从加速度计数据测量速度和距离
Measuring speed and distance from Accelerometer datas
我正在使用带 9DOF(加速度计、陀螺仪、磁力计)的 LSM9DS0 传感器
接收到来自X、Y、Z轴(在G中)的加速度后,我执行以下步骤
假设 X、Y、Z 方向的加速度为 AccelX_Avg、AccelY_Avg、AccelZ_Avg
Accel_Avg = (sqrt(AccelX_Avg*AccelX_Avg + AccelY_Avg*AccelY_Avg + AccelZ_Avg*AccelZ_Avg)) * 9.88888;
然后我计算速度和距离
if (i_offset_distance == 0) { // calculate the speed(V1) and distance(D1) for first instant
i_offset_distance = i_offset_distance + 1 ;
Serial.println("\nFirst is done \n");
Measured_Velocity_1 = (Accel_Avg* dt_ODR_A);
Distance_covered_1 = (Measured_Velocity*dt_ODR_A) + (0.5*Accel_Avg*dt_ODR_A*dt_ODR_A);
}
else{
Measured_Velocity = Measured_Velocity_1 + (Accel_Avg* dt_ODR_A); // V2 = V1 + Accelration * Dt
Measured_Velocity_1 = Measured_Velocity;
Distance_covered = (Measured_Velocity*dt_ODR_A) + (0.5*Accel_Avg*dt_ODR_A*dt_ODR_A) + Distance_covered_1;
Distance_covered_1 = Distance_covered;
i_offset_distance = i_offset_distance + 1;
}
它每次都会给我速度和行进距离的增量值,无论我如何期望,当传感器静止时加速度 (0,0,g),速度应该为零。另外,如果它不动,它应该让 distance_covered 也为 0。
我怎样才能获得速度并 total_distance 正确覆盖?
非常感谢通过代码实现、概念、算法提出任何形式的建议。谢谢你。
首先,使用6点校准方法校准加速度计传感器。
https://chionophilous.wordpress.com/2011/08/26/accelerometer-calibration-ii-simple-methods/
http://sailboatinstruments.blogspot.in/2011/09/improved-magnetometer-calibration-part.html
这里使用Magneto软件进行校准。基本概念是使用偏差和灵敏度将 (AccelX_Avg、AccelY_Avg、AccelZ_Avg) 的值拟合到半径为 9.8 的球体上。这将确保在 IMU 的静止状态下没有加速度计值,并且距离几乎保持为零。
但是因为你是双重积分,距离总会有一些漂移,所以我更愿意应用卡尔曼或 DCM 滤波器来滤除高频加速度计噪声和长期陀螺仪漂移....如有任何疑问,请执行在下方评论
我正在使用带 9DOF(加速度计、陀螺仪、磁力计)的 LSM9DS0 传感器
接收到来自X、Y、Z轴(在G中)的加速度后,我执行以下步骤
假设 X、Y、Z 方向的加速度为 AccelX_Avg、AccelY_Avg、AccelZ_Avg
Accel_Avg = (sqrt(AccelX_Avg*AccelX_Avg + AccelY_Avg*AccelY_Avg + AccelZ_Avg*AccelZ_Avg)) * 9.88888;
然后我计算速度和距离
if (i_offset_distance == 0) { // calculate the speed(V1) and distance(D1) for first instant
i_offset_distance = i_offset_distance + 1 ;
Serial.println("\nFirst is done \n");
Measured_Velocity_1 = (Accel_Avg* dt_ODR_A);
Distance_covered_1 = (Measured_Velocity*dt_ODR_A) + (0.5*Accel_Avg*dt_ODR_A*dt_ODR_A);
}
else{
Measured_Velocity = Measured_Velocity_1 + (Accel_Avg* dt_ODR_A); // V2 = V1 + Accelration * Dt
Measured_Velocity_1 = Measured_Velocity;
Distance_covered = (Measured_Velocity*dt_ODR_A) + (0.5*Accel_Avg*dt_ODR_A*dt_ODR_A) + Distance_covered_1;
Distance_covered_1 = Distance_covered;
i_offset_distance = i_offset_distance + 1;
}
它每次都会给我速度和行进距离的增量值,无论我如何期望,当传感器静止时加速度 (0,0,g),速度应该为零。另外,如果它不动,它应该让 distance_covered 也为 0。
我怎样才能获得速度并 total_distance 正确覆盖?
非常感谢通过代码实现、概念、算法提出任何形式的建议。谢谢你。
首先,使用6点校准方法校准加速度计传感器。 https://chionophilous.wordpress.com/2011/08/26/accelerometer-calibration-ii-simple-methods/ http://sailboatinstruments.blogspot.in/2011/09/improved-magnetometer-calibration-part.html
这里使用Magneto软件进行校准。基本概念是使用偏差和灵敏度将 (AccelX_Avg、AccelY_Avg、AccelZ_Avg) 的值拟合到半径为 9.8 的球体上。这将确保在 IMU 的静止状态下没有加速度计值,并且距离几乎保持为零。 但是因为你是双重积分,距离总会有一些漂移,所以我更愿意应用卡尔曼或 DCM 滤波器来滤除高频加速度计噪声和长期陀螺仪漂移....如有任何疑问,请执行在下方评论