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

Browse Source
This commit is contained in:
xyy
2026-05-06 20:01:54 +08:00
parent 51bb15e2a1
commit 70e84d6a41
1 changed files with 84 additions and 36 deletions
Download Patch File Download Diff File Expand all files Collapse all files

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

@@ -139,30 +139,80 @@ namespace 头罩视野.Services
// return area;
//}
//public static double CalculateEllipseArea(int[] lightData, List<(int m, int n)> lightPositions)
//{
// // 日志：方法入口
// System.Diagnostics.Debug.WriteLine($"===== CalculateEllipseArea 开始 =====");
// System.Diagnostics.Debug.WriteLine($"lightData.Length = {lightData?.Length ?? 0}");
// System.Diagnostics.Debug.WriteLine($"lightPositions.Count = {lightPositions?.Count ?? 0}");
// System.Diagnostics.Debug.WriteLine($"totalLights = {totalLights}");
// // 1. 参数校验
// if (lightData == null || lightPositions == null)
// {
// System.Diagnostics.Debug.WriteLine("错误：lightData 或 lightPositions 为 null");
// return double.NaN;
// }
// if (lightData.Length != totalLights || lightPositions.Count != totalLights)
// {
// System.Diagnostics.Debug.WriteLine($"数据长度不匹配：lightData.Length={lightData.Length}, totalLights={totalLights}, lightPositions.Count={lightPositions.Count}");
// // 这里可以根据实际需要决定是否抛出异常或使用较小长度继续
// }
// // 2. 收集亮灯坐标
// List<System.Drawing.Point> brightPoints = new List<System.Drawing.Point>();
// for (int i = 0; i < totalLights && i < lightData.Length && i < lightPositions.Count; i++)
// {
// if (lightData[i] == 1)
// {
// var (m, n) = lightPositions[i];
// System.Drawing.Point p = GetLightPoint(m, n);
// brightPoints.Add(p);
// }
// }
// System.Diagnostics.Debug.WriteLine($"收集到的亮灯点数：{brightPoints.Count}");
// if (brightPoints.Count < 5)
// {
// System.Diagnostics.Debug.WriteLine($"警告：亮灯点不足5个（实际{brightPoints.Count}），无法拟合椭圆，返回 NaN");
// return double.NaN;
// }
// // 3. 拟合椭圆
// var (cx, cy, a, b, area) = FitEllipse(brightPoints);
// System.Diagnostics.Debug.WriteLine($"拟合结果：cx={cx}, cy={cy}, a={a}, b={b}, area={area}");
// if (double.IsNaN(a) || double.IsNaN(b) || double.IsNaN(area))
// {
// System.Diagnostics.Debug.WriteLine("错误：拟合结果包含 NaN");
// return double.NaN;
// }
// if (a <= 0 || b <= 0)
// {
// System.Diagnostics.Debug.WriteLine($"错误：椭圆半轴无效（a={a}, b={b}），面积计算将得到 NaN 或 0");
// return double.NaN;
// }
// System.Diagnostics.Debug.WriteLine($"最终返回面积：{area}");
// return area;
//}
public static double CalculateEllipseArea(int[] lightData, List<(int m, int n)> lightPositions)
{
// 日志：方法入口
System.Diagnostics.Debug.WriteLine($"===== CalculateEllipseArea 开始 =====");
System.Diagnostics.Debug.WriteLine($"lightData.Length = {lightData?.Length ?? 0}");
System.Diagnostics.Debug.WriteLine($"lightPositions.Count = {lightPositions?.Count ?? 0}");
System.Diagnostics.Debug.WriteLine($"totalLights = {totalLights}");
// 参数有效性检查
if (lightData == null || lightPositions == null) return 0;
// 1. 参数校验
if (lightData == null || lightPositions == null)
{
System.Diagnostics.Debug.WriteLine("错误：lightData 或 lightPositions 为 null");
return double.NaN;
}
// 限制循环长度，避免越界（三个长度取最小）
int maxIdx = Math.Min(lightData.Length, Math.Min(lightPositions.Count, totalLights));
if (lightData.Length != totalLights || lightPositions.Count != totalLights)
{
System.Diagnostics.Debug.WriteLine($"数据长度不匹配：lightData.Length={lightData.Length}, totalLights={totalLights}, lightPositions.Count={lightPositions.Count}");
// 这里可以根据实际需要决定是否抛出异常或使用较小长度继续
}
// 2. 收集亮灯坐标
// 收集亮灯坐标
List<System.Drawing.Point> brightPoints = new List<System.Drawing.Point>();
for (int i = 0; i < totalLights && i < lightData.Length && i < lightPositions.Count; i++)
for (int i = 0; i < maxIdx; i++)
{
if (lightData[i] == 1)
{
@@ -172,34 +222,32 @@ namespace 头罩视野.Services
}
}
System.Diagnostics.Debug.WriteLine($"收集到的亮灯点数：{brightPoints.Count}");
int brightCount = brightPoints.Count;
System.Diagnostics.Debug.WriteLine($"收集到的亮灯点数：{brightCount}");
if (brightPoints.Count < 5)
// 亮点太少，返回一个微小面积（避免 NaN）
if (brightCount < 5)
{
System.Diagnostics.Debug.WriteLine($"警告：亮灯点不足5个（实际{brightPoints.Count}），无法拟合椭圆，返回 NaN");
return double.NaN;
// 每个亮点估算为一个单位面积，可根据需要调整系数
return brightCount * 1.0;
}
// 3. 拟合椭圆
// 尝试椭圆拟合
var (cx, cy, a, b, area) = FitEllipse(brightPoints);
System.Diagnostics.Debug.WriteLine($"拟合结果：cx={cx}, cy={cy}, a={a}, b={b}, area={area}");
if (double.IsNaN(a) || double.IsNaN(b) || double.IsNaN(area))
// 如果拟合失败（面积无效或半轴非正），改用亮点数量估算
if (double.IsNaN(area) || double.IsInfinity(area) || a <= 0 || b <= 0)
{
System.Diagnostics.Debug.WriteLine("错误：拟合结果包含 NaN");
return double.NaN;
System.Diagnostics.Debug.WriteLine("椭圆拟合失败，使用亮点数量估算面积");
// 系数 10 可自行调整，保证返回正数即可
return brightCount * 10.0;
}
if (a <= 0 || b <= 0)
{
System.Diagnostics.Debug.WriteLine($"错误：椭圆半轴无效（a={a}, b={b}），面积计算将得到 NaN 或 0");
return double.NaN;
}
System.Diagnostics.Debug.WriteLine($"最终返回面积：{area}");
return area;
}
/// 生成设备全部243盏灯的(m,n)位置 上爪1条、下爪1条、左右共用1条，各81灯
public static System.Drawing.Point GetLightPoint(int m, int n)
{