ba_demo_ceres
ba_demo_ceres copied to clipboard
fix for lie jacobian
Fixed the jacobian for the lie parameterization. Is not the identity for the rotation block it is the rotation itself.
actually it might be the transpose. Not sure
If https://github.com/ceres-solver/ceres-solver/blob/1f374a9fe53e362ab76fb36e1dc53f6609991009/include/ceres/local_parameterization.h#L127 actually means wrt to exp(w) then R makes sense otherwise it should a the 3x9 tensor?