@@ -82,17 +82,17 @@ class GNSS : public Observer {
82
82
Eigen::Vector3d *point_enu) {
83
83
static GeographicLib::LocalCartesian local_cartesian;
84
84
local_cartesian.Reset (init_lla (0 ), init_lla (1 ), init_lla (2 ));
85
- local_cartesian.Forward (point_lla ( 0 ), point_lla ( 1 ), point_lla ( 2 ), point_enu-> data ()[ 0 ], point_enu-> data ()[ 1 ],
86
- point_enu->data ()[2 ]);
85
+ local_cartesian.Forward (
86
+ point_lla ( 0 ), point_lla ( 1 ), point_lla ( 2 ), point_enu-> data ()[ 0 ], point_enu-> data ()[ 1 ], point_enu->data ()[2 ]);
87
87
}
88
88
89
89
static inline void enu2lla (const Eigen::Vector3d &init_lla,
90
90
const Eigen::Vector3d &point_enu,
91
91
Eigen::Vector3d *point_lla) {
92
92
static GeographicLib::LocalCartesian local_cartesian;
93
93
local_cartesian.Reset (init_lla (0 ), init_lla (1 ), init_lla (2 ));
94
- local_cartesian.Reverse (point_enu ( 0 ), point_enu ( 1 ), point_enu ( 2 ), point_lla-> data ()[ 0 ], point_lla-> data ()[ 1 ],
95
- point_lla->data ()[2 ]);
94
+ local_cartesian.Reverse (
95
+ point_enu ( 0 ), point_enu ( 1 ), point_enu ( 2 ), point_lla-> data ()[ 0 ], point_lla-> data ()[ 1 ], point_lla->data ()[2 ]);
96
96
}
97
97
98
98
private:
@@ -101,4 +101,4 @@ class GNSS : public Observer {
101
101
};
102
102
using GNSSPtr = std::shared_ptr<GNSS>;
103
103
104
- } // namespace cg
104
+ } // namespace cg
0 commit comments