change px4controller add velocity to set velocity

This commit is contained in:
Sem van der Hoeven
2023-05-25 14:19:51 +02:00
parent b5b2da909d
commit dc5138cb8f

View File

@@ -189,7 +189,7 @@ private:
{ {
for (int i = 0; i < 3; i++) for (int i = 0; i < 3; i++)
{ {
velocity[i] += request->values[i]; velocity[i] = request->values[i];
} }
RCLCPP_INFO(this->get_logger(), "Got new velocity setpoint. %f %f %f", velocity[0], velocity[1], velocity[2]); RCLCPP_INFO(this->get_logger(), "Got new velocity setpoint. %f %f %f", velocity[0], velocity[1], velocity[2]);
} }