|
@@ -7,10 +7,11 @@ void iv::control::ControlStatus::set_wheel_angle(float angle)
|
|
|
int16_t ang =(int16_t)angle;
|
|
|
ServiceControlStatus.cmd_steer.bit.steering_pos_req_H = (ang >>8) & 0x00FF;
|
|
|
ServiceControlStatus.cmd_steer.bit.steering_pos_req_L = ang & 0x00FF;
|
|
|
-
|
|
|
- std::cout<<"ang="<<ang<<std::endl;
|
|
|
- std::cout<<"ByteHigh="<<ServiceControlStatus.cmd_steer.bit.steering_pos_req_H<<std::endl;
|
|
|
- std::cout<<"ByteLow="<<ServiceControlStatus.cmd_steer.bit.steering_pos_req_L<<std::endl;
|
|
|
+ double high=ServiceControlStatus.cmd_steer.bit.steering_pos_req_H;
|
|
|
+ double low=ServiceControlStatus.cmd_steer.bit.steering_pos_req_L;
|
|
|
+// std::cout<<"ang="<<ang<<std::endl;
|
|
|
+// std::cout<<"ByteHigh="<<high<<std::endl;
|
|
|
+// std::cout<<"ByteLow="<<low<<std::endl;
|
|
|
}
|
|
|
|
|
|
void iv::control::ControlStatus::set_wheel_speed(float speed)
|