对上交代码进行修改，主要将能量机关去掉，添加了同济的PnP位姿解算，但是同济有个四元数，获取IMU部分没有启用，可能导致精度不够。当前还存在反陀螺功能，修改为逻辑和弹道预测相结合，主要在时间关系上进行调整。

2026-03-21 11:57:34 +08:00
commit 56985997ae
80 changed files with 60253 additions and 0 deletions
--- a/tools/para/fc2_b
+++ b/tools/para/fc2_b
@@ -0,0 +1,16 @@
+15
+-0.68187517
+-0.013023868
+-0.012667711
+0.12630615
+-0.24749278
+-0.4987089
+0.3616302
+0.23901181
+0.32909712
+-0.25681627
+0.21683879
+0.72209626
+-0.2969338
+0.35322607
+0.6401797