|
|
|
@ -35,7 +35,6 @@ void paint_joysticker_manual_control(); |
|
|
|
int AbnormalDetect();//异常检测);
|
|
|
|
char is_upper_computer_take_over_control=0; |
|
|
|
int CH13_S2_Value ; |
|
|
|
int32_t speed_selection=0; //旋钮速度0-30
|
|
|
|
int paintOffCount=0; //5° 计数 超过1s 关枪
|
|
|
|
uint8_t angle_protect_lock=0; //作业时角度偏差过5°,停车标记位
|
|
|
|
int32_t power_on_lock = 0; /*上电锁*/ |
|
|
|
@ -169,9 +168,8 @@ void MoveControl() |
|
|
|
} |
|
|
|
|
|
|
|
/* 速度选择索引 0-30 */ |
|
|
|
speed_selection = 3 * (P_MK32->CH11_RD1 + 1000) / 200; |
|
|
|
GV.Robot_Move_Speed = speed_M_min_toE01_M_min( GetVehicleSpeed(speed_selection) );/*获取旋钮速度*/ |
|
|
|
IV.RobotMoveSpeed= GetVehicleSpeed(speed_selection); |
|
|
|
GV.Robot_Move_Speed = speed_M_min_toE01_M_min( GetVehicleSpeed() );/*获取旋钮速度*/ |
|
|
|
IV.RobotMoveSpeed= GetVehicleSpeed(); |
|
|
|
|
|
|
|
//换道优先级优于普通的运行;
|
|
|
|
if (LaneChangeControl_Paint() == 1) |
|
|
|
@ -367,7 +365,7 @@ void IV_control() |
|
|
|
/* 返回值是脉冲/s P*60/10000/70/(Πd)=V */ |
|
|
|
IV.CurrentSpeed=GV.LeftMotor.Real_Velcity*60.0/CV.pulse_Per_Circle/CV.wheel_Reduction_Ratio*M_PI*CV.wheel_Diameter_m; |
|
|
|
|
|
|
|
IV.RobotMoveSpeed=GetVehicleSpeed(speed_selection); |
|
|
|
IV.RobotMoveSpeed=GetVehicleSpeed(); |
|
|
|
IV.CurrentAngle = GV.Robot_Angle; |
|
|
|
IV.SBUS_State=GV.P_MK32.IsOnline; |
|
|
|
IV.SystemError = GV.SystemErrorData.Com_Error_Code; /* SystemErrorCode = &GV.SystemErrorData.Com_Error_Code; */ |
|
|
|
|