Display_D_HP/TeamAAS-VM/Core/Management.cs

using Basler.Pylon;
using Cognex.VisionPro;
using Cognex.VisionPro.ToolBlock;
using CSScripting;
using CSScriptLib;
using MathNet.Numerics.Distributions;
using MathNet.Numerics.LinearAlgebra;
using MathNet.Numerics.RootFinding;
using Newtonsoft.Json;
using NPOI.SS.Formula.Functions;
using NPOI.Util;
using Opc.Ua;
using OpenCvSharp;
using OpenCvSharp.Flann;
using Org.BouncyCastle.Crypto;
using Prism.Events;
using Prism.Ioc;
using Prism.Mvvm;
using Prism.Regions;
using Prism.Services.Dialogs;
using System;
using System.Collections;
using System.Collections.Generic;
using System.Collections.ObjectModel;
using System.ComponentModel;
using System.Data;
using System.Diagnostics;
using System.Drawing;
using System.IO;
using System.Linq;
using System.Net.Sockets;
using System.Reflection.Metadata;
using System.Security.Cryptography;
using System.Security.Policy;
using System.Text;
using System.Threading;
using System.Threading.Tasks;
using System.Windows;
using System.Windows.Documents;
using System.Windows.Forms;
using System.Windows.Interop;
using System.Windows.Media;
using System.Windows.Media.Media3D;
using Team.FFFeederService;
using Team.FFFeederService.Interfaces;
using TeamAAS_VP;
using TeamAAS_VP.Core.PLCs;
using TeamAAS_VP.Core.Robots;
using TeamAAS_VP.Core.ScrewDriver;
using TeamAAS_VP.Data;
using TeamAAS_VP.Enums;
using TeamAAS_VP.Events;
using TeamAAS_VP.Interfaces;
using TeamAAS_VP.Models;
using TeamAAS_VP.Models.Calibration;
using TeamAAS_VP.Models.Feeder;
using TeamAAS_VP.Models.Product;
using TeamAAS_VP.Models.Torque;
using TeamAAS_VP.Resources.Languages;
using TeamAAS_VP.Services;
using TeamAAS_VP.ViewModels.Home;
using TeamAAS_VP.Views.Product;
using TouchSocket.Core;
using TouchSocket.SerialPorts;
using TouchSocket.Sockets;
using static MaterialDesignThemes.Wpf.Theme.ToolBar;
using static Org.BouncyCastle.Math.EC.ECCurve;
using static System.Windows.Forms.AxHost;
using Timer = System.Threading.Timer;

namespace TeamAAS_VP.Core
{
    public class Management : BindableBase
    {
        #region 字段
        IRegionManager _regionManager;
        IEventAggregator _eventAggregator;
        IContainerProvider _container;
        IConfigService _configService;
        IRobotService _robotService;
        ICameraService _cameraService;
        IFeederService _feederService;
        IPlcService _plcService;
        ILightManagerService _lightManagerService;
        IProductService _productService;
        ICalibrationService _calibrationService;
        IRemoteCommandService _remoteCommandService;
        ISystemDatabaseService _systemDatabaseService;
        IMesService _mesService;

        Timer yieldtimer;
        private DateTime StartTime = DateTime.Now;
        SerialPortClient client;
        // Pressure collection
        /// <summary>
        /// 压力采集信号控制CTS
        /// </summary>
        private CancellationTokenSource _pressureCts;
        /// <summary>
        /// 压力采集超时CTS
        /// </summary>
        private CancellationTokenSource _pressureTimeoutCts;
        /// <summary>
        /// 压力采集CTS
        /// </summary>
        private CancellationTokenSource _pressureLinkedCts;
        /// <summary>
        /// 压力数据集合
        /// </summary>
        private List<(DateTime Timestamp, float Value)> _pressureSamples = new List<(DateTime, float)>();
        /// <summary>
        /// 采样间隔毫秒
        /// </summary>
        private int _pressureSampleIntervalMs = 50; //采样间隔毫秒
        /// <summary>
        /// 超时自动停止秒数
        /// </summary>
        private int _pressureMaxDurationSeconds = 30; //超时自动停止秒数
        List<LockResult> lockResultsAll = new List<LockResult>();//一个产品的总结果
        string productSn = "";//产品sn
        DateTime StartScrewTime = DateTime.Now;//开始锁附的时间
        #endregion

        #region 属性
        private ObservableCollection<ShowRender> _Renders;

        /// <summary>
        /// 显示界面
        /// </summary>
        public ObservableCollection<ShowRender> Renders
        {
            get { return _Renders; }
            set { SetProperty(ref _Renders, value); }
        }

        public BgCommunicate BgCommunicate { get; private set; }

        public BgModbusTcpCommunicate BgModbusTcpCommunicate { get; private set; }

        private ObservableCollection<StatusInfo> _Status = new ObservableCollection<StatusInfo>();

        /// <summary>
        /// 状态栏集合
        /// </summary>
        public ObservableCollection<StatusInfo> Status
        {
            get { return _Status; }
            set { SetProperty(ref _Status, value); }
        }

        private Int64 _TotalQuantity;
        /// <summary>
        /// 总产量
        /// </summary>
        public Int64 TotalQuantity
        {
            get { return _TotalQuantity; }
            set { SetProperty(ref _TotalQuantity, value); }
        }

        private Int64 _TotalQuantityToday;
        /// <summary>
        /// 当天的总产量
        /// </summary>
        public Int64 TotalQuantityToday
        {
            get { return _TotalQuantityToday; }
            set { SetProperty(ref _TotalQuantityToday, value); }
        }

        private Int64 _CurrentUPH;
        /// <summary>
        /// 当前的UPH
        /// </summary>
        public Int64 CurrentUPH
        {
            get { return _CurrentUPH; }
            set { SetProperty(ref _CurrentUPH, value); }
        }

        private XYD_ScrewDriver _ScrewDriver;
        public XYD_ScrewDriver ScrewDriver
        {
            get { return _ScrewDriver; }
            set { SetProperty(ref _ScrewDriver, value); }
        }

        public Dictionary<string, object> BackupObject { get; set; } = new Dictionary<string, object>();

        private string _SignalValue = "0";
        /// <summary>
        /// 扭力测量仪获取的最大值
        /// </summary>
        public string SignalValue
        {
            get { return _SignalValue; }
            set { SetProperty(ref _SignalValue, value); }
        }

        private NumberStatistics _NumStatistics;
        /// <summary>
        /// 数量（批头、吸嘴、供料器）
        /// </summary>
        public NumberStatistics NumStatistics
        {
            get { return _NumStatistics; }
            set { SetProperty(ref _NumStatistics, value); }
        }

        private double _CTtime;
        /// <summary>
        /// ct
        /// </summary>
        public double CTtime
        {
            get { return _CTtime; }
            set { SetProperty(ref _CTtime, value); }
        }

        private bool _TorqueStatus = false;

        public bool TorqueStatus
        {
            get { return _TorqueStatus; }
            set { _TorqueStatus = value; }
        }

        private ObservableCollection<DataFormCtq> _dfc = new ObservableCollection<DataFormCtq>();
        /// <summary>
        /// CTQ数据集合
        /// </summary>
        public ObservableCollection<DataFormCtq> DFC
        {
            get { return _dfc; }
            set { SetProperty(ref _dfc, value); }
        }
        #endregion

        #region 命令

        #endregion

        #region 事件

        #endregion

        public Management(IRegionManager regionManager, IEventAggregator ea, IContainerProvider container, IConfigService configService,
            IRobotService robotService, ICameraService cameraService, IFeederService feederService, IPlcService plcService, IProductService productService,
            ICalibrationService calibrationService, IRemoteCommandService remoteCommandService, ISystemDatabaseService systemDatabaseService, ILightManagerService lightManagerService,
            IMesService mesService)
        {
            _regionManager = regionManager;
            _eventAggregator = ea;
            _container = container;
            _configService = configService;
            _robotService = robotService;
            _cameraService = cameraService;
            _feederService = feederService;
            _plcService = plcService;
            _calibrationService = calibrationService;
            yieldtimer = new Timer(DoYieldTime, null, 10000, 1000);
            Renders = new ObservableCollection<ShowRender>();
            _productService = productService;
            _remoteCommandService = remoteCommandService;
            _systemDatabaseService = systemDatabaseService;
            _lightManagerService = lightManagerService;
            _mesService = mesService;
        }

        #region 读取配置参数
        public async Task ReadConfig()
        {
            await ReadNumber();
        }
        /// <summary>
        /// 读取数量配置
        /// </summary>
        public async Task ReadNumber()
        {
            try
            {
                NumStatistics = new NumberStatistics();
                var latestHeadChangeRecord = await _systemDatabaseService.GetLatestHeadChangeRecordAsync();
                if (latestHeadChangeRecord != null)
                {
                    NumStatistics.HeaderNum = latestHeadChangeRecord.CurrentLockCount;
                }

                var latestNozzleChangeRecord = await _systemDatabaseService.GetLatestNozzleChangeRecordAsync();
                if (latestNozzleChangeRecord != null)
                {
                    NumStatistics.NozzleNum = latestNozzleChangeRecord.CurrentLockCount;
                }

                NumStatistics.Feeder1Num = _configService.GetRemainingCountByFeederNumber(1);
                NumStatistics.Feeder2Num = _configService.GetRemainingCountByFeederNumber(2);

            }
            catch (Exception ex)
            {
                NumStatistics = new NumberStatistics();
                LogHelper.WriteLogError("加载数量配置文件时出错！", ex);
            }
        }
        #endregion

        #region 初始化硬件模块

