mono_cubic1.py 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120
  1. # Function supporting monotonic cubic polynomials: first parametrization
  2. # We define the polynomial:
  3. # poly(x) = sum_i beta_i * x^i
  4. # where the coefficients beta_i are parameterized by the vector 'pars'.
  5. import numpy as np
  6. def forward_map(pars, small=1e-8):
  7. """
  8. Map parameter vector pars to coefficients beta.
  9. beta = [p0, (p2^2 + p1^2) / a, p2, p3^2],
  10. where a = 3*p3^2 + small.
  11. """
  12. pars = np.asarray(pars, dtype=float)
  13. p0, p1, p2, p3 = pars
  14. a = 3.0 * p3**2 + small
  15. beta = np.array([
  16. p0,
  17. (p2**2 + p1**2) / a,
  18. p2,
  19. p3**2
  20. ], dtype=float)
  21. return beta
  22. def backward_map(beta, small=1e-8):
  23. """
  24. Map coefficients beta back to parameter vector pars.
  25. Nonnegative roots are used for p1 and p3.
  26. """
  27. beta = np.asarray(beta, dtype=float)
  28. b0, b1, b2, b3 = beta
  29. p0 = b0
  30. p3 = np.sqrt(b3)
  31. a = 3.0 * b3 + small
  32. p2 = b2
  33. p1_sq = b1 * a - p2**2
  34. if p1_sq < 0:
  35. raise ValueError(f"Negative square root encountered for p1^2 = {p1_sq}")
  36. p1 = np.sqrt(p1_sq)
  37. return np.array([p0, p1, p2, p3], dtype=float)
  38. def forward_map_jacobian(pars, small=1e-8):
  39. """
  40. Compute Jacobian of forward_map at given pars.
  41. Returns J: d(beta)/d(pars), shape (4, 4).
  42. """
  43. p0, p1, p2, p3 = np.asarray(pars, dtype=float)
  44. a = 3.0 * p3**2 + small
  45. J = np.zeros((4, 4), dtype=float)
  46. # beta0 row
  47. J[0, 0] = 1.0
  48. # beta1 row
  49. J[1, 1] = 2.0 * p1 / a
  50. J[1, 2] = 2.0 * p2 / a
  51. J[1, 3] = -6.0 * p3 * (p2**2 + p1**2) / a**2
  52. # beta2 row
  53. J[2, 2] = 1.0
  54. # beta3 row
  55. J[3, 3] = 2.0 * p3
  56. return J
  57. def forward_map_hessian(pars, small=1e-8):
  58. """
  59. Compute Hessians of forward_map at given pars.
  60. Returns H: shape (4, 4, 4),
  61. where H[i] is the 4x4 Hessian of beta[i] w.r.t. pars.
  62. """
  63. p0, p1, p2, p3 = np.asarray(pars, dtype=float)
  64. a = 3.0 * p3**2 + small
  65. N = p1**2 + p2**2
  66. H = np.zeros((4, 4, 4), dtype=float)
  67. # beta0: all zeros
  68. # beta1 Hessian
  69. H1 = np.zeros((4, 4), dtype=float)
  70. H1[1, 1] = 2.0 / a
  71. H1[2, 2] = 2.0 / a
  72. H1[1, 3] = -12.0 * p1 * p3 / a**2
  73. H1[3, 1] = H1[1, 3]
  74. H1[2, 3] = -12.0 * p2 * p3 / a**2
  75. H1[3, 2] = H1[2, 3]
  76. H1[3, 3] = 6.0 * N * (12.0 * p3**2 - a) / a**3
  77. H[1] = H1
  78. # beta2: all zeros
  79. # beta3 Hessian
  80. H3 = np.zeros((4, 4), dtype=float)
  81. H3[3, 3] = 2.0
  82. H[3] = H3
  83. return H
  84. # -------------------------
  85. # Round-trip test
  86. # -------------------------
  87. if __name__ == "__main__":
  88. pars_original = np.array([1.0, 2.0, 3.0, 4.0])
  89. beta = forward_map(pars_original)
  90. pars_recovered = backward_map(beta)
  91. print("Original pars: ", pars_original)
  92. print("Beta: ", beta)
  93. print("Recovered pars:", pars_recovered)
  94. print("Difference: ", pars_recovered - pars_original)
  95. print("\nJacobian at pars:")
  96. print(forward_map_jacobian(pars_original))
  97. print("\nHessian for beta1:")
  98. print(forward_map_hessian(pars_original)[1])