|
|
QMC5883L 校準(zhǔn)方法
1、 數(shù)據(jù)讀取
X_QMC=BUF[1]<< 8 | BUF[0]; //Combine MSB and LSB of X Data output register 最高有效位
Y_QMC=BUF[3]<< 8 | BUF[2]; //Combine MSB and LSB of Y Data output register
Z_QMC=BUF[5]<< 8 | BUF[4]; //Combine MSB and LSB of Z Data output register
2、 水平校準(zhǔn)：把橢圓修到正圓，一、修偏心，二、修半徑。
a）、選定中心點(diǎn)，以固定半徑R水平旋轉(zhuǎn)，找出x和y的最大最小值x_max、x_min、y_max 、y_min。
b）、于是，x的偏移： Xoffset= (x_max + x_min) / 2;
c）、x的比例�。簒_gain=1
d）、y的偏移：Yoffset =(y_max + y_min) / 2;
e）、y的比例：y_gain=(x_max – x_min) / (y_max – y_min);
X_QMC = Xgain *(X_QMC -Xoffset);
Y_QMC = Ygain * (Y_QMC -Yoffset);
3、空間校準(zhǔn)：把橢球修到正球
a）、空間旋轉(zhuǎn)芯片，找出xyz的最大最小值xmax、xmin、ymax 、ymin、zmax 、zmin。
b）、于是，x的偏移： Xoffset= (xmax + xmin) / 2;
c）、x的比例�。簒_gain=1
d）、y的偏移：Yoffset =(ymax + ymin) / 2;
e）、y的比例：y_gain=(xmax – xmin) / (y_max -y_min);
f）、 z的偏移：Zoffset =(zmax + zmin) / 2;
g）、z的比例：z_gain=(xmax – xmin) / (z_max -z_min);
X_QMC = QMC_Xgain *(X_QMC – QMC_Xoffset);
Y_QMC = QMC_Ygain * (Y_QMC – QMC_Yoffset);
Z_QMC = QMC_Zgain * (Z_QMC- QMC_Zoffset);
要詳情上某寶。 |
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
