| 323 | static constexpr double kAlt0 = 451.5; |
| 324 | |
| 325 | void PosePriorPositionCartesianToWGS84(PosePrior& pose_prior) { |
| 326 | pose_prior.position = kGPSTransform.ENUToEllipsoid( |
| 327 | {pose_prior.position}, kLat0, kLon0, kAlt0)[0]; |
| 328 | pose_prior.coordinate_system = PosePrior::CoordinateSystem::WGS84; |
| 329 | } |
| 330 | |
| 331 | void PosePriorPositionWGS84ToCartesian(PosePrior& pose_prior) { |
| 332 | pose_prior.position = kGPSTransform.EllipsoidToENU( |
no test coverage detected