fix arm_solver

This commit is contained in:
cyy_mac
2026-03-25 19:29:11 +08:00
parent 9b9c603134
commit 1524268099

View File

@@ -428,10 +428,9 @@ void ArmorSolverNode::publishMarkers(const rm_interfaces::msg::Target &target_ms
visualization_msgs::msg::MarkerArray marker_array;
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 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_.pose.position.x = xc;
position_marker_.pose.position.y = yc;