fix arm_solver
This commit is contained in:
@@ -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;
|
||||
|
||||
Reference in New Issue
Block a user