大家帮分析下,我AK8975磁力计计算出的角度很不准,
我用angle=atan2(Magnetic.Mag_Y,Magnetic.Mag_X)*180/3.141593这个公式算出的角度全是正的,而且旋转一周只是从130-30-130度的变化。根不能不是-180-180啊,起码满量程是360度也行啊,我这数据根本不对啊万能的坛友分析下可能什么原因
下面是读数据函数
void AK8975_Read(AK8975_Data*p)
{
s16 BUF;
float mag_x,mag_y,mag_z;
float tmp_x,tmp_y,tmp_z;
float MagAdjust_x,MagAdjust_y,MagAdjust_z;
while(!AK8975_Read_OneByte(AK8975_ST1))
{
// PBout(12)=0;
}
// if((AK8975_Read_OneByte(AK8975_ST1)==1)&&(AK8975_Read_OneByte(AK8975_ST1)==0x01))
// PBout(12)=0;
BUF=(s16)AK8975_Read_Word(AK8975_HXL);
BUF=(s16)AK8975_Read_Word(AK8975_HYL);
BUF=(s16)AK8975_Read_Word(AK8975_HZL);
// PBout(12)=1;
/*转换成高斯单位*/
mag_x=(float)BUF*((ASAX-128)*0.5/128+1)*0.3/100;
mag_y=(float)BUF*((ASAY-128)*0.5/128+1)*0.3/100;
mag_z=(float)BUF*((ASAZ-128)*0.5/128+1)*0.3/100;
/*下面用来校准*/
tmp_x = mag_x - MagOffset_X;
tmp_y = mag_y - MagOffset_X;
tmp_z = mag_z - MagOffset_Y;
MagAdjust_x = B *tmp_x + B *tmp_y + B *tmp_z;
MagAdjust_y = B *tmp_x + B *tmp_y + B *tmp_z;
MagAdjust_z = B *tmp_x + B *tmp_y + B *tmp_z;
p->Mag_X=MagAdjust_x;
p->Mag_Y=MagAdjust_y;
p->Mag_Z=MagAdjust_z;
/*由于AK8975只有单次测量模式,所以每次读出数据之后要重新设置模式以便下次读取*/
AK8975_Write_OneByte(AK8975_CNTL,0x01);
} 磁力是需要矫正的 登云钓月 发表于 2017-3-21 14:59
磁力是需要矫正的
矫正了啊。。 在同一平面,Z轴垂直向下试试看
页:
[1]