@@ -0,0 +1,9 @@
+# 3.学会面向对象编程-封装IMU驱动
+
+上一节我们成功读取到了IMU的数据,其中角度用欧拉角的方式表示的,在我们机器人世界里姿态的表示往往使用四元数表示(如果不清楚他们之间的关系可以回看第六章机器人学篇),所以我们需要将欧拉角转换成四元数。除此之外我们还需要将其坐标系矫正到右手坐标系。
+所以本节我们将通过面向对象的方式将IMU驱动进行封装,并为其添加坐标系转换以及四元数转换函数。
+## 一、理论介绍
+欧拉角转四元数
@@ -323,6 +323,10 @@ $$

+
轴角转四元数
轴:$^AK=[k_x,k_y,k_z]^T$ 角:$\theta$