|
@@ -415,7 +415,8 @@ namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
this.pubQueue.Enqueue(msg);
|
|
this.pubQueue.Enqueue(msg);
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
- #region Receive Event
|
|
|
|
|
|
|
+ #region Receive Event
|
|
|
|
|
+
|
|
|
private void Rsp_ReceiveReady(object sender, NetMQSocketEventArgs e)
|
|
private void Rsp_ReceiveReady(object sender, NetMQSocketEventArgs e)
|
|
|
{
|
|
{
|
|
|
try
|
|
try
|
|
@@ -433,7 +434,7 @@ namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
|
|
|
|
|
switch (v[0])
|
|
switch (v[0])
|
|
|
{
|
|
{
|
|
|
- case "3050":
|
|
|
|
|
|
|
+ case "3050":
|
|
|
{
|
|
{
|
|
|
logger.D($"[Steering_Rep] - 3050/{v[0]}");
|
|
logger.D($"[Steering_Rep] - 3050/{v[0]}");
|
|
|
//switch (v[1])
|
|
//switch (v[1])
|
|
@@ -493,7 +494,7 @@ namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
}
|
|
}
|
|
|
break;
|
|
break;
|
|
|
|
|
|
|
|
- case "111":
|
|
|
|
|
|
|
+ case "111":
|
|
|
{
|
|
{
|
|
|
if (v[1].Equals("1"))
|
|
if (v[1].Equals("1"))
|
|
|
OperationMode = eOperatationMode.AutoMode;
|
|
OperationMode = eOperatationMode.AutoMode;
|
|
@@ -507,7 +508,7 @@ namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
}
|
|
}
|
|
|
break;
|
|
break;
|
|
|
|
|
|
|
|
- case "4012":
|
|
|
|
|
|
|
+ case "4012":
|
|
|
if (v[1].Equals("3"))
|
|
if (v[1].Equals("3"))
|
|
|
IsDriveMoving = true;
|
|
IsDriveMoving = true;
|
|
|
else
|
|
else
|
|
@@ -535,7 +536,7 @@ namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
}
|
|
}
|
|
|
break;
|
|
break;
|
|
|
|
|
|
|
|
- case "3009":
|
|
|
|
|
|
|
+ case "3009":
|
|
|
{
|
|
{
|
|
|
int iV = 0;
|
|
int iV = 0;
|
|
|
|
|
|
|
@@ -634,7 +635,7 @@ namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
|
|
|
|
|
switch (ret[0])
|
|
switch (ret[0])
|
|
|
{
|
|
{
|
|
|
- case "7028":
|
|
|
|
|
|
|
+ case "7028":
|
|
|
{
|
|
{
|
|
|
var ll = Convert.ToDouble(vl[0]);
|
|
var ll = Convert.ToDouble(vl[0]);
|
|
|
this.FrontRPM = Math.Truncate(ll * 100) / 100;
|
|
this.FrontRPM = Math.Truncate(ll * 100) / 100;
|
|
@@ -643,7 +644,7 @@ namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
}
|
|
}
|
|
|
break;
|
|
break;
|
|
|
|
|
|
|
|
- case "7030":
|
|
|
|
|
|
|
+ case "7030":
|
|
|
{
|
|
{
|
|
|
var ll = Convert.ToDouble(vl[0]);
|
|
var ll = Convert.ToDouble(vl[0]);
|
|
|
this.FrontLoadFactor = Math.Truncate(ll * 100) / 100;
|
|
this.FrontLoadFactor = Math.Truncate(ll * 100) / 100;
|