summaryrefslogtreecommitdiff
path: root/stereographic.hpp
blob: 638923fd4c691723cc042681769c72a24927e821 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
#pragma once

#include <eigen3/Eigen/Cholesky>

#include "p-spin.hpp"

Vector stereographicToEuclidean(const Vector& ζ) {
  unsigned N = ζ.size() + 1;
  Vector z(N);

  Scalar a = ζ.transpose() * ζ;
  Scalar b = 2 * sqrt(N) / (1.0 + a);

  for (unsigned i = 0; i < N - 1; i++) {
    z(i) = ζ(i);
  }

  z(N - 1) = (a - 1.0) / 2.0;

  return b * z;
}

Vector euclideanToStereographic(const Vector& z) {
  unsigned N = z.size();
  Vector ζ(N - 1);

  for (unsigned i = 0; i < N - 1; i++) {
    ζ(i) = z(i);
  }

  return ζ / (sqrt(N) - z(N - 1));
}

Matrix stereographicJacobian(const Vector& ζ) {
  unsigned N = ζ.size();
  Matrix J(N, N + 1);

  Scalar b = 1.0 + (Scalar)(ζ.transpose() * ζ);

  for (unsigned i = 0; i < N; i++) {
    for (unsigned j = 0; j < N; j++) {
      J(i, j) = - ζ(i) * ζ(j);

      if (i == j) {
        J(i, j) += 0.5 * b;
      }
    }

    J(i, N) = ζ(i);
  }

  return 4 * sqrt(N + 1) * J / pow(b, 2);
}

std::tuple<Scalar, Vector, Matrix> stereographicHamGradHess(const Tensor& J, const Vector& ζ, const Vector& z) {
  auto [hamiltonian, gradZ, hessZ] = hamGradHess(J, z);
  Matrix jacobian = stereographicJacobian(ζ);

  Matrix metric = jacobian * jacobian.adjoint();

  // The metric is Hermitian and positive definite, so a Cholesky decomposition can be used.
  Vector grad = metric.llt().solve(jacobian) * gradZ;
  Matrix hess = jacobian * hessZ * jacobian.transpose();

  return {hamiltonian, grad, hess};
}