stm32+hmc5883电子罗盘数据采集+磁偏角校正代码，小白一个，不懂请见谅 -

void calibrateMag(int * offsetX,int * offsetY,int * offsetZ,float * y_gain)
{
short int x,y,z,i; //三轴数据
int xMax, xMin, yMax, yMin, zMax, zMin;
//初始化
Get_mag_ADC(&x,&y,&z);
xMax=xMin=x;
yMax=yMin=y;
zMax=zMin=z;
* offsetX =0;
* offsetY =0;
* offsetZ =0;
for( i=0;i<250;i++)
{
Get_mag_ADC(&x,&y,&z);
// 计算最大值与最小值
// 计算传感器绕X,Y,Z轴旋转时的磁场强度最大值和最小值
if (x > xMax)
xMax = x;
if (x < xMin )
xMin = x;
if(y > yMax )
yMax = y;
if(y < yMin )
yMin = y;
if(z > zMax )
zMax = z;
if(z < zMin )
zMin = z;
delay_ms(100);
if(i%20 == 0)
{
printf("\n xMax = %d ",xMax);
printf("xMin = %d --",xMin);
printf(" yMax = %d ",yMax);
printf("yMin = %d \n",yMin);
}
}

复制代码

int main(void)
{
//double angle;
delay_init(); //延时函数初始化
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//设置中断优先级分组为组2：2位抢占优先级，2位响应优先级
uart_init(115200); //串口初始化为115200
IIC_Init();
Init_HMC5883();
delay_ms(500);
calibrateMag(& offsetX,& offsetY,& offsetZ,& Y_Gain);
// usmart_init(72);
while(1)
{
///////////////////////////////////////////////////////////////////////////////
// a++;//a 溢出 : 32766,32767,-32768,-32767,-32766....
// a--;//a : 2,1,0,-1,-2,....
// short int :-32768<a<32767 占内存16位
// int ：占内存32位
///////////////////////////输出方式0////////////////////////////////////
Get_mag_ADC(&x,&y,&z);
angle=atan2((double)(y-offsetY)*Y_Gain,(double)(x-offsetX))*(180 / 3.14159265)+180;
//磁偏角矫正
angle = angle - MagnetcDeclination + 180;
if(angle < 0) angle += 360;
else if(angle >360) angle -= 360;
printf("\n x = %d y = %d z = %d ",x,y,z);
printf("水平角度= %.2f 增益 = %f.3\n",angle,Y_Gain);
delay_ms(300);
/////////////////////输出方式一/////////////////////////
// angle= Get_Compass_Angle();
// delay_ms(300);
// x = BUF[0] << 8 | BUF[1];
// y = BUF[2] << 8 | BUF[3];
// z = BUF[4] << 8 | BUF[5];
// printf("\n x = %d y = %d z = %d ",x,y,z);
// printf("角度1= %f \n",angle);
////////////////////输出方式二/////////////////////////
// HMC5883_ReadXYZ(&x,&y,&z);
// angle=atan2((double)y,(double)x)*(180 / 3.14159265)+180;
// delay_ms(300);
// printf("\n x1 = %d y1 = %d z1 = %d ",x,y,z);
// printf("角度2= %f \n",angle);
//
///////////////////////////////////////////////////////
}
}

复制代码