angle = (atan2((double)Mag[1],(double)Mag[0])*(180 / pi)+180); //二维方位角计算 //Mag[0] :地磁计X轴 //Mag[1] :地磁计Y轴