/// <summary>
/// 给起点,终点,半径确定两个圆心
/// </summary>
private Postion_4D centering2D(Postion_4D begP, Postion_4D endP, double R)
{
double x1 = begP.A; // 第一个点的x坐标
double y1 = begP.B; // 第一个点的y坐标
double x2 = endP.A; // 第二个点的x坐标
double y2 = endP.B; // 第二个点的y坐标
//已知圆上两点坐标和圆的半径,求两个圆心坐标
//求两点连线的中点坐标
double x0 = (x1 + x2) / 2;
double y0 = (y1 + y2) / 2;
//求两点连线的斜率
double k;
if (y1 == y2)
k = 0;
else if (x1 == x2)
k = double.NaN;
else
k = (y2 - y1) / (x2 - x1);
//求两点连线的中垂线的斜率和截距
double k1, b1;
if (k is double.NaN)
{
k1 = 0;
b1 = y0;
}
else
{
k1 = -1 / k;
b1 = y0 - k1 * x0;
}
bool isTrue = false;
//测试中心点是否在求出的直线方程上
double value = k1 * x0 + b1;
if (Math.Abs(value - y0) < 0.0001)
{
isTrue = true;
}
else
{
throw new Exception("方程出错");
}
Postion_4D postion_4D = new Postion_4D();
double ds = k1 * 30 + b1;
double hh = Math.Sqrt(Math.Pow(30 - x0, 2) + Math.Pow(30 - y0, 2));
if (isTrue)
{
double Ang = Math.Acos(Math.Sqrt(Math.Pow(begP.A - x0, 2)
+ Math.Pow(begP.B - y0, 2)) / R);
double h = R * Math.Sin(Ang);
double a = k1 * k1 + 1;
double b = -2 * (k1 * (y0 - b1) + x0);
double c = (-(h * h)) + Math.Pow(y0 - b1, 2) + (x0 * x0);
bool sw = QuadraticPrimaryEquation(a, b, c, out double po1,out double po2);
if (sw)
{
postion_4D.A = po1;
postion_4D.B = (k1 * po1) + b1;
postion_4D.C = po2;
postion_4D.D = (k1 * po2) + b1;
bool test = DefiniteArc(postion_4D, R, begP);
bool test1 = DefiniteArc(postion_4D, R, endP);
}
else
throw new Exception("求根出错");
}
return postion_4D;
}
/// <summary>
/// 二元一次方程求解
/// </summary>
/// <param name="a">方程的A</param>
/// <param name="b">方程的B</param>
/// <param name="c">方程的C</param>
/// <param name="begP">方程的两个实数根</param>
/// <returns>false:无实数根,true:有实数根</returns>
private bool QuadraticPrimaryEquation(double a, double b, double c, out double begPA,out double begPB)
{
begPA = double.NaN;
begPB = double.NaN;
double d = Math.Pow(b, 2) - 4 * a * c;
if (d >= 0)
{
begPA = ((-b + Math.Sqrt(d)) / (2 * a));
begPB = ((-b - Math.Sqrt(d)) / (2 * a));
return true;
}
else
{
return false;
}
}
给起点,终点,半径确定两个圆心
于 2023-12-22 10:01:51 首次发布