完成基于bsp的bmi088编写,更新can comm的CAN配置

modules/algorithm/user_lib.c

@@ -174,6 +174,12 @@ float* Norm3d(float* v)
     return v;
 }
 
+// 计算模长
+float NormOf3d(float *v)
+{
+    return Sqrt(v[0] * v[0] + v[1] * v[1] + v[2] * v[2]);
+}
+
 // 三维向量叉乘v1 x v2
 void Cross3d(float* v1, float* v2,float* res)
 {