Control.cs 6.8 KB
using System;
using System.Collections.Generic;
using System.Diagnostics;
using System.Drawing;
using System.Threading;
using Model;

namespace BLL
{
    public class Control
    {
        private Timer timerCall;
        //private PointF[] position;
        //private DateTime[] timeout;

        public delegate void AgvChangedEvent(int agvIndex);
        public event AgvChangedEvent AgvChanged;
        public event AgvChangedEvent AgvOnline;

        public Control()
        {
            ThreadPool.SetMaxThreads(5, 5);  //线程池最大数量
        }

        public void Start()
        {
            //position = new PointF[Common.agvInfos.Count];
            //for (int i = 0; i < position.Length; i++)
            //    position[i] = new PointF();
            //timeout = new DateTime[Common.agvInfos.Count];
            //for (int i = 0; i < timeout.Length; i++)
            //    timeout[i] = DateTime.Now;
            timerCall = new Timer(CallProcess, null, 0, 2000);
        }

        public void Stop()
        {
            if (timerCall != null)
                timerCall.Dispose();
        }



        private void CallProcess(object obj)
        {
            for (int i = 0; i < Common.agvInfos.Count; i++)
            {
                AgvInfo info = Common.agvInfos[i];
                if (info.IsCall) continue;

                try
                {
                    info.IsCall = true;
                    CheckAgvOnline(info);
                    if (!info.IsOnline) continue;   //脱机
                    GetAgvState(info);
                    if (!info.IsAuto) continue;     //手动

                    if (info.StateID == (int)StateID.Pause)
                        Common.mir.State_Ready(info.IP, info.Authorization);

                    if (info.CurrentJob == null)
                    {
                        //软件刚打开时,防止有任务在运行
                        Common.mir.Del_Mission(info.IP, info.Authorization);
                        info.CurrentJob = new StandbyJob();
                    }
                    else
                    {
                        info.CurrentJob = info.CurrentJob.Execute(info);
                    }
                }
                catch (Exception ex)
                {
                    Common.log.Error("CallProcess " + info.Name, ex);
                }
                finally
                {
                    info.IsCall = false;
                }
            }
            UpdateBoard();
        }

        private void GetAgvState(AgvInfo info)
        {
            if (!info.IsOnline) return;
            bool rtn = Common.mir.Get_State(info.IP, info.Authorization, out int stateID, out string stateText, out int battery, out string missionText, out PointF position);
            //Common.log.Debug(string.Format("{0}[{1}] AgvState[{2}] stateID={3}, stateText={4}, battery={5}, missionText={6}, position={7}", info.Name, info.IP, rtn, stateID, stateText, battery, missionText, position.ToString()));

            if (rtn)
            {
                info.StateID = stateID;
                info.StateText = stateText;
                info.Battery = battery;
                info.MissionExplain = missionText;
                info.Position = position;
                int idx = Common.agvInfos.FindIndex(s => s.IP == info.IP);
                if (idx > -1) AgvChanged?.Invoke(idx);
            }
        }

        private void CheckAgvOnline(AgvInfo info)
        {
            bool rtn = Common.mir.CheckIP(info.IP);
            if (rtn)
            {
                if (!info.IsOnline)
                {
                    info.IsOnline = true;
                    int idx = Common.agvInfos.FindIndex(s => s.IP == info.IP);
                    if (idx > -1) AgvOnline?.Invoke(idx);
                    Common.log.Info(string.Format("{0}[{1}] 上线", info.Name, info.IP));
                }
            }
            else
            {
                if (info.IsOnline)
                {
                    info.IsOnline = false;
                    int idx = Common.agvInfos.FindIndex(s => s.IP == info.IP);
                    if (idx > -1) AgvOnline?.Invoke(idx);
                }
                Common.log.Warn(string.Format("{0}[{1}] 脱机", info.Name, info.IP));
            }
        }

        private void UpdateBoard()
        {
            //for (int i = 0; i < Common.agvInfos.Count; i++)
            //{
            //    if (Common.agvInfos[i].CurrentJob == null)
            //    {
            //        timeout[i] = DateTime.Now;
            //        continue;
            //    }

            //    string name = "";
            //    if (Common.agvInfos[i].Name.IndexOf("11") >= 0)
            //        name = "11号车";
            //    else if (Common.agvInfos[i].Name.IndexOf("13") >= 0)
            //        name = "13号车";

            //    if (Math.Abs(Common.agvInfos[i].Position.X - position[i].X) < 2 && Math.Abs(Common.agvInfos[i].Position.Y - position[i].Y) < 2)
            //    {
            //        TimeSpan span = DateTime.Now - timeout[i];
            //        if (span.TotalMinutes >= Common.BoardTimeout)
            //        {
            //            if (Common.agvInfos[i].CurrentJob is ChargeJob)
            //            {
            //                DisplayBoard.Add(name, "lineAgv." + name + ".Place", "AutoCharge", 1);
            //            }
            //            else if (Common.agvInfos[i].CurrentJob is StandbyJob)
            //            {
            //                DisplayBoard.Add(name, "lineAgv." + name + ".Place", "Standby", 1);
            //            }
            //            else
            //            {
            //                string value = string.Format("在{0}停留超时{1:F}分钟", Common.agvInfos[i].Place, span.TotalMinutes);
            //                DisplayBoard.Add(name, "lineAgv." + name + ".StandTimeOut", value, 0);
            //            }
            //        }
            //        else
            //        {
            //            DisplayBoard.Add(name, "lineAgv." + name + ".Msg", Common.agvInfos[i].CurrentJob.Msg, 1);
            //        }
            //    }
            //    else
            //    {
            //        DisplayBoard.Add(name, "lineAgv." + name + ".Msg", Common.agvInfos[i].CurrentJob.Msg, 1);
            //        timeout[i] = DateTime.Now;
            //        position[i] = new PointF(Common.agvInfos[i].Position.X, Common.agvInfos[i].Position.Y);
            //    }
            //}

            //DisplayBoard.UpdateAlarmMsg();
        }

        private enum StateID : int
        {
            None,
            Starting,
            ShuttingDown,
            Ready,
            Pause,
            Executing,
            Aborted,
            Completed,
            Docked,
            Docking,
            EmergencyStop,
            ManualControl,
            Error
        }

    }
}