CyberX8/CyberX8_RT/Modules/SRD/SRDSwitchOnRoutine.cs

using Aitex.Core.RT.Device;
using Aitex.Core.RT.Routine;
using MECF.Framework.Common.Equipment;
using MECF.Framework.Common.Routine;
using CyberX8_Core;
using CyberX8_RT.Devices.AXIS;
using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Threading.Tasks;

namespace CyberX8_RT.Modules.Transporter
{
    public class SRDSwitchOnRoutine : RoutineBase, IRoutine
    {
        private enum SwitchOnStep
        {
            Arm,
            Rotation,
            End
        }
        #region 内部变量
        private JetAxisBase _armAxis;
        private JetAxisBase _rotationAxis;
        private int _timeOut = 1000;
        #endregion

        #region 属性
        /// <summary>
        /// 当前子状态机
        /// </summary>
        public string CurrentStateMachine
        {
            get { return Runner.CurrentStep.ToString(); }
        }
        #endregion
        public SRDSwitchOnRoutine(string module) : base(module)
        {
        }

        public void Abort()
        {
            Runner.Stop("Manual Abort");
        }

        public RState Monitor()
        {
            Runner.Run(SwitchOnStep.Arm, ArmAxisSwitchOn, CheckArmSwitchOn, _timeOut)
                .Run(SwitchOnStep.Rotation, RotationAxisSwitchOn, CheckRotationSwitchOn, _timeOut)
                .End(SwitchOnStep.End,NullFun);

            return Runner.Status; 
        }
       
        private bool ArmAxisSwitchOn()
        {
            return _armAxis.SwitchOn();
        }
        private bool CheckArmSwitchOn()
        {
            return _armAxis.IsSwitchOn&&_armAxis.Status==RState.End;
        }
        private bool RotationAxisSwitchOn()
        {
            return _rotationAxis.SwitchOn();
        }

        private bool CheckRotationSwitchOn()
        {
            return _rotationAxis.IsSwitchOn&&_rotationAxis.Status==RState.End;
        }


        public RState Start(params object[] objs)
        {
            _armAxis = DEVICE.GetDevice<JetAxisBase>($"{Module}.Arm");
            _rotationAxis = DEVICE.GetDevice<JetAxisBase>($"{Module}.Rotation");
            Runner.Start(Module, "SwitchOn");
            return RState.Running;
        }
    }
}