练习1前方交会

//前方交会
double f_int()                               //forward intersetion
{
    double ja = 0, jb = 0, jc = 0;
    double xa = 0, ya = 0, xb = 0, yb = 0, xp, yp;
    cout << "请输入A，B交会角角度值" << endl;
    cin >> ja >> jb;
    cout << "请输入A点坐标" << endl;
    cin >> xa >> ya;
    cout << "请输入B点坐标" << endl;
    cin >> xb >> yb;
    int p;
    cout << "P在AB左侧输入-1，在AB右侧输入1" << endl;
    cin >> p;
    ja = dfm2rad(ja);
    jb = dfm2rad(jb);
    double down,under_x,under_y;
    down = sin(ja) * cos(jb) + cos(ja) * sin(jb);
    under_x = xa * sin(ja) * cos(jb) + xb * cos(ja) * sin(jb) + p * (ya - yb) * sin(ja) * sin(jb);
    under_y = ya * sin(ja) * cos(jb) + yb * cos(ja) * sin(jb) + p * (xb - xa) * sin(ja) * sin(jb);
    xp = under_x / down;
    yp = under_y / down;
    cout << "xp=" << xp << endl;
    cout << "yp=" << yp << endl;
    return 0;
}