@@ -143,15 +143,17 @@ void VehicleNode::publish_kinematics()
143
143
vehicle_kinematics.twist .header .frame_id = kinematic_state_msgs_->child_frame_id ;
144
144
vehicle_kinematics.twist .twist = kinematic_state_msgs_->twist ;
145
145
if (map_projector_info_->projector_type != MapProjectorInfo::LOCAL) {
146
- const geographic_msgs::msg::GeoPoint projected_gps_point = autoware::geography_utils::project_reverse (
147
- kinematic_state_msgs_->pose .pose .position , *map_projector_info_);
146
+ const geographic_msgs::msg::GeoPoint projected_gps_point =
147
+ autoware::geography_utils::project_reverse (
148
+ kinematic_state_msgs_->pose .pose .position , *map_projector_info_);
148
149
vehicle_kinematics.geographic_pose .header = kinematic_state_msgs_->header ;
149
150
vehicle_kinematics.geographic_pose .header .frame_id = " global" ;
150
151
vehicle_kinematics.geographic_pose .position .latitude = projected_gps_point.latitude ;
151
152
vehicle_kinematics.geographic_pose .position .longitude = projected_gps_point.longitude ;
152
- vehicle_kinematics.geographic_pose .position .altitude = autoware::geography_utils::convert_height (
153
- projected_gps_point.altitude , projected_gps_point.latitude , projected_gps_point.longitude ,
154
- map_projector_info_->vertical_datum , MapProjectorInfo::WGS84);
153
+ vehicle_kinematics.geographic_pose .position .altitude =
154
+ autoware::geography_utils::convert_height (
155
+ projected_gps_point.altitude , projected_gps_point.latitude , projected_gps_point.longitude ,
156
+ map_projector_info_->vertical_datum , MapProjectorInfo::WGS84);
155
157
} else {
156
158
vehicle_kinematics.geographic_pose .position .latitude = std::numeric_limits<double >::quiet_NaN ();
157
159
vehicle_kinematics.geographic_pose .position .longitude =
0 commit comments