函数体
float distance(float a,float b,float c)
{
float d;
d=sqrt((a*a/2)+(c*c/2)-(b*b/4));
return d;
}//长度函数
float angle(float b,float c,float d)
{
float angle;
angle=90-acos((c*c)+(d*d)-(b*b/4)/b*d);
return angle;
}
调用语句
Distance=distance(Rdistance,between,Ldistance);
Angle=angle(between,Ldistance,Distance);