From 65faad811883efc4264e3a5ca2c4e64340c198f5 Mon Sep 17 00:00:00 2001
From: wells.liu <wells.liu@broconcentric.com>
Date: 星期六, 04 七月 2020 13:02:28 +0800
Subject: [PATCH] 板卡运动
---
src/Bro.Device.GTSCard/GTSCardDriver.cs | 253 ++++++++++++++++++++++++++++++++++++--------------
1 files changed, 181 insertions(+), 72 deletions(-)
diff --git a/src/Bro.Device.GTSCard/GTSCardDriver.cs b/src/Bro.Device.GTSCard/GTSCardDriver.cs
index 5a562fe..b8e668e 100644
--- a/src/Bro.Device.GTSCard/GTSCardDriver.cs
+++ b/src/Bro.Device.GTSCard/GTSCardDriver.cs
@@ -18,12 +18,12 @@
namespace Bro.Device.GTSCard
{
[Device("GTSCard", "鍥洪珮鏉垮崱", EnumHelper.DeviceAttributeType.Device)]
- public class GTSCardDriver : DeviceBase, IMonitor, IMotion
+ public class GTSCardDriver : MotionCardBase
{
// 寮傚父浜嬩欢
public Action<Exception> OnExceptionRaised;
- public GTSCardInitialConfig IConfig
+ public GTSCardInitialConfig IIConfig
{
get
{
@@ -42,7 +42,7 @@
_isResetting = isReset;
}
- public List<AxisInfo> GetCurrentAxisInfo(params string[] axisName)
+ public override List<AxisInfo> GetCurrentAxisInfo(params string[] axisName)
{
throw new NotImplementedException();
}
@@ -74,6 +74,99 @@
AllMoveStop();
AllAxisOff();
}
+
+ /// <summary>
+ /// 璁惧 杩愯
+ /// </summary>
+ /// <param name="config"></param>
+ /// <returns></returns>
+ public override ResponseMessage Run(IOperationConfig config)
+ {
+ ResponseMessage responseMessage = new ResponseMessage();
+ var opConfig = config as GTSCardOperationConfig;
+ // 1.棰勬鏌�
+ if (CurrentState == DeviceState.DSOpen)
+ {
+ foreach (var preCheck in opConfig.PreCheckIOCollection)
+ {
+ int timeout = opConfig.PreCheckIOTimeout;
+ int? ioData = null;
+ while (CurrentState == DeviceState.DSOpen)
+ {
+ Thread.Sleep(10);
+ ioData = MonitorValues.FirstOrDefault(u => u.IONum == preCheck.IOItem.IONum && u.IOType == preCheck.IOItem.IOType)?.Value;//IO 鏄紑銆佸叧 浠嶮onitorValues 鑾峰彇
+ timeout -= 10;
+ if (preCheck.CheckValue == ioData || (opConfig.PreCheckIOTimeout > 0 && timeout < 0))
+ {
+ break;
+ }
+ }
+
+ if (preCheck.CheckValue != ioData)
+ {
+ responseMessage.Result = false;
+ responseMessage.Message = $"棰勬鏌ヤ笉閫氳繃锛岄厤缃細{preCheck.GetDisplayText()}锛屽綋鍓嶅�硷細{ioData}";
+ return responseMessage;
+ }
+ }
+ }
+
+ // 2.鏉垮崱杩愬姩
+ if (CurrentState == DeviceState.DSOpen)
+ {
+ responseMessage = MoveToPoint(opConfig);
+
+ if (!responseMessage.Result)
+ {
+ return responseMessage;
+ }
+ }
+
+
+ // 3.IO杈撳嚭 涓嶉渶瑕佽秴鏃�
+ if (CurrentState == DeviceState.DSOpen)
+ {
+ foreach (var ioOutput in opConfig.IOOutputCollection)
+ {
+ var ioData = MonitorValues.FirstOrDefault(u => u.IONum == ioOutput.IOItem.IONum && u.IOType == ioOutput.IOItem.IOType)?.Value;//IO 鏄紑銆佸叧 浠嶮onitorValues 鑾峰彇
+ if (ioOutput.CheckValue != ioData)
+ {
+ responseMessage.Result = false;
+ responseMessage.Message = $"IO杈撳嚭涓嶉�氳繃锛岄厤缃細{ioOutput.GetDisplayText()}锛屽綋鍓嶅�硷細{ioData}";
+ return responseMessage;
+ }
+ }
+ }
+
+ // 4.IO纭
+ if (CurrentState == DeviceState.DSOpen)
+ {
+ foreach (var ioConfirm in opConfig.IOConfirmCollection)
+ {
+ int timeout = opConfig.IOConfirmTimeout;
+ int? ioData = null;
+ while (CurrentState == DeviceState.DSOpen)
+ {
+ Thread.Sleep(10);
+ ioData = MonitorValues.FirstOrDefault(u => u.IONum == ioConfirm.IOItem.IONum && u.IOType == ioConfirm.IOItem.IOType)?.Value;//IO 鏄紑銆佸叧 浠嶮onitorValues 鑾峰彇
+ timeout -= 10;
+ if (ioConfirm.CheckValue == ioData || (opConfig.IOConfirmTimeout > 0 && timeout < 0))
+ {
+ break;
+ }
+ }
+
+ if (ioConfirm.CheckValue != ioData)
+ {
+ responseMessage.Result = false;
+ responseMessage.Message = $"IO纭涓嶉�氳繃锛岄厤缃細{ioConfirm.GetDisplayText()}锛屽綋鍓嶅�硷細{ioData}";
+ return responseMessage;
+ }
+ }
+ }
+
+ return responseMessage;
+ }
#endregion
#region GTSCard
@@ -93,6 +186,7 @@
throw new Exception("鏉垮崱杞藉叆閰嶇疆鏂囦欢寮傚父锛岄敊璇爜锛�" + res);
}
}
+
public bool AllAxisOn()
{
@@ -153,9 +247,9 @@
/// </summary>
/// <param name="item">杩愬姩瀵硅薄</param>
/// <returns>杩愬姩鎺у埗+鍋滄鍒ゆ柇</returns>
- public bool MoveToPoint(IOperationConfig opConfig)
+ public override ResponseMessage MoveToPoint(IOperationConfig opConfig)
{
- bool resultOK = false;
+ ResponseMessage responseMessage = new ResponseMessage();
var gtsOperationConfig = opConfig as GTSCardOperationConfig;
List<Task<bool>> taskList = new List<Task<bool>>();
//TaskFactory factory = new TaskFactory(TaskCreationOptions.LongRunning, TaskContinuationOptions.None);
@@ -170,9 +264,12 @@
taskList.Add(task);
}
Task.WaitAll(taskList.ToArray());
- resultOK = taskList.All(u => u.GetAwaiter().GetResult());
-
- return resultOK;
+ responseMessage.Result = taskList.All(u => u.GetAwaiter().GetResult());
+ if (!responseMessage.Result)
+ {
+ responseMessage.Message = $"鐐逛綅杩愬姩寮傚父";
+ }
+ return responseMessage;
}
/// <summary>
@@ -210,48 +307,56 @@
return await Task.Run(() =>
{
bool isSuccessAndStop = false;
- if (IConfig.AxisSettings.FirstOrDefault(a => a.AxisIndex == optionPara.AxisIndex)?.IsAxisEnabled ?? false)
+ try
{
- string _position = "";
- string motionType = optionPara.MoveMode == EnumHelper.MotorMoveMode.Normal ? (optionPara.IsAbsolute ? "Abs" : "Rel") : optionPara.MoveMode.ToString();
-
- _position = $"{DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss.fff")},{optionPara.AxisIndex},{motionType},{GetPosition(optionPara.AxisIndex).ToString()},{GetPrfPosition(optionPara.AxisIndex).ToString()},{optionPara.Destination},";
-
- switch (optionPara.MoveMode)
+ if (IConfig.AxisSettings.FirstOrDefault(a => a.AxisIndex == optionPara.AxisIndex)?.IsAxisEnabled ?? false)
{
- case MotorMoveMode.Normal:
- {
- if (_isResetting)
- {
- LogAsync(DateTime.Now, "澶嶄綅涓惎鍔ㄨ繍鍔ㄥ紓甯�", optionPara.AxisIndex + "鍚姩杩愬姩寮傚父");
- return false;
- }
+ string _position = "";
+ string motionType = optionPara.MoveMode == EnumHelper.MotorMoveMode.Normal ? (optionPara.IsAbsolute ? "Abs" : "Rel") : optionPara.MoveMode.ToString();
- if (optionPara.IsAbsolute)
- {
- isSuccessAndStop = P2PMoveAbs(optionPara);
- }
- else
- {
- isSuccessAndStop = P2PMoveRel(optionPara);
- }
+ _position = $"{DateTime.Now:yyyy-MM-dd HH:mm:ss.fff},{optionPara.AxisIndex},{motionType},{GetPosition(optionPara.AxisIndex)},{GetPrfPosition(optionPara.AxisIndex)},{optionPara.Destination},";
- }
- break;
- case MotorMoveMode.FindOri:
- {
- isSuccessAndStop = GoHome(optionPara);
- }
- break;
- case MotorMoveMode.Jog:
- {
- isSuccessAndStop = JogMove(optionPara);
- }
- break;
+ switch (optionPara.MoveMode)
+ {
+ case MotorMoveMode.Normal:
+ {
+ if (_isResetting)
+ {
+ LogAsync(DateTime.Now, "澶嶄綅涓惎鍔ㄨ繍鍔ㄥ紓甯�", optionPara.AxisIndex + "鍚姩杩愬姩寮傚父");
+ return false;
+ }
+
+ if (optionPara.IsAbsolute)
+ {
+ isSuccessAndStop = P2PMoveAbs(optionPara);
+ }
+ else
+ {
+ isSuccessAndStop = P2PMoveRel(optionPara);
+ }
+
+ }
+ break;
+ case MotorMoveMode.FindOri:
+ {
+ isSuccessAndStop = GoHome(optionPara);
+ }
+ break;
+ case MotorMoveMode.Jog:
+ {
+ isSuccessAndStop = JogMove(optionPara);
+ }
+ break;
+ }
+ _position += $"{GetPosition(optionPara.AxisIndex)},";
+ _position += $"{DateTime.Now:yyyy-MM-dd HH:mm:ss.fff}";
+ LogAsync(DateTime.Now, "", _position);
}
- _position += $"{GetPosition(optionPara.AxisIndex)},";
- _position += $"{DateTime.Now:yyyy-MM-dd HH:mm:ss.fff}";
- LogAsync(DateTime.Now, "", _position);
+ }
+ catch (Exception ex)
+ {
+ isSuccessAndStop = false;
+ LogAsync(DateTime.Now, $"杞磠optionPara.AxisIndex}杩愬姩寮傚父", ex.GetExceptionMessage());
}
return isSuccessAndStop;
});
@@ -322,7 +427,7 @@
if (ret != (short)GTSRetCode.GRCRunOK)
{
LogAsync(DateTime.Now, "杞�" + optionPara.AxisIndex + "APS_absolute_move寮傚父", "閿欒鐮侊細" + ret + ";" + "閲嶈瘯娆℃暟锛�" + repeatTime);
- Thread.Sleep(50);
+ Thread.Sleep(10);
}
repeatTime--;
} while (ret != (short)GTSRetCode.GRCRunOK && repeatTime > 0);
@@ -396,11 +501,11 @@
LogAsync(DateTime.Now, "杞�" + optionPara.AxisIndex + "寮�濮嬭繍鍔�", "鐩爣鍧愭爣锛�" + optionPara.Destination);
short ret = 0;
- repeatTime = 100;
bool isSuccessSetAxisParam = false;
int currentPosition = (int)GetPosition(optionPara.AxisIndex);
int dPosition = optionPara.Destination + currentPosition;
- do
+ int timeout = optionPara.MovingTimeout;
+ while (CurrentState == DeviceState.DSOpen)
{
//璁剧疆 杩愬姩鍙傛暟
isSuccessSetAxisParam = SetAxisParam(optionPara);
@@ -412,8 +517,12 @@
LogAsync(DateTime.Now, "杞�" + optionPara.AxisIndex + "APS_absolute_move寮傚父", "閿欒鐮侊細" + ret + ";" + "閲嶈瘯娆℃暟锛�" + repeatTime);
Thread.Sleep(50);
}
- repeatTime--;
- } while (ret != (short)GTSRetCode.GRCRunOK && !isSuccessSetAxisParam && repeatTime > 0);
+ timeout -= 50;
+ if ((ret == (short)GTSRetCode.GRCRunOK && isSuccessSetAxisParam) || (optionPara.MovingTimeout > 0 && timeout < 0))
+ {
+ break;
+ }
+ }
//杩愬姩寮�濮嬪悗 妫�鏌ヨ繍鍔ㄦ槸鍚﹀仠姝�
bool isStop = false;
@@ -467,9 +576,9 @@
}
LogAsync(DateTime.Now, "杞�" + optionPara.AxisIndex + "寮�濮嬭繍鍔�", "鐩爣鍧愭爣锛�" + optionPara.Destination);
short ret = 0;
- repeatTime = 100;
bool isSuccessSetAxisParam = false;
- do
+ int timeout = optionPara.MovingTimeout;
+ while (CurrentState == DeviceState.DSOpen)
{
//璁剧疆 杩愬姩鍙傛暟
isSuccessSetAxisParam = SetAxisParam(optionPara);
@@ -481,8 +590,12 @@
LogAsync(DateTime.Now, "杞�" + optionPara.AxisIndex + "APS_absolute_move寮傚父", "閿欒鐮侊細" + ret + ";" + "閲嶈瘯娆℃暟锛�" + repeatTime);
Thread.Sleep(50);
}
- repeatTime--;
- } while (ret != (short)GTSRetCode.GRCRunOK && !isSuccessSetAxisParam && repeatTime > 0);
+ timeout -= 50;
+ if ((ret == (short)GTSRetCode.GRCRunOK && isSuccessSetAxisParam) || (optionPara.MovingTimeout > 0 && timeout < 0))
+ {
+ break;
+ }
+ }
bool isStop = false;
repeatTime = 1000;
@@ -627,14 +740,13 @@
/// <summary>
/// 璇诲彇IO杈撳嚭
/// </summary>
- /// <param name="cardNum"></param>
- /// <param name="index"></param>
+ /// <param name="index">io绱㈠紩</param>
/// <returns></returns>
- public bool GetDoSts(short cardNum, short index)
+ public bool GetDoSts(short index)
{
int outSts;
short outNum = (short)(index % 100);
- GTSCardAPI.GT_GetDo(cardNum, GTSCardAPI.MC_GPO, out outSts);
+ GTSCardAPI.GT_GetDo((short)IConfig.CardNum, GTSCardAPI.MC_GPO, out outSts);
if ((outSts & (1 << outNum)) == 0) return true;
else return false;
}
@@ -642,19 +754,18 @@
/// <summary>
/// 鎸変綅璁剧疆鏁板瓧 IO 杈撳嚭鐘舵��
/// </summary>
- /// <param name="cardNum">鍗″彿</param>
/// <param name="index">杈撳嚭鍙�,杩斿洖1-16</param>
/// <param name="value">false琛ㄧず杈撳嚭锛宼rue琛ㄧず鍏抽棴</param>
- public void WriteOut(short cardNum, short index, bool value)
+ public void WriteOut(short index, bool value)
{
short outNum = (short)(index % 100 + 1);
if (value)
{
- GTSCardAPI.GT_SetDoBit(cardNum, GTSCardAPI.MC_GPO, outNum, 0);
+ GTSCardAPI.GT_SetDoBit((short)IConfig.CardNum, GTSCardAPI.MC_GPO, outNum, 0);
}
else
{
- GTSCardAPI.GT_SetDoBit(cardNum, GTSCardAPI.MC_GPO, outNum, 1);
+ GTSCardAPI.GT_SetDoBit((short)IConfig.CardNum, GTSCardAPI.MC_GPO, outNum, 1);
}
}
@@ -679,8 +790,6 @@
#endregion
#region IMonitor
- public event Action<DateTime, string, IDevice, IMonitorSet> OnMonitorInvoke;
- public event Action<DateTime, IDevice, IWarningSet> OnMonitorAlarm;
public List<IOItem> MonitorValues { get; set; } = new List<IOItem>();
@@ -702,13 +811,13 @@
{
IONum = index,
Value = (inValue & (1 << index)) == 0 ? 1 : 0,
- Model = IOModel.In
+ IOType = IOType.INPUT
};
IOItem outItem = new IOItem()
{
IONum = index,
Value = (outValue & (1 << index)) == 0 ? 1 : 0,
- Model = IOModel.Out
+ IOType = IOType.OUTPUT
};
result.Add(inItem);
result.Add(outItem);
@@ -717,7 +826,7 @@
return result;
}
- public async void Monitor()
+ public async override void Monitor()
{
await Task.Run(() =>
{
@@ -779,7 +888,7 @@
foreach (var replyIOData in monitorSet.ReplyIODatas)
{
//鍐欏叆IO杈撳嚭
- if (replyIOData.Model == IOModel.Out)
+ if (replyIOData.IOType == IOType.OUTPUT)
{
GTSCardAPI.GT_SetDoBit((short)IConfig.CardNum, GTSCardAPI.MC_GPI, (short)replyIOData.IONum, (short)replyIOData.Value);
}
@@ -796,7 +905,7 @@
{
MotionCardWarningSet warningSet = wSet as MotionCardWarningSet;
- bool isOn = ((tempNew.FirstOrDefault(u => u.IONum == warningSet.TriggerIndex && u.Model == warningSet.WarningIOModel)?.Value >> warningSet.TriggerIndex) & 1) == (warningSet.TriggerValue ? 1 : 0);
+ bool isOn = ((tempNew.FirstOrDefault(u => u.IONum == warningSet.TriggerIndex && u.IOType == warningSet.WarningIOModel)?.Value >> warningSet.TriggerIndex) & 1) == (warningSet.TriggerValue ? 1 : 0);
if (warningSet.CurrentStatus != isOn)
{
@@ -804,7 +913,7 @@
warningSet.TriggerTime = DateTime.Now;
warningSet.WarningDescription = $"璀︽姤锛歿warningSet.Name}-瑙﹀彂绱㈠紩锛歿warningSet.TriggerIndex}-{warningSet.WarningIOModel.GetEnumDescription()}:{warningSet.WarningCode}";
SaveAlarmCSVAsync(DateTime.Now, this.Name, warningSet);
- OnMonitorAlarm?.BeginInvoke(DateTime.Now, this, warningSet, null, null);
+ ExcuteMonitorAlarm(DateTime.Now, this, warningSet);
}
});
#endregion
@@ -835,14 +944,14 @@
// return tempNew[index].Value;
//}).ToList();
- OnMonitorInvoke?.BeginInvoke(DateTime.Now, monitorSet.InvokeDevice, this, monitorSet, OnMethodInvoked, monitorSet);
+ ExcuteMonitorInvok(DateTime.Now, monitorSet.InvokeDevice, this, monitorSet, OnMethodInvoked);
}
}
});
#endregion
}
- public void ResetAlarm()
+ public override void ResetAlarm()
{
int axis_sts;
uint clk;
--
Gitblit v1.8.0