Skip to content

Commit 3c4dac2

Browse files
committed
#6: use the INS velocity instead GNSS for separate velocity topic
1 parent 0c81996 commit 3c4dac2

File tree

1 file changed

+2
-2
lines changed

1 file changed

+2
-2
lines changed

adma_ros2_driver/src/adma_driver.cpp

Lines changed: 2 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -194,8 +194,8 @@ void ADMADriver::parseData(std::array<char, 856> recv_buf)
194194
// read heading and velocity
195195
message_heading.data = adma_data_scaled_msg.ins_yaw;
196196
message_velocity.data = std::sqrt(
197-
std::pow(adma_data_scaled_msg.gnss_vel_frame.x, 2) +
198-
std::pow(adma_data_scaled_msg.gnss_vel_frame.y, 2)) *
197+
std::pow(adma_data_scaled_msg.ins_vel_frame.x, 2) +
198+
std::pow(adma_data_scaled_msg.ins_vel_frame.y, 2)) *
199199
3.6;
200200

201201
pub_adma_data_scaled_->publish(adma_data_scaled_msg);

0 commit comments

Comments
 (0)