|
@@ -183,6 +183,7 @@ namespace VehicleControlSystem.ControlLayer
|
|
|
switch (cmd)
|
|
switch (cmd)
|
|
|
{
|
|
{
|
|
|
case eSteerCommand.LL:
|
|
case eSteerCommand.LL:
|
|
|
|
|
+ case eSteerCommand.ManualLL:
|
|
|
inputList.Add(IsFrontLeft);
|
|
inputList.Add(IsFrontLeft);
|
|
|
inputList.Add(IsRearLeft);
|
|
inputList.Add(IsRearLeft);
|
|
|
this.iO.WriteOutputIO("OUT_F_STEERING_OFF", true);
|
|
this.iO.WriteOutputIO("OUT_F_STEERING_OFF", true);
|
|
@@ -205,6 +206,7 @@ namespace VehicleControlSystem.ControlLayer
|
|
|
outputList.Add(actionOnRearHightVolteOn);
|
|
outputList.Add(actionOnRearHightVolteOn);
|
|
|
break;
|
|
break;
|
|
|
case eSteerCommand.RR:
|
|
case eSteerCommand.RR:
|
|
|
|
|
+ case eSteerCommand.ManualRR:
|
|
|
inputList.Add(IsFrontRight);
|
|
inputList.Add(IsFrontRight);
|
|
|
inputList.Add(IsRearRight);
|
|
inputList.Add(IsRearRight);
|
|
|
this.iO.WriteOutputIO("OUT_F_STEERING_OFF", true);
|
|
this.iO.WriteOutputIO("OUT_F_STEERING_OFF", true);
|
|
@@ -224,6 +226,7 @@ namespace VehicleControlSystem.ControlLayer
|
|
|
inputList.Add(IsRearRight);
|
|
inputList.Add(IsRearRight);
|
|
|
this.iO.WriteOutputIO("OUT_R_STEERING_OFF", true);
|
|
this.iO.WriteOutputIO("OUT_R_STEERING_OFF", true);
|
|
|
actionSteerRear(false);
|
|
actionSteerRear(false);
|
|
|
|
|
+
|
|
|
outputList.Add(actionOnRearHightVolteOn);
|
|
outputList.Add(actionOnRearHightVolteOn);
|
|
|
break;
|
|
break;
|
|
|
default:
|
|
default:
|
|
@@ -245,7 +248,7 @@ namespace VehicleControlSystem.ControlLayer
|
|
|
|
|
|
|
|
if (SwUtils.Elapsed(sT) > 700)
|
|
if (SwUtils.Elapsed(sT) > 700)
|
|
|
{
|
|
{
|
|
|
- logger.D($"Execute Steer - {cmd} - {SwUtils.Elapsed(sT)}mm");
|
|
|
|
|
|
|
+ logger.D($"Execute Steer Time out - {cmd} - {SwUtils.Elapsed(sT)}mm");
|
|
|
break;
|
|
break;
|
|
|
}
|
|
}
|
|
|
}
|
|
}
|
|
@@ -256,9 +259,11 @@ namespace VehicleControlSystem.ControlLayer
|
|
|
switch (command)
|
|
switch (command)
|
|
|
{
|
|
{
|
|
|
case eSteerCommand.LL:
|
|
case eSteerCommand.LL:
|
|
|
|
|
+ case eSteerCommand.ManualLL:
|
|
|
case eSteerCommand.LX:
|
|
case eSteerCommand.LX:
|
|
|
case eSteerCommand.XL:
|
|
case eSteerCommand.XL:
|
|
|
case eSteerCommand.RR:
|
|
case eSteerCommand.RR:
|
|
|
|
|
+ case eSteerCommand.ManualRR:
|
|
|
case eSteerCommand.RX:
|
|
case eSteerCommand.RX:
|
|
|
case eSteerCommand.XR:
|
|
case eSteerCommand.XR:
|
|
|
actionSteer(command);
|
|
actionSteer(command);
|
|
@@ -288,6 +293,11 @@ namespace VehicleControlSystem.ControlLayer
|
|
|
break;
|
|
break;
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
+ if ( command == eSteerCommand.ManualLL || command == eSteerCommand.ManualRR)
|
|
|
|
|
+ {
|
|
|
|
|
+ this.SteeringState = GetSteerDirection();
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
logger.D($"Complete Steer Command - {command} / {SwUtils.Elapsed(cmdSt)}ms");
|
|
logger.D($"Complete Steer Command - {command} / {SwUtils.Elapsed(cmdSt)}ms");
|
|
|
}
|
|
}
|
|
|
|
|
|
|
@@ -309,10 +319,10 @@ namespace VehicleControlSystem.ControlLayer
|
|
|
case eSteeringState.None:
|
|
case eSteeringState.None:
|
|
|
break;
|
|
break;
|
|
|
case eSteeringState.Left:
|
|
case eSteeringState.Left:
|
|
|
- this.RequestCommand(eSteerCommand.LL);
|
|
|
|
|
|
|
+ this.RequestCommand(eSteerCommand.ManualLL);
|
|
|
break;
|
|
break;
|
|
|
case eSteeringState.Right:
|
|
case eSteeringState.Right:
|
|
|
- this.RequestCommand(eSteerCommand.RR);
|
|
|
|
|
|
|
+ this.RequestCommand(eSteerCommand.ManualRR);
|
|
|
break;
|
|
break;
|
|
|
default:
|
|
default:
|
|
|
break;
|
|
break;
|