|
@@ -4,10 +4,13 @@
|
|
|
|
|
|
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;
|
|
|
|
|
|
- int ang =angle;
|
|
|
- ServiceControlStatus.cmd_steer.bit.steering_pos_req_H = (ang) /256;
|
|
|
- ServiceControlStatus.cmd_steer.bit.steering_pos_req_L = (ang) % 256;
|
|
|
+ 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;
|
|
|
}
|
|
|
|
|
|
void iv::control::ControlStatus::set_wheel_speed(float speed)
|