261 lines
8.2 KiB
C#
261 lines
8.2 KiB
C#
|
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<string, AlarmEventItem> 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<WalkingAxisBaseDevice>(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;
|
|||
|
}
|
|||
|
|
|||
|
|
|||
|
|
|||
|
}
|
|||
|
}
|