cyy/yq_2026_duo
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

fix arm_solver

Browse Source
This commit is contained in:
cyy_mac
2026-03-25 19:29:11 +08:00
parent 9b9c603134
commit 1524268099
1 changed files with 1 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
src/rm_auto_aim/armor_solver/src/armor_solver_node.cpp
View File

@@ -428,10 +428,9 @@ void ArmorSolverNode::publishMarkers(const rm_interfaces::msg::Target &target_ms
visualization_msgs::msg::MarkerArray marker_array; visualization_msgs::msg::MarkerArray marker_array;
if (target_msg.tracking) { if (target_msg.tracking) {
double yaw = target_msg.yaw, r1 = target_msg.radius_1, r2 = target_msg.radius_2; double yaw = target_msg.yaw;
double xc = target_msg.position.x, yc = target_msg.position.y, zc = target_msg.position.z; double xc = target_msg.position.x, yc = target_msg.position.y, zc = target_msg.position.z;
double vx = target_msg.velocity.x, vy = target_msg.velocity.y, vz = target_msg.velocity.z; double vx = target_msg.velocity.x, vy = target_msg.velocity.y, vz = target_msg.velocity.z;
double d_za = target_msg.d_za, d_zc = target_msg.d_zc;
position_marker_.action = visualization_msgs::msg::Marker::ADD; position_marker_.action = visualization_msgs::msg::Marker::ADD;
position_marker_.pose.position.x = xc; position_marker_.pose.position.x = xc;
position_marker_.pose.position.y = yc; position_marker_.pose.position.y = yc;