三轴加速度计计算倾角

#include “math.h“
main（）
{
  float a1_xya2_xya1_xa1_ya2_xa2_yaxayaz;
  float angle_xangle_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;