|
@@ -638,6 +638,10 @@ namespace TeamAAS_VP.Core.Robots
|
|
|
{
|
|
{
|
|
|
nodeIds.Add(axis.State.ErrorNode);
|
|
nodeIds.Add(axis.State.ErrorNode);
|
|
|
}
|
|
}
|
|
|
|
|
+ if (!string.IsNullOrWhiteSpace(axis.State.PausedNode))
|
|
|
|
|
+ {
|
|
|
|
|
+ nodeIds.Add(axis.State.PausedNode);
|
|
|
|
|
+ }
|
|
|
}
|
|
}
|
|
|
var res = Plc.ReadNodes(nodeIds.ToArray());
|
|
var res = Plc.ReadNodes(nodeIds.ToArray());
|
|
|
bool allOk = true;
|
|
bool allOk = true;
|
|
@@ -660,6 +664,15 @@ namespace TeamAAS_VP.Core.Robots
|
|
|
{
|
|
{
|
|
|
isError = (bool)res[axis.State.ErrorNode];
|
|
isError = (bool)res[axis.State.ErrorNode];
|
|
|
}
|
|
}
|
|
|
|
|
+ if (res.ContainsKey(axis.State.PausedNode))
|
|
|
|
|
+ {
|
|
|
|
|
+ isError = (bool)res[axis.State.PausedNode];
|
|
|
|
|
+ }
|
|
|
|
|
+ if (isError)
|
|
|
|
|
+ {
|
|
|
|
|
+ isAnyError = true;
|
|
|
|
|
+ break;
|
|
|
|
|
+ }
|
|
|
//检查是否到位和位置一致
|
|
//检查是否到位和位置一致
|
|
|
float targetPos = 0;
|
|
float targetPos = 0;
|
|
|
switch (axis.Name)
|
|
switch (axis.Name)
|