#include "math.h"
main()
{
float a1_xy,a2_xy,a1_x,a1_y,a2_x,a2_y,ax,ay,az;
float angle_x,angle_y;
ax=a1_x;
ay=a2_x;
az=(a1_y+a2_y)/2;
a1_xy = a1_x*a1_x + az*az;
a1_xy =sqrt(a1_xy);
if((a1_x<0.0)&&(az<0.0))
a1_xy=-a1_xy;
a2_xy = a2_x*a2_x + az*az;
a2_xy =sqrt(a2_xy);
if((a2_x<0.0)&&(az<0.0))
a2_xy=-a2_xy;
//计算X轴角度
angle_x = atan(ax/a2_xy);
if((ax>0)&&(a2_xy<0))
{
angle_x = 180 + angle_x;
}
if((ax<0)&&(a2_xy<0))
{
angle_x = -180 + angle_x;
}
//计算Y轴角度
angle_y = atan(ay/a1_xy);
if((ay>0)&&(a1_xy<0))
{
angle_y = 180 + angle_y;
}
if((ay<0)&&(a1_xy<0))
{
angle_y = -180 + angle_y;
}
}
- 1
- 2
前往页