using Aitex.Core.RT.Device; using Aitex.Core.RT.Event; using Aitex.Core.RT.Fsm; using Aitex.Core.RT.DataCenter; using System; using System.Collections.Generic; using System.Linq; using System.Text; using System.Threading.Tasks; using Aitex.Core.RT.OperationCenter; using MECF.Framework.Common.Event; namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.WalkingAixs { public abstract class WalkingAxisBaseDevice : Entity, IDevice { public bool IsBusy { get; private set; } protected WalkingAxisBaseDevice(string module, string name) : base() { Module = module; Name = name; InitializeMotion(); } private void InitializeMotion() { BuildTransitionTable(); SubscribeDataVariable(); SubscribeOperation(); Running = true; } public event Action OnDeviceAlarmStateChanged; public bool HasAlarm { get; } public string Module { get; set; } public string Name { get; set ; } public WalkingAxisState DeviceState { get => (WalkingAxisState)fsm.State; } public abstract int GetCurrentStation(); public bool IsArrivedTarget { get { return (TargetStation == GetCurrentStation()); } } public int TargetStation { get; private set; } public abstract void Monitor(); public void Reset() { } public enum WalkingAxisMsg { Reset, Init, StartMove, Stop, Error, ActionDone, } public enum WalkingAxisState { Init, Initializing, Idle, Moving, ERROR, Stopped, Busy, } private void BuildTransitionTable() { fsm = new StateMachine(Module + Name + ".StateMachine", (int)WalkingAxisState.Init, 50); AnyStateTransition(WalkingAxisMsg.Error, fError, WalkingAxisState.ERROR); AnyStateTransition(WalkingAxisMsg.Stop, fStop, WalkingAxisState.Stopped); Transition(WalkingAxisState.Init, WalkingAxisMsg.Init, fStartInit, WalkingAxisState.Initializing); Transition(WalkingAxisState.Initializing, FSM_MSG.TIMER, fMonitorInit, WalkingAxisState.Initializing); Transition(WalkingAxisState.Initializing, WalkingAxisMsg.ActionDone, fInitComplete, WalkingAxisState.Idle); Transition(WalkingAxisState.Idle, WalkingAxisMsg.Init, fStartInit, WalkingAxisState.Initializing); Transition(WalkingAxisState.Idle, WalkingAxisMsg.StartMove, fStartMove, WalkingAxisState.Moving); Transition(WalkingAxisState.Moving, FSM_MSG.TIMER, fMonitorMove, WalkingAxisState.Moving); Transition(WalkingAxisState.Moving, WalkingAxisMsg.ActionDone, fMoveComplete, WalkingAxisState.Idle); Transition(WalkingAxisState.ERROR, WalkingAxisMsg.Reset, fStartReset, WalkingAxisState.Init); Transition(WalkingAxisState.Stopped, WalkingAxisMsg.Reset, fStartReset, WalkingAxisState.Init); Transition(WalkingAxisState.Idle, WalkingAxisMsg.Reset, fStartReset, WalkingAxisState.Idle); Transition(WalkingAxisState.Init, WalkingAxisMsg.Reset, fStartReset, WalkingAxisState.Idle); } public virtual bool IsReady() { return ((!IsBusy) && (DeviceState == WalkingAxisState.Idle)); } private void SubscribeDataVariable() { DATA.Subscribe($"{Module}.{Name}.State", () => DeviceState.ToString()); } private void SubscribeOperation() { OP.Subscribe($"{Module}.{Name}.Home", (string cmd, object[] param) => { string reason = ""; if (!Home(null)) { EV.PostWarningLog(Module, $"{Name} can not home, {reason}"); return false; } EV.PostInfoLog(Module, $"{Name} home"); return true; }); OP.Subscribe($"{Module}.{Name}.Reset", (string cmd, object[] param) => { string reason = ""; if (!Reset(null)) { EV.PostWarningLog(Module, $"{Name} can not clear alarm, {reason}"); return false; } EV.PostInfoLog(Module, $"{Name} reset alarm"); return true; }); OP.Subscribe($"{Module}.{Name}.MoveTo", (string cmd, object[] param) => { string reason = ""; if (!MoveTo(param)) { EV.PostWarningLog(Module, $"{Name} can not move to {param[0].ToString()}, {reason}"); return false; } EV.PostInfoLog(Module, $"{Name} move to {param[0]}"); return true; }); OP.Subscribe($"{Module}.{Name}.Stop", (string cmd, object[] param) => { string reason = ""; if (!Stop(null)) { EV.PostWarningLog(Module, $"{Name} can not Stop, {reason}"); return false; } EV.PostInfoLog(Module, $"{Name} Stop"); return true; }); } protected virtual bool fStop(object[] param) { IsBusy = false; return true; } protected abstract bool fStartReset(object[] param); protected abstract bool fMonitorMove(object[] param); protected abstract bool fStartMove(object[] param); protected abstract bool fMonitorInit(object[] param); protected abstract bool fStartInit(object[] param); protected virtual bool fError(object[] param) { return true; } protected virtual bool fInitComplete(object[] param) { IsBusy = false; return true; } protected virtual bool fMoveComplete(object[] param) { IsBusy = false; return true; } public virtual bool Home(object[] param) { IsBusy = true; return CheckToPostMessage((int)WalkingAxisMsg.Init, param); } public virtual bool MoveTo(object[] param) { int temp; if (int.TryParse(param[0].ToString(), out temp)) { TargetStation = temp; IsBusy = true; return CheckToPostMessage((int)WalkingAxisMsg.StartMove, new object[] { temp}); } return false; } public virtual bool Reset(object[] param) { IsBusy = false; return CheckToPostMessage((int)WalkingAxisMsg.Reset, param); } public virtual bool Stop(object[] param) { IsBusy = true; return CheckToPostMessage((int)WalkingAxisMsg.Stop, param); } public virtual bool OnActionDone(object[] param) { IsBusy = false; return CheckToPostMessage((int)WalkingAxisMsg.ActionDone, param); } public virtual bool OnError(object[] param) { return CheckToPostMessage((int)WalkingAxisMsg.Error, param); } public bool CheckToPostMessage(int msg, params object[] args) { if (!fsm.FindTransition(fsm.State, msg)) { EV.PostWarningLog(Name, $"{Name} is in { (WalkingAxisState)fsm.State} state,can not do {(WalkingAxisMsg)msg}"); return false; } fsm.PostMsg(msg, args); return true; } public bool Check(int msg, out string reason, params object[] args) { if (!fsm.FindTransition(fsm.State, msg)) { reason = String.Format("{0} is in {1} state,can not do {2}", Name, (WalkingAxisState)fsm.State, (WalkingAxisMsg)msg); return false; } reason = ""; return true; } } }