diff --git a/头罩视野slove/头罩视野/Views/PageTest.xaml.cs b/头罩视野slove/头罩视野/Views/PageTest.xaml.cs index 6eb09d4..c0c9557 100644 --- a/头罩视野slove/头罩视野/Views/PageTest.xaml.cs +++ b/头罩视野slove/头罩视野/Views/PageTest.xaml.cs @@ -5,6 +5,7 @@ using Sunny.UI; //using RecordDateView; using System; using System.Collections.Generic; +using System.IO.Ports; using System.Net; using System.Net.Sockets; using System.Reflection.Metadata; @@ -292,49 +293,49 @@ namespace 头罩视野.Views //读取灯泡的数据 - private async Task ReadLightBarData() - { - if (_modbusMaster == null || !ModbusHelper.TcpClient.Connected) - return; + //private async Task ReadLightBarData() + //{ + // if (_modbusMaster == null || !ModbusHelper.TcpClient.Connected) + // return; - try - { - ushort[] registers = await _modbusMaster.ReadHoldingRegistersAsync(1, 350, 15); - var tempList = new List(240); // 240 是预期长度 + // try + // { + // ushort[] registers = await _modbusMaster.ReadHoldingRegistersAsync(1, 350, 15); + // var tempList = new List(240); // 240 是预期长度 - foreach (ushort reg in registers) - { - for (int bit = 0; bit < 16; bit++) - { - int lightBit = (reg & (1 << bit)) != 0 ? 1 : 0; + // foreach (ushort reg in registers) + // { + // for (int bit = 0; bit < 16; bit++) + // { + // int lightBit = (reg & (1 << bit)) != 0 ? 1 : 0; - if (tbTest.Content.ToString() == "空白测试") - { - lightBit = 1; + // if (tbTest.Content.ToString() == "空白测试") + // { + // lightBit = 1; - if (tempList.Where(s => s == 1).Count() > 194) - { - lightBit = 0; - } - } - tempList.Add(lightBit); - } - } + // if (tempList.Where(s => s == 1).Count() > 194) + // { + // lightBit = 0; + // } + // } + // tempList.Add(lightBit); + // } + // } - lock (_lock) - { - DataList.Clear(); - DataList.AddRange(tempList.Cast()); - } + // lock (_lock) + // { + // DataList.Clear(); + // DataList.AddRange(tempList.Cast()); + // } - System.Diagnostics.Debug.WriteLine($"灯条二进制数据总长度：{DataList.Count}"); - } - catch (Exception ex) - { - Console.WriteLine($"灯条数据读取失败：{ex.Message}"); - // 出错时不清空 DataList，保留旧数据 - } - } + // System.Diagnostics.Debug.WriteLine($"灯条二进制数据总长度：{DataList.Count}"); + // } + // catch (Exception ex) + // { + // Console.WriteLine($"灯条数据读取失败：{ex.Message}"); + // // 出错时不清空 DataList，保留旧数据 + // } + //} private async void Timer_Tick(object sender, EventArgs e) { @@ -401,6 +402,7 @@ namespace 头罩视野.Views //计算 private async Task calCurrentangle() { + await ReadLightBarData(); int[] lightData; @@ -415,17 +417,30 @@ namespace 头罩视野.Views return; } + // 打印原始数据（假设灯条顺序：上81，中81，下81） + void PrintSegment(int[] data, int start, int length, string title) + { + int end = Math.Min(start + length, data.Length); + var values = data.Skip(start).Take(end - start).ToArray(); + string first20 = string.Join("", values.Take(20)); + string last20 = string.Join("", values.Skip(Math.Max(0, values.Length - 20)).Take(20)); + System.Diagnostics.Debug.WriteLine($"{title} (共{values.Length}个): 前20:{first20} ... 后20:{last20}"); + } + + System.Diagnostics.Debug.WriteLine("=== 原始灯条数据 ==="); + PrintSegment(lightData, 0, 81, "上爪灯条"); + PrintSegment(lightData, 81, 81, "下爪灯条"); + PrintSegment(lightData, 162, 81, "左右灯条"); + double singleArea = GetArea.CalculateEllipseArea(lightData, _lightPositions); double bottomViewAngle; + if (tbTest.Content.ToString() == "试样测试") { - // 1. 修正下爪灯条的不连续性：填充空洞，使所有1连续 + // 修正下爪灯条：填充空洞使连续 int startIdx = 81; - int endIdx = 162; // 81+81=162 - int firstOne = -1; - int lastOne = -1; - - // 找到第一个1和最后一个1 + int endIdx = startIdx + 81; + int firstOne = -1, lastOne = -1; for (int i = startIdx; i < endIdx; i++) { if (lightData[i] == 1) @@ -434,97 +449,91 @@ namespace 头罩视野.Views lastOne = i; } } - - // 如果存在1，则将 firstOne 到 lastOne 之间的所有灯设为1（填充空洞） if (firstOne != -1 && lastOne != -1) { for (int i = firstOne; i <= lastOne; i++) - { lightData[i] = 1; - } } - // 2. 基于修正后的数据，计算下爪灯条亮灯比例 + PrintSegment(lightData, 81, 81, "修正后的下爪灯条"); + + // 计算亮灯比例 int bottomLampCount = 0; - const int totalBottomLamps = 81; - for (int i = 0; i < lightData.Length && i < _lightPositions.Count; i++) - { - var (m, n) = _lightPositions[i]; - if (n == 1 && lightData[i] == 1) - bottomLampCount++; - } - double ratio = (double)bottomLampCount / totalBottomLamps; - double estimatedAngle = 90.0 * ratio; // 全亮时90°，全灭时0° - - // 3. 可选：钳位到52-60（如果需要） - // if (estimatedAngle < 52) estimatedAngle = 52; - // if (estimatedAngle > 60) estimatedAngle = 60; - - bottomViewAngle = estimatedAngle; + for (int i = startIdx; i < endIdx; i++) + if (lightData[i] == 1) bottomLampCount++; + double ratio = bottomLampCount / 81.0; + bottomViewAngle = 90.0 * ratio; + // 可选钳位 + // if (bottomViewAngle < 52) bottomViewAngle = 52; + // if (bottomViewAngle > 60) bottomViewAngle = 60; } else { bottomViewAngle = GetArea.CalculateBottomViewAngle(lightData, _lightPositions); - } - System.Diagnostics.Debug.WriteLine($"角度: {dqangle.Text}, singleArea={singleArea}, bottomViewAngle={bottomViewAngle}"); - // 5. 根据当前测试模式（左眼/右眼/双目），累加面积 - if (isLeftOnly) - { - //System.Diagnostics.Debug.WriteLine($"lightData 实际长度: {lightData.Length}"); - _leftTotalArea += singleArea; - // 实时合并左眼：只要亮过一次，就永久亮 - // 安全获取真实长度 - int realLength = lightData.Length; - // 初始化最终数据（永远和 lightData 一样长，不会错） - if (_leftFinalData == null || _leftFinalData.Count != realLength) + + System.Diagnostics.Debug.WriteLine($"角度: {dqangle.Text}, singleArea={singleArea}, bottomViewAngle={bottomViewAngle}"); + + // 5. 根据当前测试模式（左眼/右眼/双目），累加面积 + if (isLeftOnly) { - _leftFinalData = new List(new int[realLength]); + //System.Diagnostics.Debug.WriteLine($"lightData 实际长度: {lightData.Length}"); + _leftTotalArea += singleArea; + // 实时合并左眼：只要亮过一次，就永久亮 + + // 安全获取真实长度 + int realLength = lightData.Length; + + // 初始化最终数据（永远和 lightData 一样长，不会错） + if (_leftFinalData == null || _leftFinalData.Count != realLength) + { + _leftFinalData = new List(new int[realLength]); + } + + for (int i = 0; i < realLength; i++) + { + if (lightData[i] == 1) + { + _leftFinalData[i] = 1; + } + } + } - for (int i = 0; i < realLength; i++) + else if (isRightOnly) { - if (lightData[i] == 1) + _rightTotalArea += singleArea; + int realLength = lightData.Length; + + if (_rightFinalData == null || _rightFinalData.Count != realLength) { - _leftFinalData[i] = 1; + _rightFinalData = new List(new int[realLength]); + } + + for (int i = 0; i < realLength; i++) + { + if (lightData[i] == 1) + { + _rightFinalData[i] = 1; + } } } - } + // 6. 更新下方视野的最大值（取所有角度中最大的） + if (bottomViewAngle > maxBottomViewAngle) + maxBottomViewAngle = bottomViewAngle; - else if (isRightOnly) - { - _rightTotalArea += singleArea; - int realLength = lightData.Length; - - if (_rightFinalData == null || _rightFinalData.Count != realLength) + await Dispatcher.InvokeAsync(() => { - _rightFinalData = new List(new int[realLength]); - } - - for (int i = 0; i < realLength; i++) - { - if (lightData[i] == 1) - { - _rightFinalData[i] = 1; - } - } + zmsyarea.Text = _leftTotalArea.ToString("0"); + ymsyarea.Text = _rightTotalArea.ToString("0"); + smsyarea.Text = _binocularTotalArea.ToString("0"); + xfsyarea.Text = maxBottomViewAngle.ToString("0"); + }); } - - // 6. 更新下方视野的最大值（取所有角度中最大的） - if (bottomViewAngle > maxBottomViewAngle) - maxBottomViewAngle = bottomViewAngle; - - await Dispatcher.InvokeAsync(() => - { - zmsyarea.Text = _leftTotalArea.ToString("0"); - ymsyarea.Text = _rightTotalArea.ToString("0"); - smsyarea.Text = _binocularTotalArea.ToString("0"); - xfsyarea.Text = maxBottomViewAngle.ToString("0"); - }); } //数据共享 @@ -944,6 +953,115 @@ namespace 头罩视野.Views } + + + private IModbusMaster _serialMaster; + + private void InitSerialModbus() + { + try + { + // 请根据实际 COM 口和参数修改 + string portName = "COM3"; // 实际串口号 + int baudRate = 9600; + Parity parity = Parity.None; + int dataBits = 8; + StopBits stopBits = StopBits.One; + + var serialPort = new SerialPort(portName, baudRate, parity, dataBits, stopBits); + if (!serialPort.IsOpen) + serialPort.Open(); + + _serialMaster = ModbusSerialMaster.CreateRtu(serialPort); + + // 推荐加上超时，避免卡死 + _serialMaster.Transport.Retries = 2; + _serialMaster.Transport.ReadTimeout = 500; + _serialMaster.Transport.WriteTimeout = 500; + + System.Diagnostics.Debug.WriteLine($"RS485 串口 {portName} 初始化成功"); + } + catch (Exception ex) + { + Console.WriteLine($"串口初始化失败：{ex.Message}"); + } + } + + private async Task ReadLightBarData() + { + // ===================== 最小修改，不丢次 ===================== + if (_serialMaster == null) + { + InitSerialModbus(); // 立即初始化，不跳过本次 + } + if (_serialMaster == null) return; // 真的失败才退出 + // ========================================================== + + try + { + byte slaveId = 1; + + var allLights = new List(); + + // 通道一：10001~10081 + bool[] ch1 = await _serialMaster.ReadInputsAsync(slaveId, 0, 81); + allLights.AddRange(ch1.Select(b => b ? 1 : 0)); + + // 通道二：10097~10177 + bool[] ch2 = await _serialMaster.ReadInputsAsync(slaveId, 96, 81); + allLights.AddRange(ch2.Select(b => b ? 1 : 0)); + + // 通道三 + bool[] s1 = await _serialMaster.ReadInputsAsync(slaveId, 192, 8); + bool[] s2 = await _serialMaster.ReadInputsAsync(slaveId, 208, 16); + bool[] s3 = await _serialMaster.ReadInputsAsync(slaveId, 224, 16); + bool[] s4 = await _serialMaster.ReadInputsAsync(slaveId, 240, 1); + bool[] s5 = await _serialMaster.ReadInputsAsync(slaveId, 256, 16); + bool[] s6 = await _serialMaster.ReadInputsAsync(slaveId, 272, 16); + bool[] s7 = await _serialMaster.ReadInputsAsync(slaveId, 288, 8); + + allLights.AddRange(s1.Select(b => b ? 1 : 0)); + allLights.AddRange(s2.Select(b => b ? 1 : 0)); + allLights.AddRange(s3.Select(b => b ? 1 : 0)); + allLights.AddRange(s4.Select(b => b ? 1 : 0)); + allLights.AddRange(s5.Select(b => b ? 1 : 0)); + allLights.AddRange(s6.Select(b => b ? 1 : 0)); + allLights.AddRange(s7.Select(b => b ? 1 : 0)); + + int total = 81 + 81 + 8 + 16 + 16 + 1 + 16 + 16 + 8; + if (allLights.Count != total) + { + System.Diagnostics.Debug.WriteLine($"灯条数据总数错误：{allLights.Count}，预期 {total}"); + } + + lock (_lock) + { + DataList.Clear(); + if (tbTest.Content.ToString()=="空白测试") + { + allLights.ForEach(s => + { + int item = 1; + DataList.Add(item); + }); + } + DataList.AddRange(allLights.Cast()); + } + + int onCount = DataList.Count(s => s == 1); + System.Diagnostics.Debug.WriteLine($"当前亮灯数量：{onCount}"); + } + catch (Exception ex) + { + Console.WriteLine($"灯条数据读取失败：{ex.Message}"); + System.Diagnostics.Debug.WriteLine(ex.StackTrace); + } + } + + + + + } }