给起点,终点,半径确定两个圆心

/// <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;
    }
}

  • 10
    点赞
  • 8
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值