zhj/hoodFieldOfView
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

优化

Browse Source
This commit is contained in:
rain
2026-05-06 15:00:54 +08:00
parent 07caa61a39
commit 32b149cea9
2 changed files with 178 additions and 155 deletions
Download Patch File Download Diff File Expand all files Collapse all files

66
头罩视野slove/头罩视野/Services/GetArea.cs
View File

@@ -40,6 +40,10 @@ namespace 头罩视野.Services
// 只处理亮灯的情况
if (lightData[i] == 1)
{
if (lightPositions.Count < lightData.Count())
{
return 0;
}
var (m, n) = lightPositions[i];
// 关键：只取下爪灯条（n == 1），因为只有它才对应下方的垂直视野
@@ -63,7 +67,7 @@ namespace 头罩视野.Services
//视野保存率
public static double CalcVisionRate(double binocularRate)
{
// 1. 总视野保存率
double ratioTotal = binocularRate / _standardTotalArea;
double gammaTotal = GetVisionGamma(ratioTotal);
@@ -114,8 +118,14 @@ namespace 头罩视野.Services
List<System.Drawing.Point> brightPoints = new List<System.Drawing.Point>();
for (int i = 0; i < totalLights; i++)
{
if (totalLights > lightData.Count())
{
}
if (lightData[i] == 1)
{
var (m, n) = lightPositions[i];
System.Drawing.Point p = GetLightPoint(m, n);
brightPoints.Add(p);
@@ -127,7 +137,7 @@ namespace 头罩视野.Services
// 返回面积
return area;
}
}
/// 生成设备全部243盏灯的(m,n)位置 上爪1条、下爪1条、左右共用1条，各81灯
public static System.Drawing.Point GetLightPoint(int m, int n)
{
@@ -162,45 +172,45 @@ namespace 头罩视野.Services
// 最小二乘法拟合椭圆（核心算法）cx：椭圆中心点的 X 坐标 cy：椭圆中心点的 Y 坐标 a：椭圆的长半轴长度（较大的那个半径）b：椭圆的短半轴长度（较小的那个半径）
public static (double cx, double cy, double a, double b, double area) FitEllipse(List<Point> points)
{
int n = points.Count;
{
int n = points.Count;
if (n < 5)
//throw new Exception("至少需要5个点来拟合椭圆");
return new (0,0,0,0,0) ;
return new(0, 0, 0, 0, 0);
// 这里是正确写法
var M = MathNetMatrix.Build.Dense(n, 5);
var Y = MathNetVector.Build.Dense(n, i => -1.0);
for (int i = 0; i < n; i++)
{
double x = points[i].X;
double y = points[i].Y;
M[i, 0] = x * x;
M[i, 1] = x * y;
M[i, 2] = y * y;
M[i, 3] = x;
M[i, 4] = y;
}
{
double x = points[i].X;
double y = points[i].Y;
M[i, 0] = x * x;
M[i, 1] = x * y;
M[i, 2] = y * y;
M[i, 3] = x;
M[i, 4] = y;
}
// 求解
Vector<double> sol = M.QR().Solve(Y);
double A = sol[0], B = sol[1], C = sol[2], D = sol[3], E = sol[4], F = 1;
// 求解
Vector<double> sol = M.QR().Solve(Y);
double A = sol[0], B = sol[1], C = sol[2], D = sol[3], E = sol[4], F = 1;
// 椭圆中心
double cx = (2 * C * D - B * E) / (B * B - 4 * A * C);
double cy = (2 * A * E - B * D) / (B * B - 4 * A * C);
// 椭圆中心
double cx = (2 * C * D - B * E) / (B * B - 4 * A * C);
double cy = (2 * A * E - B * D) / (B * B - 4 * A * C);
// 半轴
double term1 = 2 * (A * E * E + C * D * D - B * D * E + (B * B - 4 * A * C) * F);
double term2 = (A + C) + Math.Sqrt((A - C) * (A - C) + B * B);
double term3 = (A + C) - Math.Sqrt((A - C) * (A - C) + B * B);
// 半轴
double term1 = 2 * (A * E * E + C * D * D - B * D * E + (B * B - 4 * A * C) * F);
double term2 = (A + C) + Math.Sqrt((A - C) * (A - C) + B * B);
double term3 = (A + C) - Math.Sqrt((A - C) * (A - C) + B * B);
double a = Math.Sqrt(Math.Abs(term1 / ((B * B - 4 * A * C) * term3)));
double b = Math.Sqrt(Math.Abs(term1 / ((B * B - 4 * A * C) * term2)));
double a = Math.Sqrt(Math.Abs(term1 / ((B * B - 4 * A * C) * term3)));
double b = Math.Sqrt(Math.Abs(term1 / ((B * B - 4 * A * C) * term2)));
if (a < b) (a, b) = (b, a);
double area = Math.PI * a * b;
if (a < b) (a, b) = (b, a);
double area = Math.PI * a * b;
return (cx, cy, a, b, area);
}

267
头罩视野slove/头罩视野/Views/PageTest.xaml.cs
View File

@@ -42,7 +42,6 @@ namespace 头罩视野.Views
private double currentAngle;
#endregion
private double _leftTotalArea = 0; // 左目总视野面积
private double _rightTotalArea = 0; // 右目总视野面积
private double _binocularTotalArea = 0; // 双目总视野面积
@@ -69,13 +68,18 @@ namespace 头罩视野.Views
MessageBox.Show("未连接");
return;
}
}
// 硬件固定参数（提前定义好，不要改）
private const int LightsPerStrip = 81; // 单条灯条81个灯
private const int HalfLights = (LightsPerStrip - 1) / 2; // 40，给左右灯条用
double stepAngle;
bool isLeftOnly = false;
bool isRightOnly = false;
bool isBinocular = false;
protected readonly object _lock = new object();
private List<(int m, int n)> _lightPositions;
private void InitLightPositions()
{
@@ -213,30 +217,11 @@ namespace 头罩视野.Views
}
//测试btn 测试按钮：读取数据，存入共享列表
private async void Button_Click_Test(object sender, RoutedEventArgs e)
{
ma.BtnClickFunction(Function.ButtonType.复归型, 100);
ButtonTest.Content = "测试中....";
testTimer.Start();
double stepAngle;
double.TryParse(fbspeed.Text.Trim(), out double val);
// 范围判断：必须在 0 ~ 180 之间
if (val <= 0 || val > 180)
{
stepAngle = 10.0; // 超出范围用默认值
}
else
{
stepAngle = val; // 正常就用输入值
}
// 1. 读取输入框
// 分辨角度 例：10
bool isLeftOnly = btnLeft.Content.ToString() == "左眼开" && btnRight.Content.ToString() == "右眼关";
bool isRightOnly = btnRight.Content.ToString() == "右眼开" && btnLeft.Content.ToString() == "左眼关";
bool isBinocular = btnLeft.Content.ToString() == "左眼开" && btnRight.Content.ToString() == "右眼开";
@@ -254,9 +239,133 @@ namespace 头罩视野.Views
_binocularTotalArea = 0;
}
}
//页面渲染值
public void UpdateVisionResults(double BotViAn)
{
zmsyarea.Text = _leftTotalArea.ToString("0.00"); // 左目
ymsyarea.Text = _rightTotalArea.ToString("0.00"); // 右目
smsyarea.Text = _binocularTotalArea.ToString("0.00"); // 双目
// 3. 计算空白区视野面积（双目时才有效）
if (double.TryParse(smsyarea.Text, out double binocularTotalArea))
{
double blankArea = GetArea.GetBlankViewArea(binocularTotalArea);
kbsyarea.Text = blankArea.ToString("0.00"); // 空白视野面积
}
//// 4. 计算下方视野面积
int botViAnInt = (int)Math.Round(BotViAn);
xfsyarea.Text = botViAnInt.ToString("0.0"); // 下方视野
// 5. 计算视野保存率（双目）
if (double.TryParse(smsyarea.Text, out double totalAreaForRate))
{
double binocularRate = GetArea.CalcVisionRate(totalAreaForRate);
sybhl.Text = binocularRate.ToString("0.00"); // 视野保存率
}
}
//读取灯泡的数据
private async Task ReadLightBarData()
{
// 无连接直接返回
if (_modbusMaster == null || !ModbusHelper.TcpClient.Connected)
return;
try
{
DataList.Clear();
// 读取灯条寄存器（地址350，长度15）
ushort[] registers = await _modbusMaster.ReadHoldingRegistersAsync(1, 350, 15);
// 每个 ushort 是16位，低位在前
foreach (ushort reg in registers)
{
for (int bit = 0; bit < 16; bit++)
{
// 取第bit位的值：0或1
int lightBit = (reg & (1 << bit)) != 0 ? 1 : 0;
lock (_lock)
{
DataList.Add(lightBit);
}
}
}
// 调试：打印转换后的数据长度
System.Diagnostics.Debug.WriteLine($"灯条二进制数据总长度：{DataList.Count}");
}
catch (Exception ex)
{
Console.WriteLine($"灯条数据读取失败：{ex.Message}");
//DataList.Clear(); // 出错时清空数据
}
}
private async void Timer_Tick(object sender, EventArgs e)
{
//System.Diagnostics.Debug.WriteLine("定时器触发了！" + DateTime.Now);
// 调用你原来的读取方
//await ReadAddr262DataAsync();
await calCurrentangle();
// 组装当前数据
var data = new TestDataStore.TestRecord
{
Date = DateTime.Now.ToString("yyyy-MM-dd"),
Time = DateTime.Now.ToString("HH:mm:ss"),
LeftEyeArea = double.TryParse(zmsyarea.Text, out var l) ? l : 0,
RightEyeArea = double.TryParse(ymsyarea.Text, out var r) ? r : 0,
BinocularArea = double.TryParse(smsyarea.Text, out var b) ? b : 0,
LowerVision = double.TryParse(xfsyarea.Text, out var lv) ? lv : 0,
VisionRetentionRate = double.TryParse(sybhl.Text, out var vr) ? vr : 0
};
// ==================== 去重判断 ====================
if (_lastRecord != null &&
data.LeftEyeArea == _lastRecord.LeftEyeArea &&
data.RightEyeArea == _lastRecord.RightEyeArea &&
data.BinocularArea == _lastRecord.BinocularArea &&
data.LowerVision == _lastRecord.LowerVision &&
data.VisionRetentionRate == _lastRecord.VisionRetentionRate)
{
return; // 一样就不添加
}
//原来存的数据清空 切换页面会清空
//TestDataStore.Records.Clear();
// 不一样 → 插入表格
TestDataStore.AddNewRecord(data);
_lastRecord = data;
}
private async Task calCurrentangle()
{
double.TryParse(fbspeed.Text.Trim(), out double val);
//// 范围判断：必须在 0 ~ 180 之间
//if (val <= 0 || val > 180)
//{
// stepAngle = 10.0; // 超出范围用默认值
//}
//else
//{
// stepAngle = val; // 正常就用输入值
//}
// 1. 读取输入框
// 分辨角度 例：10
// 2. 从0转到180，每 stepAngle 执行一次
for (double current = stepAngle; current <= 180; current += stepAngle)
for (double current = stepAngle; current < 180; current += stepAngle)
{
await ReadLightBarData();
@@ -264,6 +373,10 @@ namespace 头罩视野.Views
// 读完再转数组
int[] lightData = DataList.Cast<int>().ToArray();
if (lightData.Length == 0)
{
return;
}
//开始计算视野面积
double singleArea = GetArea.CalculateEllipseArea(lightData, _lightPositions);
@@ -298,103 +411,6 @@ namespace 头罩视野.Views
// minBottomViewAngle = bottomViewAngle;
// }
}
}
//页面渲染值
public void UpdateVisionResults(double BotViAn)
{
zmsyarea.Text = _leftTotalArea.ToString("0.00"); // 左目
ymsyarea.Text = _rightTotalArea.ToString("0.00"); // 右目
smsyarea.Text = _binocularTotalArea.ToString("0.00"); // 双目
// 3. 计算空白区视野面积（双目时才有效）
if (double.TryParse(smsyarea.Text, out double binocularTotalArea))
{
double blankArea = GetArea.GetBlankViewArea(binocularTotalArea);
kbsyarea.Text = blankArea.ToString("0.00"); // 空白视野面积
}
//// 4. 计算下方视野面积
int botViAnInt = (int)Math.Round(BotViAn);
xfsyarea.Text = botViAnInt.ToString("0.0"); // 下方视野
// 5. 计算视野保存率（双目）
if (double.TryParse(smsyarea.Text, out double totalAreaForRate))
{
double binocularRate = GetArea.CalcVisionRate(totalAreaForRate);
sybhl.Text = binocularRate.ToString("0.00"); // 视野保存率
}
}
//读取灯泡的数据
private async Task ReadLightBarData()
{
// 无连接直接返回
if (_modbusMaster == null || !ModbusHelper.TcpClient.Connected)
return;
try
{
DataList.Clear();
// 读取灯条寄存器（地址350，长度15）
ushort[] registers = await _modbusMaster.ReadHoldingRegistersAsync(1, 350, 15);
// 每个 ushort 是16位，低位在前
foreach (ushort reg in registers)
{
for (int bit = 0; bit < 16; bit++)
{
// 取第bit位的值：0或1
int lightBit = (reg & (1 << bit)) != 0 ? 1 : 0;
DataList.Add(lightBit);
}
}
// 调试：打印转换后的数据长度
System.Diagnostics.Debug.WriteLine($"灯条二进制数据总长度：{DataList.Count}");
}
catch (Exception ex)
{
Console.WriteLine($"灯条数据读取失败：{ex.Message}");
//DataList.Clear(); // 出错时清空数据
}
}
private async void Timer_Tick(object sender, EventArgs e)
{
//System.Diagnostics.Debug.WriteLine("定时器触发了！" + DateTime.Now);
// 调用你原来的读取方
//await ReadAddr262DataAsync();
// 组装当前数据
var data = new TestDataStore.TestRecord
{
Date = DateTime.Now.ToString("yyyy-MM-dd"),
Time = DateTime.Now.ToString("HH:mm:ss"),
LeftEyeArea = double.TryParse(zmsyarea.Text, out var l) ? l : 0,
RightEyeArea = double.TryParse(ymsyarea.Text, out var r) ? r : 0,
BinocularArea = double.TryParse(smsyarea.Text, out var b) ? b : 0,
LowerVision = double.TryParse(xfsyarea.Text, out var lv) ? lv : 0,
VisionRetentionRate = double.TryParse(sybhl.Text, out var vr) ? vr : 0
};
// ==================== 去重判断 ====================
if (_lastRecord != null &&
data.LeftEyeArea == _lastRecord.LeftEyeArea &&
data.RightEyeArea == _lastRecord.RightEyeArea &&
data.BinocularArea == _lastRecord.BinocularArea &&
data.LowerVision == _lastRecord.LowerVision &&
data.VisionRetentionRate == _lastRecord.VisionRetentionRate)
{
return; // 一样就不添加
}
//原来存的数据清空 切换页面会清空
//TestDataStore.Records.Clear();
// 不一样 → 插入表格
TestDataStore.AddNewRecord(data);
_lastRecord = data;
}
//打印
@@ -408,7 +424,7 @@ namespace 头罩视野.Views
//试样测试
private void TbTest_Checked(object sender, RoutedEventArgs e)
private async void TbTest_Checked(object sender, RoutedEventArgs e)
{
// 选中 → 试样测试
@@ -417,16 +433,16 @@ namespace 头罩视野.Views
tbTest.Background = System.Windows.Media.Brushes.LightSkyBlue;
System.Diagnostics.Debug.WriteLine($"1232312312");
_modbusMaster.WriteSingleCoilAsync(1, 41, true);
await _modbusMaster.WriteSingleCoilAsync(1, 41, true);
}
private void TbTest_Unchecked(object sender, RoutedEventArgs e)
private async void TbTest_Unchecked(object sender, RoutedEventArgs e)
{
// 取消 → 空白测试
tbTest.Content = "试样测试";
tbTest.Background = System.Windows.Media.Brushes.LightGray;
_modbusMaster.WriteSingleCoilAsync(1, 41, false);
await _modbusMaster.WriteSingleCoilAsync(1, 41, false);
}
private void Button_Click_home(object sender, RoutedEventArgs e)
{
@@ -470,7 +486,7 @@ namespace 头罩视野.Views
//ReadAndUpdateFloatAsync(210 ,2, ymsyarea, "F2", " "),
ReadAndUpdateFloatRangeAsync(200, 12, "F2", "°"),
//ReadAndUpdateFloatAsync(424 ,2, kbsyarea, "F2", "cm²"),
ReadAndUpdateFloatAsync(310, 2, zdangle, "F2", "°/S"),
ReadAndUpdateFloatAsync(310, 2, zdangle, "F2", ""),
//ReadAndUpdateFloatAsync(430 ,2, sybhl, "F2", " "),
//前1从站地址，后1是长度
@@ -624,9 +640,6 @@ namespace 头罩视野.Views
}
}
}