        /// <summary>
        /// 初始化Feeder
        /// </summary>
        /// <returns></returns>
        public async Task<(bool IsSucceed, string Msg)> InitFeeders()
        {
            var feeders = _configService.GetAllFeeders();
            StringBuilder sb = new StringBuilder();
            foreach (var item in feeders)
            {
                _feederService.CreateFeeder(item.Id, item.FeederNo, item.FeederName, item.IP, item.Port, item.FeederBrand);
                var feeder = _feederService.GetFeeder(item.Id);
                Status.Add(new StatusInfo(item.Id, item.FeederName + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
                try
                {
                    feeder.FeederConnectionStatusChanged += Management_FeederConnectionStatusChanged;
                    await feeder.ConnectAsync();     //连接Feeder
                    //SendTaskMessage($"{item.FeederName}已连接!", MessageLevel.Debug);
                }
                catch (Exception ex)
                {
                    sb.AppendLine($"{item.FeederName}:{Lang.断开连接}![{ex.Message}]");
                    SendTaskMessage($"{item.FeederName}{Lang.断开连接}!", MessageLevel.Alarm);
                }
            }
            if (sb.Length == 0)
            {
                return (true, "");
            }
            else
            {
                return (false, sb.ToString());
            }
        }

        /// <summary>
        /// 初始化机器人
        /// </summary>
        /// <returns></returns>
        public async Task<(bool IsSucceed, string Msg)> InitRobots()
        {
            var robots = _configService.GetAllRobots();
            StringBuilder sb = new StringBuilder();
            foreach (var item in robots)
            {
                _robotService.CreateRobot(item.Id, item);

                try
                {
                    Status.Add(new StatusInfo(item.Id, item.RobotName + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
                    var robot = _robotService.GetRobot(item.Id);
                    robot.ReceivedEvent += Management_ReceivedEvent;
                    robot.SendEvent += Management_SendEvent;
                    robot.ConnectedEvent += Management_ConnectedEvent;
                    robot.DisconnectedEvent += Management_DisconnectedEvent;
                    await robot.ConnectAsync();     //连接Robot
                    SendTaskMessage($"{item.RobotName}{Lang.已连接}!", MessageLevel.Debug);
                }
                catch (Exception ex)
                {
                    sb.AppendLine($"{item.RobotName}:{Lang.断开连接}![{ex.Message}]");
                    SendTaskMessage($"{item.RobotName}{Lang.断开连接}!", MessageLevel.Alarm);
                }
            }
            if (sb.Length == 0)
            {
                return (true, "");
            }
            else
            {
                return (false, sb.ToString());
            }
        }

        /// <summary>
        /// 初始化PLC
        /// </summary>
        /// <returns></returns>
        public async Task<(bool IsSucceed, string Msg)> InitPlc()
        {
            var plcs = _configService.GetAllPlcs();
            StringBuilder sb = new StringBuilder();
            foreach (var item in plcs)
            {
                try
                {
                    _plcService.CreatePlc(item.Id, item);
                    var plc = _plcService.GetPlc(item.Id);
                    Status.Add(new StatusInfo(item.Id, item.Name + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
                    plc.ConnectChangedEvent += Management_PlcConnectChangedEvent;
                    await plc.ConnectAsync();     //连接PLC
                    //SendTaskMessage($"{item.Name}{Lang.已连接}!", MessageLevel.Debug);
                }
                catch (Exception ex)
                {
                    sb.AppendLine($"{item.Name}:{Lang.断开连接}![{ex.Message}]");
                    SendTaskMessage($"{item.Name}{Lang.断开连接}!", MessageLevel.Alarm);
                }
            }
            try
            {
                await WriteSystemParameterToPlcAsync(_configService.GetSystemConfiguration());
                RegisterPlcMonitorAddress();
            }
            catch (Exception ex)
            {
                LogHelper.WriteLogError(Lang.为PLC写入系统参数和订阅变量时出错, ex);
            }
            if (sb.Length == 0)
            {
                return (true, "");
            }
            else
            {
                return (false, sb.ToString());
            }
        }

        /// <summary>
        /// 初始化相机
        /// </summary>
        /// <returns></returns>
        public async Task<(bool IsSucceed, string Msg)> InitCameras()
        {
            var cameras = _configService.GetAllCameras();
            StringBuilder sb = new StringBuilder();
            foreach (var item in cameras)
            {

                try
                {
                    Renders.Add(new ShowRender() { Id = item.Id, CameraName = item.CameraName });
                    _cameraService.CreateCamera(item.Id, item);
                    var camera = _cameraService.GetCamera(item.Id);
                    Status.Add(new StatusInfo(item.Id, item.CameraName + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
                    camera.CameraConnectChangedEvent += Management_CameraConnectChangedEvent;
                    try
                    {
                        if (await camera.OpenDeviceAsync())
                        {
                            SendTaskMessage($"{item.CameraName}{Lang.已连接}!", MessageLevel.Debug);
                        }
                        else
                        {
                            SendTaskMessage($"{item.CameraName}{Lang.连接失败}!", MessageLevel.Alarm);
                            sb.AppendLine($"{item.CameraName}:{Lang.连接失败}!");
                        }
                    }
                    catch (Exception ex)
                    {
                        SendTaskMessage($"{item.CameraName}{ex.Message}!", MessageLevel.Alarm);
                        sb.AppendLine($"{item.CameraName}:{ex.Message}!");
                    }

                }
                catch (Exception ex)
                {
                    SendTaskMessage($"{item.CameraName}{Lang.连接失败}!", MessageLevel.Alarm);
                    sb.AppendLine($"{item.CameraName}:{Lang.连接失败}!:{ex.Message}");
                }

            }
            _container.Resolve<ShowVisionRenderViewModel>().Renders = Renders;

            if (sb.Length == 0)
            {
                return (true, "");
            }
            else
            {
                return (false, sb.ToString());
            }
        }

        /// <summary>
        /// 初始化光源控制器
        /// </summary>
        /// <returns></returns>
        public async Task<(bool IsSucceed, string Msg)> InitLightControllers()
        {
            var lightcontrollers = _configService.GetAllLightControllers();
            StringBuilder sb = new StringBuilder();
            foreach (var item in lightcontrollers)
            {
                try
                {
                    var lishtCtr = await _lightManagerService.RegisterControllerAsync(item.Id, item);
                    //var lightcontroller = _cameraService.GetLightController(item.Id);
                    //await lightcontroller.ConnectAsync();     //连接光源控制器
                    //SendTaskMessage($"{item.LightControllerName}{Lang.已连接}!", MessageLevel.Debug);
                }
                catch (Exception ex)
                {
                    //sb.AppendLine($"{item.LightControllerName}:{Lang.断开连接}![{ex.Message}]");
                    //SendTaskMessage($"{item.LightControllerName}{Lang.断开连接}!", MessageLevel.Alarm);
                }
            }
            if (lightcontrollers.Count > 0)
            {
                var result = await _lightManagerService.ConnectAllAsync();
                if (result)
                {
                    return (true, "");
                }
                else
                {
                    return (false, "Light Controller Connect Failed!");
                }
            }
            return (true, "");
            //if (sb.Length == 0)
            //{
            //    return (true, "");
            //}
            //else
            //{
            //    return (false, sb.ToString());
            //}
        }

        /// <summary>
        /// 初始化后台TCP服务器通讯
        /// </summary>
        public void InitBgTcp()
        {
            var config = _configService.GetBgTcp();
            try
            {
                BgCommunicate = new BgCommunicate(config);
                BgCommunicate.ConnectedEvent += BgCommunicate_ConnectedEvent;
                BgCommunicate.DisconnectedEvent += BgCommunicate_DisconnectedEvent;
                BgCommunicate.ReceivedEvent += BgCommunicate_ReceivedEvent;
                BgCommunicate.SendEvent += BgCommunicate_SendEvent;
                BgCommunicate.StartListening();
                SendTaskMessage($"{Lang.已开启监听端口}：{config.Port}", MessageLevel.Debug);
            }
            catch (Exception ex)
            {
                SendTaskMessage($"{Lang.未开启监听端口}：{config.Port}", MessageLevel.Error);
                LogHelper.WriteLogError(Lang.开启后台服务器通讯时出错, ex);
            }
        }

        /// <summary>
        /// 初始化后台ModbusTCP从站
        /// </summary>
        public void InitModbusTcp()
        {
            try
            {
                var config = _configService.GetBgModbusTcp();
                BgModbusTcpCommunicate = new BgModbusTcpCommunicate(config);
                if (config.IsEnabled)
                {
                    BgModbusTcpCommunicate.Listen();
                    SendTaskMessage($"Start Modbus Tcp Slave：{BgModbusTcpCommunicate.IP}:{BgModbusTcpCommunicate.Port}:{BgModbusTcpCommunicate.SlaveID}", MessageLevel.Debug);
                }
            }
            catch (Exception ex)
            {
                SendTaskMessage($"No Start Modbus Tcp Slave：{ex.Message}", MessageLevel.Alarm);
                LogHelper.WriteLogError(Lang.开启后台ModbusTCP通讯时出错, ex);
            }
        }

        /// <summary>
        /// 初始化后台脚本
        /// </summary>
        public void InitBackgroundcript()
        {
            try
            {
                if (!Directory.Exists(FilePath.BackgroundScriptPath))
                {
                    Directory.CreateDirectory(FilePath.BackgroundScriptPath);
                }

                try
                {
                    string[] files = Directory.GetFiles(FilePath.BackgroundScriptPath);
                    List<string> ScriptFilesCollection = new List<string>();
                    foreach (string file in files)
                    {
                        string fileName = Path.GetFileName(file);
                        string fileExtension = Path.GetExtension(file);
                        if (fileExtension == ".cs")
                        {
                            ScriptFilesCollection.Add(file);
                        }
                    }
                    foreach (var item in ScriptFilesCollection)
                    {
                        try
                        {
                            string script = FileHelper.ReadFile(item);
                            SendTaskMessage($"{Lang.执行脚本}:{item}", MessageLevel.Info);
                            Task.Factory.StartNew(() =>
                            {
                                ScriptHelper.ExecuteScriptingAsync(script, _regionManager, _eventAggregator, _container, rst =>
                            {
                                if (!rst.Item1)
                                {
                                    foreach (var err in rst.Item2)
                                    {
                                        SendTaskMessage($"{Lang.后台脚本出错}:{err}", MessageLevel.Error);
                                    }
                                }
                            });
                            });
                        }
                        catch (Exception ex)
                        {
                            LogHelper.WriteLogError(string.Format(Lang.开启脚本时出错0, item), ex);
                        }
                    }
                }
                catch (Exception ex)
                {
                    LogHelper.WriteLogError(Lang.读取本地脚本文件列表时出错, ex);
                }
            }
            catch (Exception ex)
            {
                LogHelper.WriteLogError(Lang.开启后台脚本时出错, ex);
            }
        }

        /// <summary>
        /// 初始化电批
        /// </summary>
        /// <returns></returns>
        public async Task InitScrewDriver()
        {
            try
            {

                var screwDriverConfig = _configService.GetScrewDriverConfig();
                ScrewDriver = new XYD_ScrewDriver(screwDriverConfig.IPAdress, screwDriverConfig.Port);
                Status.Add(new StatusInfo(ScrewDriver.Id, Lang.电批未连接, new SolidColorBrush(Colors.Red)));
                ScrewDriver.ConnectStateChangedEvent += ScrewDriver_ConnectStateChangedEvent;
                ScrewDriver.SendTimeout = screwDriverConfig.SendTimeout;
                screwDriverConfig.ReceiveTimeout = screwDriverConfig.ReceiveTimeout;
                var isConnected = await ScrewDriver.ConnectAsync();
                if (isConnected)
                {
                    SendTaskMessage(Lang.电批已连接, MessageLevel.Debug);
                }
                else
                {
                    SendTaskMessage(Lang.电批连接失败, MessageLevel.Error);
                }
            }
            catch (Exception ex)
            {
                SendTaskMessage(string.Format(Lang.电批连接失败0, ex.Message), MessageLevel.Alarm);
                LogHelper.WriteLogError(Lang.连接电批时出错, ex);
            }
        }

        /// <summary>
        /// 初始化扭力测量仪
        /// </summary>
        /// <returns></returns>
        public async Task InitSignal()
        {

            var torqueConfig = _configService.GetTorqueReaderConfig();

            if (torqueConfig != null)
            {
                try
                {
                    var port = FileHelper.ReadJsonFile<TorqueProduceModel>(FilePath.TorqueReaderConfigurationPath);
                    if (string.IsNullOrEmpty(port.TorqueMeasureSerialPort))

                    {
                        client = new TouchSocket.SerialPorts.SerialPortClient();
                        client.Connecting = (client1, e) => { return EasyTask.CompletedTask; };//即将连接到端口
                        client.Connected = (client1, e) => { return EasyTask.CompletedTask; };//成功连接到端口
                        client.Closing = (client1, e) => { return EasyTask.CompletedTask; };//即将从端口断开连接。此处仅主动断开才有效。
                        client.Closed = (client1, e) => { return EasyTask.CompletedTask; };//从端口断开连接，当连接不成功时不会触发。
                        client.Received = async (c, e) =>
                        {
                            //await Console.Out.WriteLineAsync(Encoding.UTF8.GetString(e.ByteBlock.Buffer));
                            await Console.Out.WriteLineAsync(e.ByteBlock.Span.ToString(Encoding.ASCII));
                        };
                        client.Received = Sp_DataReceived;

                        await client.SetupAsync(new TouchSocketConfig()
                             .SetSerialPortOption(new SerialPortOption()
                             {
                                 BaudRate = torqueConfig.BaudRate,//波特率
                                 DataBits = torqueConfig.DataBits,//数据位
                                 Parity = torqueConfig.Parity,//校验位
                                 PortName = torqueConfig.PortName,//COM
                                 StopBits = torqueConfig.StopBits//停止位
                             })
                             .SetSerialDataHandlingAdapter(() => new PeriodPackageAdapter() { CacheTimeout = TimeSpan.FromMilliseconds(100) })
                             );

                        await client.ConnectAsync();
                    }
                    else
                    {
                        SendTaskMessage("请设置扭力测量仪串口！", MessageLevel.Error);
                    }
                }
                catch (Exception ex)
                {
                    LogHelper.WriteLogError("初始化扭力测量仪时出错！", ex);
                    SendTaskMessage("初始化扭力测量仪时出错！" + ex.Message, MessageLevel.Error);
                }
            }
            else
            {
                TorqueSerialPortConfig config = new TorqueSerialPortConfig();
                FileHelper.WriteJsonFile(config, FilePath.TorqueReaderConfigurationPath);
            }
        }
        #endregion

        #region 机器人指令执行

        public Dictionary<Guid, CancellationTokenSource> RobotTCPCollection = new Dictionary<Guid, CancellationTokenSource>();
        /// <summary>
        /// 机器人TCP接收
        /// </summary>
        /// <param name="arg1"></param>
        /// <param name="arg2"></param>
        /// <param name="arg3"></param>
        private async void Management_ReceivedEvent(Guid robotid, object arg2, TouchSocket.Sockets.ReceivedDataEventArgs e)
        {
            try
            {
                if (!RobotTCPCollection.ContainsKey(robotid))
                    RobotTCPCollection.Add(robotid, new CancellationTokenSource());
                else
                {
                    if (RobotTCPCollection[robotid].IsCancellationRequested)
                    {
                        RobotTCPCollection[robotid] = new CancellationTokenSource();
                    }
                }
                var robot = await _robotService.GetRobotAsync(robotid);
                //从服务器收到信息。但是一般byteBlock和requestInfo会根据适配器呈现不同的值。
                var buffer = e.ByteBlock.Span.ToString(robot.GetEncoding());
                SendTaskMessage($"{robot.Name}Received:{buffer}", MessageLevel.Info);

                var _ = _remoteCommandService.ExecuteAsync(buffer, RobotTCPCollection[robotid].Token, async msg =>
                {
                    try
                    {
                        if (robot.ConnectType == TCPConnectType.Client)
                        {
                            if (robot.IsConnected)
                            {
                                await robot.SendAsync($"{msg}");
                            }
                        }
                        else
                        {
                            var cient = (ITcpSessionClient)arg2;
                            if (cient.Online)
                            {
                                await robot.SendAsync(cient, $"{msg}");
                            }
                        }
                    }
                    catch (Exception ex)
                    {
                        LogHelper.WriteLogError(Lang.TCP发送数据时出错, ex);
                        SendTaskMessage(ex.Message, MessageLevel.Alarm);
                    }
                });
            }
            catch (Exception ex)
            {
                LogHelper.WriteLogError(Lang.处理机器人接收的命令时出错, ex);
                SendTaskMessage(ex.Message, MessageLevel.Alarm);
            }
        }

        #endregion

        #region 机器人&Feeder&相机连接状态事件
        /// <summary>
        /// 机器人发送事件
        /// </summary>
        /// <param name="arg1"></param>
        /// <param name="arg2"></param>
        /// <param name="arg3"></param>
        /// <exception cref="NotImplementedException"></exception>
        private void Management_SendEvent(Guid robotid, object arg2, string arg3)
        {
            var r = _robotService.GetRobot(robotid);
            SendTaskMessage($"{r.Name}Send:{arg3}", MessageLevel.Info);
        }

        /// <summary>
        /// 机器人断开连接时
        /// </summary>
        /// <param name="arg1"></param>
        /// <param name="arg2"></param>
        /// <param name="arg3"></param>
        /// <exception cref="NotImplementedException"></exception>
        private void Management_DisconnectedEvent(Guid robotid, object arg2, ClosedEventArgs arg3)
        {
            if (RobotTCPCollection.ContainsKey(robotid))
            {
                RobotTCPCollection[robotid].Cancel();
            }
            var r = _configService.GetRobot(robotid);
            if (r.ConnectType == TCPConnectType.Server)
            {
                ITcpSessionClient socketClient = arg2 as ITcpSessionClient;
                SendTaskMessage($"{r.RobotName}[{socketClient.Id}:{socketClient.IP}]{Lang.断开连接}！", MessageLevel.Error);

                var robot = _robotService.GetRobot(robotid);
                if (robot.TcpService.Count < 1)
                {
                    var sta = Status.FirstOrDefault(s => s.ID == robotid);
                    App.Current.Dispatcher.Invoke(new
                         Action(() =>
                         {
                             sta.Message = $"{r.RobotName}{Lang.未连接}";
                             sta.Background = new SolidColorBrush(Colors.Red);
                         }));

                }
            }
            else
            {
                SendTaskMessage($"{r.RobotName}{Lang.断开连接}！", MessageLevel.Error);
                var sta = Status.FirstOrDefault(s => s.ID == robotid);
                App.Current.Dispatcher.Invoke(new
                         Action(() =>
                         {
                             sta.Message = $"{r.RobotName}{Lang.断开连接}";
                             sta.Background = new SolidColorBrush(Colors.Red);
                         }));

            }
        }

        /// <summary>
        /// 机器人连接成功时
        /// </summary>
        /// <param name="arg1"></param>
        /// <param name="arg2"></param>
        /// <param name="arg3"></param>
        /// <exception cref="NotImplementedException"></exception>
        private void Management_ConnectedEvent(Guid robotid, object arg2, ConnectedEventArgs arg3)
        {
            var r = _configService.GetRobot(robotid);
            if (r.ConnectType == TCPConnectType.Server)
            {
                ITcpSessionClient socketClient = arg2 as ITcpSessionClient;
                SendTaskMessage($"{r.RobotName}[{socketClient.Id}:{socketClient.IP}]{Lang.已连接}！", MessageLevel.Debug);

                var robot = _robotService.GetRobot(robotid);
                if (robot.TcpService.Count > 0)
                {
                    var sta = Status.FirstOrDefault(s => s.ID == robotid);
                    App.Current.Dispatcher.Invoke(new
                         Action(() =>
                         {
                             sta.Message = $"{r.RobotName}{Lang.已连接}";
                             sta.Background = new SolidColorBrush(Colors.Green);
                         }));

                }
            }
            else
            {
                SendTaskMessage($"{r.RobotName}{Lang.已连接}！", MessageLevel.Debug);
                var sta = Status.FirstOrDefault(s => s.ID == robotid);
                App.Current.Dispatcher.Invoke(new
                         Action(() =>
                         {
                             sta.Message = $"{r.RobotName}{Lang.已连接}";
                             sta.Background = new SolidColorBrush(Colors.Green);
                         }));

            }
        }

        /// <summary>
        /// Feeder连接状态改变时
        /// </summary>
        /// <param name="sender"></param>
        /// <param name="state"></param>
        private void Management_FeederConnectionStatusChanged(object sender, bool state)
        {
            IFeeder feeder = sender as IFeeder;
            var sta = Status.FirstOrDefault(s => s.ID == feeder.Id);
            if (state)
            {
                App.Current.Dispatcher.Invoke(new
                         Action(() =>
                         {
                             sta.Message = $"{feeder.Name}{Lang.已连接}";
                             sta.Background = new SolidColorBrush(Colors.Green);
                         }));

                SendTaskMessage($"{feeder.Name}{Lang.已连接}！", MessageLevel.Debug);
            }
            else
            {
                App.Current.Dispatcher.Invoke(new
                         Action(() =>
                         {
                             sta.Message = $"{feeder.Name}{Lang.未连接}";
                             sta.Background = new SolidColorBrush(Colors.Red);
                         }));

                SendTaskMessage($"{feeder.Name}{Lang.断开连接}！", MessageLevel.Error);
            }
        }

        /// <summary>
        /// 相机连接或者断开时
        /// </summary>
        /// <param name="id"></param>
        /// <param name="state"></param>
        private void Management_CameraConnectChangedEvent(Guid id, bool state)
        {
            var sta = Status.FirstOrDefault(s => s.ID == id);
            var camera = _configService.GetCamera(id);
            if (sta != null && camera != null)
            {
                if (state)
                {
                    App.Current.Dispatcher.Invoke(new Action(() =>
                    {
                        sta.Message = $"{camera.CameraName}{Lang.已连接}";
                        sta.Background = new SolidColorBrush(Colors.Green);
                    }));

                }
                else
                {
                    App.Current.Dispatcher.Invoke(new Action(() =>
                    {
                        sta.Message = $"{camera.CameraName}{Lang.断开连接}";
                        sta.Background = new SolidColorBrush(Colors.Red);
                    }));
                }
            }
        }

        /// <summary>
        /// PLC连接状态改变事件
        /// </summary>
        /// <param name="plc"></param>
        /// <param name="isconnected"></param>
        private async void Management_PlcConnectChangedEvent(object sender, bool isconnected)
        {
            IPlc plc = sender as IPlc;
            var sta = Status.FirstOrDefault(s => s.ID == plc.Id);
            if (plc.IsConnected)
            {
                SendTaskMessage($"{plc.Name}{Lang.已连接}！", MessageLevel.Debug);
                if (sta == null) return;
                App.Current.Dispatcher.Invoke(new
                         Action(() =>
                         {
                             sta.Message = $"{plc.Name}{Lang.已连接}";
                             sta.Background = new SolidColorBrush(Colors.Green);
                         }));
                try
                {
                    await WriteSystemParameterToPlcAsync(_configService.GetSystemConfiguration());
                    await WritePositionToPlcAsync();
                }
                catch (Exception ex)
                {
                    LogHelper.WriteLogError("PLC连接成功时，写入系统参数和点位信息时出错！", ex);
                }
            }
            else
            {
                SendTaskMessage($"{plc.Name}{Lang.断开连接}！", MessageLevel.Error);
                if (sta == null) return;
                App.Current.Dispatcher.Invoke(new
                         Action(() =>
                         {
                             sta.Message = $"{plc.Name}{Lang.未连接}";
                             sta.Background = new SolidColorBrush(Colors.Red);
                         }));
            }
        }

        /// <summary>
        /// 电批连接状态改变时
        /// </summary>
        /// <param name="screwDevice"></param>
        /// <param name="state"></param>
        private void ScrewDriver_ConnectStateChangedEvent(object screwDevice, bool state)
        {
            try
            {
                XYD_ScrewDriver screwDriver = screwDevice as XYD_ScrewDriver;
                if (state)
                {
                    SendTaskMessage(Lang.电批已连接, MessageLevel.Debug);
                    var sta = Status.FirstOrDefault(s => s.ID == screwDriver.Id);
                    App.Current.Dispatcher.Invoke(new
                         Action(() =>
                         {
                             sta.Message = Lang.电批已连接;
                             sta.Background = new SolidColorBrush(Colors.Green);
                         }));
                }
                else
                {
                    SendTaskMessage(Lang.电批未连接, MessageLevel.Error);
                    var sta = Status.FirstOrDefault(s => s.ID == screwDriver.Id);
                    App.Current.Dispatcher.Invoke(new
                         Action(() =>
                         {
                             sta.Message = Lang.电批未连接;
                             sta.Background = new SolidColorBrush(Colors.Red);
                         }));
                }
            }
            catch (Exception ex)
            {
                LogHelper.WriteLogError(Lang.电批连接状态改变时出错了, ex);
            }
        }
        #endregion

        #region 后台服务器通讯事件
        private void BgCommunicate_SendEvent(ITcpSessionClient client, string msg)
        {
            SendTaskMessage($"{Lang.服务器}[{client.ServicePort}] Send To {Lang.客户端}[{client.Id}:{client.IP}]:{msg}", MessageLevel.Info);
        }

        public Dictionary<string, CancellationTokenSource> BgCommunicateollection = new Dictionary<string, CancellationTokenSource>();
        private async void BgCommunicate_ReceivedEvent(ITcpSessionClient client, string msg)
        {

            try
            {
                if (!BgCommunicateollection.ContainsKey(client.Id))
                {
                    BgCommunicateollection.Add(client.Id, new CancellationTokenSource());
                }

                SendTaskMessage($"{Lang.服务器}[{client.ServicePort}]ReceiveFor{Lang.客户端}[{client.Id}:{client.IP}]:{msg}", MessageLevel.Info);
                var _ = _remoteCommandService.ExecuteAsync(msg, BgCommunicateollection[client.Id].Token, async response =>
                {
                    try
                    {
                        if (!client.Online)
                        {
                            return;
                        }
                        await BgCommunicate.SendAsync(client, $"{response}");
                    }
                    catch (Exception ex)
                    {
                        LogHelper.WriteLogError(Lang.后台TCP发送数据时出错, ex);
                        SendTaskMessage(ex.Message, MessageLevel.Alarm);
                    }
                });
            }
            catch (Exception ex)
            {
                LogHelper.WriteLogError(Lang.处理后台服务器接收的命令时出错, ex);
                SendTaskMessage(ex.Message, MessageLevel.Alarm);
            }
        }

        private void BgCommunicate_DisconnectedEvent(ITcpSessionClient client, ClosedEventArgs e)
        {
            SendTaskMessage($"{Lang.服务器}[{client.ServicePort}]{Lang.客户端}[{client.Id}:{client.IP}]{Lang.断开连接}!", MessageLevel.Alarm);
            if (BgCommunicateollection.ContainsKey(client.Id))
            {
                BgCommunicateollection[client.Id].Cancel();
            }
        }

        private void BgCommunicate_ConnectedEvent(ITcpSessionClient client, ConnectedEventArgs e)
        {
            SendTaskMessage($"{Lang.服务器}[{client.ServicePort}]{Lang.客户端}[{client.Id}:{client.IP}]{Lang.连接成功}!", MessageLevel.Debug);
        }

        /// <summary>
        /// 扭力测量仪接收信息
        /// </summary>
        /// <param name="client"></param>
        /// <param name="e"></param>
        /// <returns></returns>
        private async Task Sp_DataReceived(ISerialPortClient client, ReceivedDataEventArgs e)
        {
            try
            {
                string poname = client.MainSerialPort.PortName;
                string data = e.ByteBlock.Span.ToString(Encoding.ASCII);
                await Console.Out.WriteLineAsync(data);
                string response = data.Split('\r')[0];
                SendTaskMessage($"{poname}Receive:{response}", MessageLevel.Info);
                SignalValue = "";
                SignalValue = response;
            }
            catch (Exception ex)
            {
                LogHelper.WriteLogError("扭力测量仪接收信息时出错！", ex);
                SendTaskMessage("扭力测量仪接收信息时出错！" + ex.Message, MessageLevel.Error);
                Thread.Sleep(50);
            }
        }
        #endregion

        #region PLC
        /// <summary>
        /// 将系统参数写入PLC
        /// </summary>
        /// <param name="systemConfiguration"></param>
        /// <returns></returns>
        public async Task WriteSystemParameterToPlcAsync(SystemConfiguration systemConfiguration)
        {
            var addressConfig = _configService.GetPlcAddresses();
            var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
            if (plc == null || !plc.IsConnected) return;
            Dictionary<string, object> nodeValues = new Dictionary<string, object>();
            nodeValues.Add(addressConfig.Out_WorkMode.Address, (Int16)systemConfiguration.WorkMode);
            nodeValues.Add(addressConfig.Out_PickPointNum.Address, (Int16)systemConfiguration.PickPointNum);
            nodeValues.Add(addressConfig.Out_DowmCameraNum.Address, (Int16)systemConfiguration.DowmCameraNum);
            nodeValues.Add(addressConfig.Out_UpCameraPickNum.Address, (Int16)systemConfiguration.UpCameraPickNum);
            nodeValues.Add(addressConfig.Out_UpCameraPutNum.Address, (Int16)systemConfiguration.UpCameraPutNum);
            nodeValues.Add(addressConfig.Out_UPCameracheckNum.Address, (Int16)systemConfiguration.UPCameracheckNum);
            nodeValues.Add(addressConfig.Out_FixedCameraPickNum.Address, (Int16)systemConfiguration.FixedCameraPickNum);
            nodeValues.Add(addressConfig.Out_FixedCameraPutNum.Address, (Int16)systemConfiguration.FixedCameraPutNum);
            nodeValues.Add(addressConfig.Out_FixedCameracheckNum.Address, (Int16)systemConfiguration.FixedCameracheckNum);
            nodeValues.Add(addressConfig.Out_ScrewTeachNum.Address, (Int16)systemConfiguration.ScrewTeachNum);

            var res = await plc.WriteNodesAsync(nodeValues);
        }

        /// <summary>
        /// 注册需要监控的PLC地址
        /// </summary>
        public void RegisterPlcMonitorAddress()
        {
            var addressConfig = _configService.GetPlcAddresses();
            var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
            if (plc == null || !plc.IsConnected) return;

            //PLC地址数组
            List<string> monitorNodeIds = new List<string>()
            {
                addressConfig.In_DowmCameraExe.Address,
                addressConfig.In_UpCameraPickExe.Address,
                addressConfig.In_UpCameraPutExe.Address,
                addressConfig.In_UPCameracheckExe.Address,
                addressConfig.In_FixedCameraPickExe.Address,
                addressConfig.In_FixedCameraPutExe.Address,
                addressConfig.In_FixedCameracheckExe.Address,
                addressConfig.In_WorkStart.Address,
                addressConfig.In_WorkDone.Address,
                //addressConfig.In_MesCheck.Address,
                addressConfig.In_RequestPosition.Address,
                addressConfig.In_QrCodePhotoRequest.Address,
                addressConfig.In_ScrewTeachExe.Address,
                addressConfig.In_PickINC.Address,
            };
            for (int i = 0; i < 10; i++)
            {
                monitorNodeIds.Add(string.Format(addressConfig.In_MesCheck.Address, i));
            }
            //订阅PLC地址变化
            plc.SubscribeNodes("AutoSensor", monitorNodeIds, PlcCommandTrigger);
        }

        /// <summary>
        /// 写入点位信息给PLC
        /// </summary>
        /// <returns></returns>
        public async Task WritePositionToPlcAsync()
        {
            var addressConfig = _configService.GetPlcAddresses();
            var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
            if (plc == null || !plc.IsConnected) return;
            var current = _productService.GetCurrentProduct();
            if (current == null) return;
            if (current.PickCameraPoints != null && current.PickCameraPoints.Count > 0)
            {
                foreach (var item in current.PickCameraPoints)
                {
                    await item.WriteToPlcAddress(addressConfig.Out_PickCamera, plc);
                }
            }

            if (current.PickPoints != null && current.PickPoints.Count > 0)
            {
                foreach (var item in current.PickPoints)
                {
                    await item.WriteToPlcAddress(addressConfig.Out_Pick, plc);
                }
            }
            if (current.SecPosCameraPoints != null && current.SecPosCameraPoints.Count > 0)
            {
                foreach (var item in current.SecPosCameraPoints)
                {
                    await item.WriteToPlcAddress(addressConfig.Out_SecPosCamera, plc);
                }
            }
            if (current.ScrewCameraPoints != null && current.ScrewCameraPoints.Count > 0)
            {
                foreach (var item in current.ScrewCameraPoints)
                {
                    await item.WriteToPlcAddress(addressConfig.Out_ScrewCamera, plc);
                }
            }
            if (current.ScrewPoints != null && current.ScrewPoints.Count > 0)
            {
                foreach (var item in current.ScrewPoints)
                {
                    await item.WriteToPlcAddressEx(addressConfig.Out_Screw, plc);
                }
                await plc.WriteNodeAsync(addressConfig.Out_WorkNum.Address, (Int16)current.ScrewPoints.Count);
            }
            if (current.CheckCameraPoints != null && current.CheckCameraPoints.Count > 0)
            {
                foreach (var item in current.CheckCameraPoints)
                {
                    await item.WriteToPlcAddress(addressConfig.Out_CheckCamera, plc);
                }
            }
            if (current.QrCodePoints != null && current.QrCodePoints.Count > 0)
            {
                foreach (var item in current.QrCodePoints)
                {
                    await item.WriteToPlcAddress(addressConfig.Out_QrCodeCamera, plc);
                }
            }
        }

        PointF[] DowmCameraResults = new PointF[10];
        PointF[] UpCameraPutResults = new PointF[10];

        bool _LastDowmCameraExe = false;
        bool _LastScrewTeachExe = false;
        bool _LastUpCameraPickExe = false;
        bool _LastUpCameraPutExe = false;
        bool _LastUPCameracheckExe = false;
        bool _LastFixedCameraPickExe = false;
        bool _LastFixedCameraPutExe = false;
        bool _LastFixedCameracheckExe = false;
        Int16 _LastWorkStart = 0;
        Int16 _LastWorkDone = 0;
        Int16 _LastRequestPosition = 0;
        Int16 _LastQrCodePhotoRequest = 0;
        Int16[] _LastMesCheck = new Int16[10];
        Int16 _LastPickINC = 0;
        DateTime[] _LastMesCheckTime = new DateTime[10];
        /// <summary>
        /// PLC命令触发时
        /// </summary>
        /// <param name="tuple"></param>
        private async void PlcCommandTrigger((string key, string nodeId, object value) tuple)
        {
            try
            {
                if (tuple.key != "AutoSensor")
                {
                    return;
                }

                var addressConfig = _configService.GetPlcAddresses();
                var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
                if (plc == null || !plc.IsConnected) return;
                // 获取当前产品
                var currentProduct = _productService.GetCurrentProduct();
                if (currentProduct == null)
                {
                    return;
                }

                //获取产品编码
                _productService.CurrentProductCode = plc.ReadNode<string>(string.Format(addressConfig.In_Code.Address, 0));
                //如果产品编码为空，则以当前的时间戳作为编码
                if (string.IsNullOrEmpty(_productService.CurrentProductCode))
                {
                    _productService.CurrentProductCode = DateTime.Now.ToString("yyyyMMddHHmmssfff");
                }

                // 触发下相机拍照
                if (addressConfig.In_DowmCameraExe.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is bool state)
                    {
                        if (_LastDowmCameraExe != state)
                        {
                            _LastDowmCameraExe = state;
                        }
                        else
                        {
                            return;
                        }

                        if (state)
                        {
                            SendTaskMessage(Lang.触发下相机拍照, MessageLevel.Debug);
                            //相机的编号
                            Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_DowmCameraNum.Address);
                            SendTaskMessage(string.Format(Lang.编号0, cameraIndex), MessageLevel.Info);

                            // 获取流程
                            var process = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
                            if (process == null)
                            {
                                SendTaskMessage(string.Format(Lang.固定向上相机1视觉流程流程ID0, currentProduct.FixedUpCamera1ProcedureId), MessageLevel.Alarm);
                                await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
                                return;
                            }

                            // 获取机器人当前坐标
                            var robot = _robotService.GetAllRobots().FirstOrDefault();
                            if (robot == null)
                            {
                                SendTaskMessage(Lang.未找到机器人无法执行上相机锁附组装拍照视觉任务, MessageLevel.Alarm);
                                await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
                                return;

                            }
                            var currentPosition = robot.GetRobotPos();

                            // 执行视觉任务
                            var _cts = new CancellationTokenSource();
                            var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, null, _cts.Token, cameraIndex, null);
                            if (visionResult.IsSucceed)
                            {
                                //披头偏差
                                float offsetX = (float)(visionResult.X - currentPosition.X);
                                float offsetY = (float)(visionResult.Y - currentPosition.Y);

                                DowmCameraResults[cameraIndex] = new PointF(offsetX, offsetY);
                                await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
                                return;
                            }
                            else
                            {
                                await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
                                return;
                            }
                        }
                        else
                        {
                            SendTaskMessage(Lang.触发下相机拍照信号已关闭, MessageLevel.Alarm);
                            await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)0);
                        }
                    }
                }
                // 触发下相机拍照披头
                if (addressConfig.In_ScrewTeachExe.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is bool state)
                    {
                        if (_LastScrewTeachExe != state)
                        {
                            _LastScrewTeachExe = state;
                        }
                        else
                        {
                            return;
                        }

                        if (state)
                        {
                            SendTaskMessage(Lang.触发下相机拍照, MessageLevel.Debug);
                            //相机的编号
                            Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_DowmCameraNum.Address);
                            SendTaskMessage(string.Format(Lang.编号0, cameraIndex), MessageLevel.Info);

                            // 获取流程
                            var process = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
                            if (process == null)
                            {
                                SendTaskMessage(string.Format(Lang.固定向上相机1视觉流程流程ID0, currentProduct.FixedUpCamera1ProcedureId), MessageLevel.Alarm);
                                await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)2);
                                return;
                            }

                            // 获取机器人当前坐标
                            var robot = _robotService.GetAllRobots().FirstOrDefault();
                            if (robot == null)
                            {
                                SendTaskMessage(Lang.未找到机器人无法执行上相机锁附组装拍照视觉任务, MessageLevel.Alarm);
                                await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)2);
                                return;

                            }
                            var currentPosition = robot.GetRobotPos();

                            // 执行视觉任务
                            var _cts = new CancellationTokenSource();
                            var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, null, _cts.Token, cameraIndex, null);
                            if (visionResult.IsSucceed)
                            {
                                //披头偏差
                                float offsetX = (float)(visionResult.X - currentPosition.X);
                                float offsetY = (float)(visionResult.Y - currentPosition.Y);

                                DowmCameraResults[cameraIndex] = new PointF(offsetX, offsetY);
                                await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)1);
                                return;
                            }
                            else
                            {
                                await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)2);
                                return;
                            }
                        }
                        else
                        {
                            SendTaskMessage(Lang.触发下相机拍照信号已关闭, MessageLevel.Alarm);
                            await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)0);
                        }
                    }
                }
                // 触发上相机取料拍照
                else if (addressConfig.In_UpCameraPickExe.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is bool state)
                    {
                        if (_LastUpCameraPickExe != state)
                        {
                            _LastUpCameraPickExe = state;
                        }
                        else
                        {
                            return;
                        }

                        if (state)
                        {
                            SendTaskMessage(Lang.触发上相机取料拍照, MessageLevel.Debug);
                            //相机的编号
                            //Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_UpCameraPickNum.Address);


                            await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)1);
                        }
                        else
                        {
                            SendTaskMessage(Lang.触发上相机取料拍照信号已关闭, MessageLevel.Alarm);
                            await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)0);
                        }
                    }
                }
                // 上相机锁附/组装拍照
                else if (addressConfig.In_UpCameraPutExe.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is bool state)
                    {
                        if (_LastUpCameraPutExe != state)
                        {
                            _LastUpCameraPutExe = state;
                        }
                        else
                        {
                            return;
                        }

                        if (state)
                        {
                            SendTaskMessage(Lang.触发上相机锁附组装拍照, MessageLevel.Debug);
                            //相机的编号
                            Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_UpCameraPutNum.Address);
                            SendTaskMessage(string.Format(Lang.编号0, cameraIndex), MessageLevel.Info);

                            //视觉流程ID
                            Guid procedureId = currentProduct.MoveDownCameraLockPhotoProcedureId;

                            //获取锁付拍照的点位
                            var pos = currentProduct.ScrewCameraPoints.FirstOrDefault(p => p.Number == cameraIndex);
                            if (pos != null)
                            {
                                procedureId = pos.VisionProcessID;
                            }

                            // 获取流程
                            var process = _productService.GetCurrentProductProcedureModelById(procedureId);
                            if (process == null)
                            {
                                SendTaskMessage(string.Format(Lang.未找到上相机锁附组装拍照对应的视觉流程流程ID0, procedureId), MessageLevel.Alarm);
                                await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
                                return;
                            }

                            // 获取机器人当前坐标
                            var robot = _robotService.GetAllRobots().FirstOrDefault();
                            if (robot == null)
                            {
                                SendTaskMessage(Lang.未找到机器人无法执行上相机锁附组装拍照视觉任务, MessageLevel.Alarm);
                                await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
                                return;

                            }
                            var currentPosition = robot.GetRobotPos();

                            // 执行视觉任务
                            var _cts = new CancellationTokenSource();
                            var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, cameraIndex, null);
                            if (visionResult.IsSucceed)
                            {
                                //是拍一个锁一个还是拍两个点锁所有
                                var systemConfig = _configService.GetSystemConfiguration();
                                //拍1打1 
                                if (systemConfig.WorkMode == 1)
                                {
                                    UpCameraPutResults[1] = new PointF((float)visionResult.X, (float)visionResult.Y);
                                }
                                else
                                {
                                    UpCameraPutResults[cameraIndex] = new PointF((float)visionResult.X, (float)visionResult.Y);
                                }

                                await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)1);
                            }
                            else
                            {
                                await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
                            }
                        }
                        else
                        {
                            SendTaskMessage(Lang.触发上相机锁附组装拍照信号已关闭, MessageLevel.Alarm);
                            await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)0);
                        }
                    }
                }
                // 上相机检测拍照
                else if (addressConfig.In_UPCameracheckExe.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is bool state)
                    {
                        if (_LastUPCameracheckExe != state)
                        {
                            _LastUPCameracheckExe = state;
                        }
                        else
                        {
                            return;
                        }
                        if (state)
                        {
                            SendTaskMessage(Lang.触发上相机检测拍照, MessageLevel.Debug);
                            //相机的编号
                            Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.Out_UPCameracheckNum.Address);
                            SendTaskMessage(string.Format(Lang.编号0, cameraIndex), MessageLevel.Info);

                            //视觉流程ID
                            Guid procedureId = Guid.Empty;
                            //获取锁付拍照的点位
                            var pos = currentProduct.CheckCameraPoints.FirstOrDefault(p => p.Number == cameraIndex);
                            if (pos != null)
                            {
                                procedureId = pos.VisionProcessID;
                            }

                            // 获取流程
                            var process = _productService.GetCurrentProductProcedureModelById(procedureId);
                            if (process == null)
                            {
                                SendTaskMessage(string.Format("未找到点位：{0}的视觉流程：{1}", cameraIndex, procedureId), MessageLevel.Alarm);
                                await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)2);
                                return;
                            }

                            // 执行视觉任务
                            var _cts = new CancellationTokenSource();
                            var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, null, _cts.Token, cameraIndex, null);
                            if (visionResult.IsSucceed)
                            {
                                await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)1);
                                SendTaskMessage($"点位{cameraIndex}检测OK", MessageLevel.Debug);
                            }
                            else
                            {
                                await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)2);
                                SendTaskMessage($"点位{cameraIndex}检测NG", MessageLevel.Error);
                            }
                        }
                        else
                        {
                            SendTaskMessage(Lang.触发上相机检测拍照信号已关闭, MessageLevel.Alarm);
                            await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)0);
                        }
                    }
                }
                // 固定相机取料拍照
                else if (addressConfig.In_FixedCameraPickExe.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is bool state)
                    {
                        if (_LastFixedCameraPickExe != state)
                        {
                            _LastFixedCameraPickExe = state;
                        }
                        else
                        {
                            return;
                        }
                        if (state)
                        {
                            SendTaskMessage(Lang.触发固定相机取料拍照, MessageLevel.Debug);
                            //相机的编号
                            //Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_FixedCameraPickNum.Address);



                            await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPickStatus.Address, (Int16)1);
                        }
                        else
                        {
                            SendTaskMessage(Lang.触发固定相机取料拍照信号已关闭, MessageLevel.Alarm);
                            await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPickStatus.Address, (Int16)0);
                        }
                    }
                }
                // 固定相机锁附/组装拍照
                else if (addressConfig.In_FixedCameraPutExe.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is bool state)
                    {
                        if (_LastFixedCameraPutExe != state)
                        {
                            _LastFixedCameraPutExe = state;
                        }
                        else
                        {
                            return;
                        }
                        if (state)
                        {
                            SendTaskMessage(Lang.触发固定相机锁附组装拍照, MessageLevel.Debug);
                            //相机的编号
                            //Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_FixedCameraPutNum.Address);


                            await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)1);
                        }
                        else
                        {
                            SendTaskMessage(Lang.触发固定相机锁附组装拍照信号已关闭, MessageLevel.Alarm);
                            await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)0);
                        }
                    }
                }
                // 固定相机检测拍照
                else if (addressConfig.In_FixedCameracheckExe.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is bool state)
                    {
                        if (_LastFixedCameracheckExe != state)
                        {
                            _LastFixedCameracheckExe = state;
                        }
                        else
                        {
                            return;
                        }
                        if (state)
                        {
                            SendTaskMessage(Lang.触发固定相机检测拍照, MessageLevel.Debug);
                            //相机的编号
                            //Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_FixedCameracheckNum.Address);


                            await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)1);
                        }
                        else
                        {
                            SendTaskMessage(Lang.触发固定相机检测拍照信号已关闭, MessageLevel.Alarm);
                            await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)0);
                        }
                    }
                }
                // 开始锁付
                else if (addressConfig.In_WorkStart.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is Int16 state)
                    {
                        if (_LastWorkStart != state)
                        {
                            _LastWorkStart = state;
                        }
                        else
                        {
                            return;
                        }
                        if (state == 1)
                        {
                            SendTaskMessage(Lang.收到开始锁付信号, MessageLevel.Debug);
                            StartScrewTime = DateTime.Now;
                            //位置编号
                            Int16 positionIndex = plc.ReadNode<Int16>(addressConfig.In_ProductNum.Address);
                            SendTaskMessage(string.Format(Lang.编号0, positionIndex), MessageLevel.Info);
                            // 开始采集压力值
                            StartPressureCollection(currentProduct.Name, _productService.CurrentProductCode, positionIndex);
                        }
                        else
                        {
                            SendTaskMessage(Lang.开始锁付信号已关闭, MessageLevel.Alarm);
                            // 关闭时的处理（如需）可放在这里
                        }
                    }
                }
                // 停止锁付
                else if (addressConfig.In_WorkDone.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is Int16 state)
                    {
                        if (_LastWorkDone != state)
                        {
                            _LastWorkDone = state;
                        }
                        else
                        {
                            return;
                        }
                        if (state == 1 || state == 2)
                        {
                            if (TorqueStatus)
                            {
                                
                            }
                            SendTaskMessage(Lang.收到停止锁付信号, MessageLevel.Debug);
                            //位置编号
                            Int16 positionIndex = plc.ReadNode<Int16>(addressConfig.In_ProductNum.Address);
                            SendTaskMessage(string.Format(Lang.编号0, positionIndex), MessageLevel.Info);
                            //获取当前锁付点
                            var screwPoint = currentProduct.ScrewPoints.FirstOrDefault(p => p.Number == positionIndex);
                            //获取当前的机器人点位
                            var robot = _robotService.GetAllRobots().FirstOrDefault();
                            var currentPosition = robot.GetRobotPos();
                            //读取压力值
                            float pressure = plc.ReadNode<float>(addressConfig.In_PressureValue.Address);
                            //当前用户名
                            string currentUserName = _systemDatabaseService.GetCurrentUser().UserName;

                            //吸嘴最后一次的记录
                            var nozzleRecord = await _systemDatabaseService.GetLatestNozzleChangeRecordAsync();
                            //最后一次的吸嘴编号
                            string nozzleNumber = nozzleRecord != null ? nozzleRecord.NozzleBatchNumber : "N/A";
                            //披头最后一次的记录
                            var headRecord = await _systemDatabaseService.GetLatestHeadChangeRecordAsync();
                            //最后一次的披头编号
                            string headNumber = headRecord != null ? headRecord.HeadBatchNumber : "N/A";
                            var cdata = _configService.GetCTQDataInfo();//获取ctq数据参数

                            await Task.Delay(60);
                            //获取电批结果
                            bool isSucced = ScrewDriver.GetData();
                            LockResult lockResult = new LockResult();
                            lockResult.ScrewdriverGetDataSucceed = isSucced;
                            lockResult.Number = positionIndex;
                            lockResult.LockPassed = ScrewDriver.Success;
                            lockResult.ProductName = currentProduct.Name;
                            lockResult.ProductNumber = _productService.CurrentProductCode;
                            lockResult.LockTurns = (float)ScrewDriver.Truns;
                            lockResult.LockTorque = (float)ScrewDriver.TorqueValue;
                            lockResult.LockDuration = (float)ScrewDriver.FinalTime;
                            lockResult.ScrewdriverProgramNumber = ScrewDriver.ProgramNumber;
                            lockResult.ResultDetails = ScrewDriver.ErrorInfo;
                            lockResult.Pressure = pressure;
                            lockResult.TargetTorqueUpperLimit = ScrewDriver.TargetTorqueUpperLimit;
                            lockResult.TargetTorqueLowerLimit = ScrewDriver.TargetTorqueLowerLimit;
                            lockResult.TargetTurnsUpperLimit = ScrewDriver.TargetTurnsUpperLimit;
                            lockResult.TargetTurnsLowerLimit = ScrewDriver.TargetTurnsLowerLimit;
                            lockResult.TargetLockSpeed = ScrewDriver.TargetLockSpeed;
                            lockResult.PositionX = currentPosition.X;
                            lockResult.PositionY = currentPosition.Y;
                            lockResult.StartPositionZ = screwPoint.Z_Position_Start;
                            lockResult.EndPositionZ = currentPosition.Z;
                            lockResult.LockDescentSpeed = screwPoint.Z_Velocity_Stop;
                            lockResult.FeederNumber = screwPoint != null ? screwPoint.Feeder : 0;
                            lockResult.NozzleNumber = nozzleNumber;
                            lockResult.HeadNumber = headNumber;
                            lockResult.OperatorName = currentUserName;
                            lockResult.ProductImagePath = "";
                            lockResult.WaveDatas = ScrewDriver.WaveDatas;
                            //获取系统参数
                            var systemConfig = _configService.GetSystemConfiguration();
                            //判断是否保存锁付曲线
                            if (systemConfig.IsSaveScrewCurve)
                            {
                                //锁付曲线的保存路径为：systemConfig.ScrewCurvePath//年月//年月日//配方名//产品SN//产品SN+螺丝索引
                                string datePath = DateTime.Now.ToString("yyyy-MM") + "\\" + DateTime.Now.ToString("yyyy-MM-dd") + "\\";
                                string dirPath = System.IO.Path.Combine(systemConfig.ScrewCurvePath, datePath, currentProduct.Name, lockResult.ProductNumber);
                                if (!Directory.Exists(dirPath))
                                {
                                    Directory.CreateDirectory(dirPath);
                                }
                                string curveFileName = $"{lockResult.ProductNumber}-{lockResult.Number}.png";
                                //锁付CSV保存路径
                                string curveFileFullPath = System.IO.Path.Combine(dirPath, $"{lockResult.ProductNumber}-{lockResult.Number}.csv");

                                //锁付曲线保存路径
                                lockResult.LockCurveImagePath = System.IO.Path.Combine(dirPath, curveFileName);
                                var _ = lockResult.SaveToCsvAsync(curveFileFullPath);
                            }

                            lockResultsAll.Add(lockResult);
                            App.Current.Dispatcher.Invoke(() =>
                            {
                                _eventAggregator.GetEvent<LockFinishNotification>().Publish(lockResult);
                            });
                            //记录锁付结果至数据库
                            await _systemDatabaseService.RecordLockResultAsync(lockResult);
                            //披头数量+1
                            NumStatistics.HeaderNum = await _systemDatabaseService.IncrementLatestHeadLockCountAsync(currentUserName);
                            //吸嘴数量+1
                            NumStatistics.NozzleNum = await _systemDatabaseService.IncrementLatestNozzleLockCountAsync(currentUserName);


                            await plc.WriteNodeAsync(addressConfig.In_WorkDone.Address, (Int16)0);
                            // 停止采集压力并保存
                            await StopAndSavePressureCollectionAsync(currentProduct.Name, _productService.CurrentProductCode, positionIndex);

                            DFC.Clear();
                            DFC.Add(new DataFormCtq
                            {
                                PPID = productSn,
                                PROCESS_NAME = cdata.PROCESS_NAME,
                                PROCESS_START_TIME = StartScrewTime.ToString(),
                                CTQ_NAME = "Torque",
                                CTQ_VALUE = lockResult.LockTorque,
                                CTQ_LSL = lockResult.TargetTorqueLowerLimit,
                                CTQ_USL = lockResult.TargetTorqueUpperLimit,
                                PROCESS_END_TIME = DateTime.Now.ToString(),
                                SUPPLIER_NAME = cdata.SUPPLIER_NAME,
                                COMMODITY_TYPE = cdata.COMMODITY_TYPE,
                                REVISION = cdata.REVISION,
                                WO = cdata.WO,
                                MFG_LOT = cdata.MFG_LOT,
                                MFG_ASSY_LINE = cdata.MFG_ASSY_LINE,
                                PROCESS_OUTCOME = lockResult.LockPassed ? "PASS" : "FAIL",
                                PROCESS_MACHINE_ID = cdata.PROCESS_MACHINE_ID,
                                CTQ_UNIT_OF_MEASURE = "kgf.cm",
                                ERROR_MESSAGE = lockResult.LockPassed ? "" : "Torque_Spec OOS"
                            });
                            DFC.Add(new DataFormCtq
                            {
                                PPID = productSn,
                                PROCESS_NAME = cdata.PROCESS_NAME,
                                PROCESS_START_TIME = StartScrewTime.ToString(),
                                CTQ_NAME = "Turn",
                                CTQ_VALUE = lockResult.LockTurns,
                                CTQ_LSL = lockResult.TargetTurnsLowerLimit,
                                CTQ_USL = lockResult.TargetTurnsUpperLimit,
                                PROCESS_END_TIME = DateTime.Now.ToString(),
                                SUPPLIER_NAME = cdata.SUPPLIER_NAME,
                                COMMODITY_TYPE = cdata.COMMODITY_TYPE,
                                REVISION = cdata.REVISION,
                                WO = cdata.WO,
                                MFG_LOT = cdata.MFG_LOT,
                                MFG_ASSY_LINE = cdata.MFG_ASSY_LINE,
                                PROCESS_OUTCOME = lockResult.LockPassed ? "PASS" : "FAIL",
                                PROCESS_MACHINE_ID = cdata.PROCESS_MACHINE_ID,
                                CTQ_UNIT_OF_MEASURE = "圈",
                                ERROR_MESSAGE = lockResult.LockPassed ? "" : "Turn_Spec OOS"
                            });
                            DFC.Add(new DataFormCtq
                            {
                                PPID = productSn,
                                PROCESS_NAME = cdata.PROCESS_NAME,
                                PROCESS_START_TIME = StartScrewTime.ToString(),
                                CTQ_NAME = "Pressure",
                                CTQ_VALUE = lockResult.Pressure,
                                CTQ_LSL = cdata.CTQ_LSL_Pressure,
                                CTQ_USL = cdata.CTQ_USL_Pressure,
                                PROCESS_END_TIME = DateTime.Now.ToString(),
                                SUPPLIER_NAME = cdata.SUPPLIER_NAME,
                                COMMODITY_TYPE = cdata.COMMODITY_TYPE,
                                REVISION = cdata.REVISION,
                                WO = cdata.WO,
                                MFG_LOT = cdata.MFG_LOT,
                                MFG_ASSY_LINE = cdata.MFG_ASSY_LINE,
                                PROCESS_OUTCOME = lockResult.LockPassed ? "PASS" : "FAIL",
                                PROCESS_MACHINE_ID = cdata.PROCESS_MACHINE_ID,
                                CTQ_UNIT_OF_MEASURE = "N",
                                ERROR_MESSAGE = lockResult.LockPassed ? "" : "Pressure_Spec OOS"
                            });
                            foreach (var item in DFC)
                            {
                                FileHelper.WriteDataToCSV(item);
                            }
                        }
                        else
                        {
                            SendTaskMessage(Lang.停止锁付信号已关闭, MessageLevel.Alarm);
                        }
                    }
                }
                // 多相机坐标合并
                else if (addressConfig.In_RequestPosition.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is Int16 state)
                    {
                        if (_LastRequestPosition != state)
                        {
                            _LastRequestPosition = state;
                        }
                        else
                        {
                            return;
                        }
                        if (state == 1)
                        {
                            SendTaskMessage(Lang.收到多相机坐标合并请求开始合并, MessageLevel.Debug);
                            //位置编号
                            Int16 positionIndex = plc.ReadNode<Int16>(addressConfig.In_ProductNum.Address);
                            //是拍一个锁一个还是拍两个点锁所有
                            var systemConfig = _configService.GetSystemConfiguration();
                            //拍1打1 
                            if (systemConfig.WorkMode == 1)
                            {
                                var point = currentProduct.ScrewPoints.FirstOrDefault(p => p.Number == positionIndex);
                                if (point == null)
                                {
                                    SendTaskMessage($"点：{positionIndex}不存在", MessageLevel.Info);
                                    await plc.WriteNodeAsync(addressConfig.Out_CameraDone.Address, (Int16)2);
                                    return;
                                }
                                point = point.Clone();
                                point.X_Position = UpCameraPutResults[1].X + DowmCameraResults[1].X;
                                point.Y_Position = UpCameraPutResults[1].Y + DowmCameraResults[1].Y;
                                SendTaskMessage($"点：{positionIndex}，{point.X_Position:F3}，{point.Y_Position:F4}", MessageLevel.Info);
                                await point.WriteToPlcAddress(addressConfig.Out_Screw, plc);
                            }
                            //拍1打所有
                            else if (systemConfig.WorkMode == 2)
                            {
                                //根据UpCameraPutResults[]中的索引1、2，和拍照点对应的Local下的坐标，从创建Local坐标系
                                PointF worldP1 = new PointF(UpCameraPutResults[1].X, UpCameraPutResults[1].Y);
                                PointF worldP2 = new PointF(UpCameraPutResults[2].X, UpCameraPutResults[2].Y);
                                PointF localP1 = new PointF(currentProduct.ScrewCameraLocalPos1.X_Position, currentProduct.ScrewCameraLocalPos1.Y_Position);
                                PointF localP2 = new PointF(currentProduct.ScrewCameraLocalPos2.X_Position, currentProduct.ScrewCameraLocalPos2.Y_Position);
                                CoordinateTransformer local = new CoordinateTransformer(worldP1, worldP2, localP1, localP2);

                                for (int i = 0; i < currentProduct.ScrewPoints.Count; i++)
                                {
                                    var localPoint = new PointF(currentProduct.ScrewPoints[i].X_Position + currentProduct.ScrewPoints[i].X_Offset,
                                        currentProduct.ScrewPoints[i].Y_Position + currentProduct.ScrewPoints[i].Y_Offset);
                                    var worldPoint = local.ToOldCoord(localPoint.X, localPoint.Y);
                                    var point = currentProduct.ScrewPoints[i].Clone();

                                    //锁付点位在Local中已经加了偏移，这里写回PLC时需要将偏移清零，否则写入PLC端时会重复计算偏移
                                    point.X_Offset = 0;
                                    point.Y_Offset = 0;
                                    point.X_Position = (float)worldPoint[0];
                                    point.Y_Position = (float)worldPoint[1];
                                    SendTaskMessage($"点：{i}，{point.X_Position:F3}，{point.Y_Position:F4}", MessageLevel.Info);
                                    await point.WriteToPlcAddress(addressConfig.Out_Screw, plc);
                                }
                                await plc.WriteNodeAsync(addressConfig.Out_WorkNum.Address, (Int16)currentProduct.ScrewPoints.Count);
                            }
                            await plc.WriteNodeAsync(addressConfig.Out_CameraDone.Address, (Int16)1);
                        }
                        else
                        {
                            SendTaskMessage(string.Format(Lang.多相机坐标合并请求已结束或被取消state0, state), MessageLevel.Alarm);
                            await plc.WriteNodeAsync(addressConfig.Out_CameraDone.Address, (Int16)0);
                        }
                    }
                }
                // PLC请求二维码拍照位置
                else if (addressConfig.In_QrCodePhotoRequest.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is Int16 state)
                    {
                        if (_LastQrCodePhotoRequest != state)
                        {
                            _LastQrCodePhotoRequest = state;
                        }
                        else
                        {
                            return;
                        }

                        if (state == 1)
                        {
                            SendTaskMessage("收到PLC二维码拍照位置请求", MessageLevel.Debug);
                            if (currentProduct.QrCodePoints == null || currentProduct.QrCodePoints.Count == 0)
                            {
                                SendTaskMessage("未找到示教后的二维码拍照点位", MessageLevel.Alarm);
                                await plc.WriteNodeAsync(addressConfig.Out_QrCodePhotoResault.Address, (Int16)2);
                                return;
                            }
                            var qrpoint = currentProduct.QrCodePoints[0];
                            //发送点位
                            bool SendSuccess = await qrpoint.WriteToPlcAddress(addressConfig.Out_QrCodeCamera, plc);
                            if (SendSuccess)
                            {
                                SendTaskMessage("二维码拍照点位发送成功", MessageLevel.Alarm);
                                await plc.WriteNodeAsync(addressConfig.Out_QrCodePhotoResault.Address, (Int16)1);

                                Guid qrCodeProcedureId = currentProduct.QrCodeProcedureId;
                                if (qrCodeProcedureId == Guid.Empty)
                                {
                                    // 如果没有配置二维码视觉流程，直接返回成功
                                    SendTaskMessage("未配置二维码视觉流程，跳过扫码", MessageLevel.Info);
                                    return;
                                }
                            }
                            else
                            {
                                SendTaskMessage("二维码拍照点位发送失败", MessageLevel.Alarm);
                                await plc.WriteNodeAsync(addressConfig.Out_QrCodePhotoResault.Address, (Int16)2);
                            }
                        }
                        else
                        {
                            SendTaskMessage("二维码拍照点位发送信号已关闭", MessageLevel.Alarm);
                        }
                    }

                }
                // 螺丝供料器螺丝递减
                else if (addressConfig.In_PickINC.Address.Contains(tuple.nodeId))
                {
                    if (tuple.value is Int16 state)
                    {
                        if (_LastPickINC != state)
                        {
                            _LastPickINC = state;
                        }
                        else
                        {
                            return;
                        }
                        if (state != 0)
                        {
                            SendTaskMessage($"螺丝供料器...", MessageLevel.Info);
                            await plc.WriteNodeAsync(addressConfig.In_PickINC.Address, (Int16)0);

                            var feeders = _configService.GetRemainingCountByFeederNumber(state);
                            if (state == 1)
                            {
                                NumStatistics.Feeder1Num = _configService.DecrementScrewCountByFeederNumber(feeders);
                            }
                            else if (state == 2)
                            {
                                NumStatistics.Feeder2Num = _configService.DecrementScrewCountByFeederNumber(feeders);
                            }
                        }
                    }
                }
                // 过站检查
                else
                {
                    for (int i = 0; i < 10; i++)
                    {
                        if (string.Format(addressConfig.In_MesCheck.Address, i).Contains(tuple.nodeId))
                        {
                            if (tuple.value is Int16 state)
                            {
                                if (_LastMesCheck[i] != state)
                                {
                                    _LastMesCheck[i] = state;
                                }
                                else
                                {
                                    return;
                                }

                                string code = "";
                                //plc启用的模式
                                bool models = plc.ReadNode<bool>(addressConfig.Cam_code_mode.Address);

                                if (models && state == 1)
                                {
                                    //拍照读码
                                    SendTaskMessage(Lang.触发上相机锁附组装拍照, MessageLevel.Debug);
                                    //相机的编号
                                    Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_UpCameraPutNum.Address);
                                    SendTaskMessage(string.Format(Lang.编号0, cameraIndex), MessageLevel.Info);

                                    Guid qrCodeProcedureId = currentProduct.QrCodeProcedureId;

                                    //视觉流程ID
                                    var qrCodeProcess = _productService.GetCurrentProductProcedureModelById(qrCodeProcedureId);
                                    if (qrCodeProcess == null)
                                    {
                                        SendTaskMessage($"未找到二维码视觉流程，流程ID: {qrCodeProcedureId}", MessageLevel.Alarm);
                                        await plc.WriteNodeAsync(addressConfig.Out_QrCodePhotoResault.Address, (Int16)2);
                                        return;
                                    }
                                    SendTaskMessage($"开始执行二维码扫码视觉流程", MessageLevel.Debug);
                                    var _cts = new CancellationTokenSource();

                                    await _remoteCommandService.SetLightBeforePhoto(qrCodeProcess);
                                    var qrCodeResult = _remoteCommandService.ExecutePhoto(qrCodeProcess, out CogToolBlockTerminalCollection outputCollection);

                                    if (qrCodeResult && outputCollection.Contains("QR"))
                                    {
                                        code = outputCollection["QR"].Value as string;
                                        SendTaskMessage($"二维码扫码成功:{code}", MessageLevel.Info);
                                        await plc.WriteNodeAsync(addressConfig.Out_QrCodePhotoResault.Address, (Int16)1);
                                    }
                                    else
                                    {
                                        code = "";
                                        SendTaskMessage("二维码扫码失败", MessageLevel.Alarm);
                                        await plc.WriteNodeAsync(addressConfig.Out_QrCodePhotoResault.Address, (Int16)2);
                                        return;
                                    }
                                }
                                else
                                {
                                    code = plc.ReadNode<string>(string.Format(addressConfig.In_Code.Address, i));
                                    //code = "JSTEST045";
                                }
                                productSn = code;

                                //询问mes
                                if (state == 1)
                                {
                                    //这里缺少从MES获取产品配方的内容，需要补充

                                    _LastMesCheckTime[i] = DateTime.UtcNow;
                                    LogHelper.WriteLogMes($"【mes开始QUERY】");
                                    SendTaskMessage($"mes开始QUERY", MessageLevel.Info);
                                    (bool isSuccess, string response) = await _mesService.StationGetAsync(code,"", 2);//询问mes
                                    if (i == 0)
                                    {
                                        SendTaskMessage($"收到当前过站检查请求（当站是否生产）...", MessageLevel.Debug);
                                    }
                                    else
                                    {
                                        SendTaskMessage($"收到{i}过站检查请求（当站是否生产）...", MessageLevel.Debug);
                                    }
                                    if (isSuccess)
                                    {
                                        //产品发生改变并且供料器发生了变化时，需要通知PLC进行取料更改
                                        await plc.WriteNodeAsync(addressConfig.Out_ScrewFeederIsChanged.Address, (Int16)1); //不发生改变
                                        await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)1);

                                        LogHelper.WriteLogMes($"询问mes成功");
                                        SendTaskMessage($"询问mes成功", MessageLevel.Debug);
                                    }
                                    else
                                    {
                                        //产品发生改变并且供料器发生了变化时，需要通知PLC进行取料更改
                                        await plc.WriteNodeAsync(addressConfig.Out_ScrewFeederIsChanged.Address, (Int16)1); //不发生改变
                                        await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)2);

                                        LogHelper.WriteLogMes($"询问mes失败");
                                        SendTaskMessage($"询问mes失败:{response}", MessageLevel.Error);
                                    }
                                    LogHelper.WriteLogMes($"【mes结束QUERY】");
                                    SendTaskMessage($"mes结束QUERY", MessageLevel.Info);
                                }
                                // 上传本站数据
                                else if (state == 2)
                                {
                                    SendTaskMessage($"收到{i}上传本站数据请求...", MessageLevel.Debug);

                                    //这里缺少上传MES的本站数据结果及开始和结束时间，需要补充

                                    if (i == 0)
                                    {
                                        CTtime = DateTime.UtcNow.Subtract(_LastMesCheckTime[i]).TotalSeconds;
                                    }

                                    //读取产品结果
                                    Int16 resultIndex = plc.ReadNode<Int16>(string.Format(addressConfig.In_Result.Address, i));

                                    //目前只记录当前站
                                    if (i == 0)
                                        await _systemDatabaseService.RecordProductionAsync(new ProductionRecord()
                                        {
                                            ProductName = currentProduct.Name,
                                            ProductCode = code,
                                            DeviceId = i,
                                            DeviceName = "",
                                            Category = resultIndex == 1 ? "OK" : "NG",
                                            Quantity = 1,
                                            Remark = $"TotalSeconds:{DateTime.UtcNow.Subtract(_LastMesCheckTime[i]).TotalSeconds.ToString("F2")}",
                                        });

                                    LogHelper.WriteLogMes($"【mes开始ADD】");
                                    SendTaskMessage($"mes开始ADD", MessageLevel.Info);
                                    //上传mes
                                    string torque = ""; string pressure = ""; string turn = "";
                                    //string torque = "1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22" +
                                    //    "1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22" +
                                    //    "1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,61-3.33";
                                    //string pressure = "1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22" +
                                    //    "1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22" +
                                    //    "1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,61-3.33";
                                    //string turn = "1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22" +
                                    //    "1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22" +
                                    //    "1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,1-1.11,2-2.22,3-1.11,4-2.22,5-1.11,6-2.22,7-1.11,8-2.22,9-1.11,10-2.22,61-3.33";
                                    (bool isSuccess, string response) = await _mesService.SubmitGetAsync(code,"",torque,pressure,turn, resultIndex == 1 ? true : false, _LastMesCheckTime[i], DateTime.UtcNow);
                                    if (isSuccess)
                                    {
                                        LogHelper.WriteLogMes($"上传mes成功");
                                        SendTaskMessage($"上传mes成功", MessageLevel.Debug);
                                    }
                                    else
                                    {
                                        LogHelper.WriteLogMes($"上传mes失败");
                                        SendTaskMessage($"上传mes失败", MessageLevel.Error);
                                    }
                                    await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)3);

                                    WriteProductLog(lockResultsAll, code, CTtime);

                                    LogHelper.WriteLogMes($"【mes结束ADD】");
                                    SendTaskMessage($"mes结束ADD", MessageLevel.Info);
                                }
                                else
                                {
                                    SendTaskMessage($"{i}过站检查信号：state={state}，处理为默认状态", MessageLevel.Alarm);
                                    await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)0);
                                }
                            }
                        }
                    }

                }
            }
            catch (Exception ex)
            {
                SendTaskMessage(ex.Message, MessageLevel.Error);
            }
        }

        #endregion

        #region 方法

        public void SendTaskMessage(string msg, MessageLevel level)
        {
            App.Current.Dispatcher.Invoke(() =>
            {
                _eventAggregator.GetEvent<TaskMessageNotification>().Publish(new Models.MessageStruct() { Message = msg, level = level });
            });
        }

        #region Pressure collection helpers
        /// <summary>
        /// 开始采集压力值
        /// </summary>
        /// <param name="productName">配方名称</param>
        /// <param name="productCode">产品编号</param>
        /// <param name="positionIndex">锁付点编号</param>
        private void StartPressureCollection(string productName, string productCode, int positionIndex)
        {
            try
            {
                // cancel existing if any
                _pressureCts?.Cancel();
                _pressureTimeoutCts?.Cancel();
                _pressureLinkedCts?.Dispose();
                _pressureSamples?.Clear();

                _pressureCts = new CancellationTokenSource();
                _pressureTimeoutCts = new CancellationTokenSource();

                // timeout after configured seconds
                _pressureTimeoutCts.CancelAfter(TimeSpan.FromSeconds(_pressureMaxDurationSeconds));

                // link tokens so either stop or timeout cancels
                _pressureLinkedCts = CancellationTokenSource.CreateLinkedTokenSource(_pressureCts.Token, _pressureTimeoutCts.Token);

                var token = _pressureLinkedCts.Token;
                var addressConfig = _configService.GetPlcAddresses();
                var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
                if (plc == null || !plc.IsConnected) return;
                Task.Run(async () =>
                {
                    SendTaskMessage($"Pressure collection started for position {positionIndex}", MessageLevel.Debug);
                    while (!token.IsCancellationRequested)
                    {
                        try
                        {
                            float pressure = plc.ReadNode<float>(addressConfig.In_PressureValue.Address);
                            lock (_pressureSamples)
                            {
                                _pressureSamples.Add((DateTime.Now, pressure));
                            }
                        }
                        catch (Exception ex)
                        {
                            LogHelper.WriteLogError("采集压力值时出错", ex);
                        }
                        await Task.Delay(_pressureSampleIntervalMs);
                    }
                    // if cancelled due to timeout
                    if (_pressureTimeoutCts.IsCancellationRequested && !_pressureCts.IsCancellationRequested)
                    {
                        SendTaskMessage("Pressure collection timed out, saving collected data.", MessageLevel.Alarm);
                        await StopAndSavePressureCollectionAsync(productName, productCode, positionIndex);
                    }
                }, token);
            }
            catch (Exception ex)
            {
                LogHelper.WriteLogError("StartPressureCollection error", ex);
            }
        }

        /// <summary>
        /// 停止采集并保存压力数据
        /// </summary>
        /// <param name="productName"></param>
        /// <param name="productCode"></param>
        /// <param name="positionIndex"></param>
        /// <returns></returns>
        private async Task StopAndSavePressureCollectionAsync(string productName, string productCode, int positionIndex)
        {
            try
            {
                // cancel sampling
                _pressureCts?.Cancel();
                // allow worker to observe cancel
                await Task.Delay(50);

                List<(DateTime Timestamp, float Value)> snapshot;
                lock (_pressureSamples)
                {
                    snapshot = new List<(DateTime, float)>(_pressureSamples);
                }

                if (snapshot.Count == 0)
                {
                    SendTaskMessage("No pressure samples collected.", MessageLevel.Info);
                    return;
                }

                // save to file under configured path
                try
                {
                    //获取系统参数
                    var systemConfig = _configService.GetSystemConfiguration();
                    //判断是否保存锁付曲线
                    if (systemConfig.IsSaveScrewCurve)
                    {
                        string basePath = systemConfig?.ScrewCurvePath ?? Environment.GetFolderPath(Environment.SpecialFolder.MyDocuments);
                        string datePath = DateTime.Now.ToString("yyyy-MM") + "\\" + DateTime.Now.ToString("yyyy-MM-dd") + "\\";
                        string dirPath = Path.Combine(basePath, datePath, productName ?? "UnknownProduct", productCode ?? DateTime.Now.ToString("yyyyMMddHHmmssfff"));
                        if (!Directory.Exists(dirPath)) Directory.CreateDirectory(dirPath);
                        string fileName = $"pressure-{productCode}-{positionIndex}-{DateTime.Now.ToString("HHmmss")}.csv";
                        string fullPath = Path.Combine(dirPath, fileName);
                        var sb = new StringBuilder();
                        sb.AppendLine("Timestamp,Value");
                        foreach (var s in snapshot)
                        {
                            sb.AppendLine($"{s.Timestamp:O},{s.Value}");
                        }

                        File.WriteAllText(fullPath, sb.ToString());
                        SendTaskMessage($"Pressure samples saved to {fullPath}", MessageLevel.Debug);
                    }
                }
                catch (Exception ex)
                {
                    LogHelper.WriteLogError("保存压力采样文件时出错", ex);
                    SendTaskMessage("保存压力采样文件时出错: " + ex.Message, MessageLevel.Error);
                }
            }
            catch (Exception ex)
            {
                LogHelper.WriteLogError("StopAndSavePressureCollectionAsync error", ex);
            }
            finally
            {
                try
                {
                    _pressureLinkedCts?.Cancel();
                    _pressureLinkedCts?.Dispose();
                    _pressureTimeoutCts?.Dispose();
                    _pressureCts?.Dispose();
                    _pressureSamples?.Clear();
                }
                catch { }
            }
        }
        #endregion

        private async void DoYieldTime(object state)
        {
            try
            {
                //获取当前产品
                var currentproduct = _productService.GetCurrentProduct();
                if (currentproduct == null) return;
                TotalQuantity = await _systemDatabaseService.GetOverallProductionAsync(currentproduct.Name);
                TotalQuantityToday = await _systemDatabaseService.GetTodayProductionAsync(currentproduct.Name);
                CurrentUPH = await _systemDatabaseService.GetLastHourProductionAsync(currentproduct.Name);
            }
            catch (Exception)
            {

            }
        }

        #region vm启动检测

        /// <summary>
        /// 杀死所有VM有关进程
        /// </summary>
        public void KillVMProcess()
        {
            KillProcess("VisionMasterServerApp");
            KillProcess("VisionMaster");
            KillProcess("VmModuleProxy.exe");
            KillProcess("vServerApp.exe");
        }

        /// <summary>
        /// 杀死指定进程名的进程
        /// </summary>
        /// <param name="strKillName"></param>
        public void KillProcess(string strKillName)
        {
            foreach (System.Diagnostics.Process p in System.Diagnostics.Process.GetProcesses())
            {
                if (p.ProcessName.Contains(strKillName))
                {
                    try
                    {
                        p.Kill();
                        p.WaitForExit();
                    }
                    catch (Exception ex)
                    {
                        LogHelper.WriteLogError(string.Format(Lang.杀死进程0时失败, strKillName), ex);
                    }
                }
            }
        }
        #endregion


        #region 产品锁付记录进行存储
        /// <summary>
        /// 产品锁付记录进行存储
        /// </summary>
        /// <param name="result">结果</param>
        public void WriteProductLog(List<LockResult> lockResults, string rfid, double ct)
        {
            try
            {
                string result = "";//产品的总结果
                foreach (var item in lockResults)
                {
                    result = "OK";
                    if (!item.LockPassed)
                    {
                        result = "NG";
                        break;
                    }
                }
                DateTime dt = DateTime.Now;
                int number = lockResults.Count;//螺丝数量
                string path = $"E:\\Data\\生产数据\\{dt.ToString("yyyy-MM")}\\{dt.ToString("yyyy-MM-dd")}.csv";
                StringBuilder sb = new StringBuilder();
                //具体的ct需要优化
                sb.Append($"{dt.ToString("yyyy-MM-dd HH:mm:ss")},{lockResults[0].ProductName},{Math.Round(ct, 3)},{rfid},{result},{lockResults[number - 1].NozzleNumber},{lockResults[number - 1].HeadNumber},");
                foreach (var item in lockResults)
                {
                    try
                    {
                        sb.Append($"{item.LockPassed},{item.ResultDetails},{item.LockTorque},{item.TargetTorqueUpperLimit},{item.TargetTorqueLowerLimit},{item.LockTurns},{item.TargetTurnsUpperLimit},{item.TargetTurnsLowerLimit},{item.Pressure},{item.PositionX},{item.PositionY},{item.StartPositionZ},{item.EndPositionZ},{item.LockDescentSpeed},");
                    }
                    catch (Exception)
                    {
                        sb.Append($",,,,,,,,,,,,,,");
                    }
                }
                //========================
                if (!Directory.Exists(Path.GetDirectoryName(path)))   //判断文件夹是否
                {
                    Directory.CreateDirectory(Path.GetDirectoryName(path));    //创建文件夹
                }

                if (File.Exists(path))
                {
                    // 使用 StreamWriter 以追加模式打开文件
                    StreamWriter sw = new StreamWriter(path, true, Encoding.UTF8);
                    sw.WriteLine(sb.ToString().TrimEnd(','));
                    sw.Close();
                    sw.Dispose();
                }
                else
                {
                    StreamWriter sw = new StreamWriter(path, true, Encoding.UTF8);
                    StringBuilder sb1 = new StringBuilder();
                    StringBuilder sb_up = new StringBuilder();
                    StringBuilder sb_down = new StringBuilder();
                    sb1.Append("时间,产品名称,CT,RFID,产品结果,吸嘴数量,披头数量,");
                    for (int i = 0; i < number; i++)
                    {
                        sb1.Append($"螺丝{i + 1}结果,螺丝{i + 1}结果详情,螺丝{i + 1}扭矩,螺丝{i + 1}扭矩上限,螺丝{i + 1}扭矩下限,螺丝{i + 1}圈数,螺丝{i + 1}圈数上限,螺丝{i + 1}圈数下限,螺丝{i + 1}压力值,螺丝{i + 1}锁附X,螺丝{i + 1}锁附Y,螺丝{i + 1}开始位置Z,螺丝{i + 1}结束位置Z,螺丝{i + 1}锁附下降速度,");
                    }
                    sw.WriteLine(sb1.ToString().TrimEnd(','));
                    sw.WriteLine(sb.ToString().TrimEnd(','));
                    sw.Close();
                    sw.Dispose();
                }
            }
            catch (Exception ex)
            {
                LogHelper.WriteLogError("写入产品记录时出错!", ex);
            }

            lockResultsAll.Clear();
        }
        #endregion

        #endregion
    }
}