Browse Source

modify controller

HAPO-9# 2 năm trước cách đây
mục cha
commit
b2540c1314

+ 5 - 4
src/controller/controller_rubshCar/control/control_status.cpp

@@ -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)