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

tools/para/conv1_w

@@ -0,0 +1,454 @@
+3
+6
+5
+5
+0.026539411
+0.42253798
+0.6257618
+0.7803654
+0.56751746
+0.26718912
+0.7051625
+0.71628624
+0.7642506
+0.49248695
+0.16620474
+0.3780306
+0.7110501
+0.6030068
+0.4948883
+0.24835615
+0.33591226
+0.43040946
+0.5077497
+0.5212336
+-0.027971355
+0.2103128
+0.25356093
+0.07722227
+0.18559895
+0.32333145
+0.345134
+0.4201757
+0.6501012
+0.71342164
+0.27166557
+0.4905165
+0.6236048
+0.7930295
+0.7500772
+0.17779675
+0.56028295
+0.74555326
+0.5372084
+0.70782083
+0.27072752
+0.50543845
+0.57856107
+0.65362686
+0.53758156
+0.20370956
+0.38661864
+0.5690749
+0.24994203
+0.42308953
+-0.05610049
+0.0263962
+0.16409136
+-0.12595575
+-0.28413054
+-0.08711743
+0.3854187
+0.18076564
+0.08114622
+-0.31865782
+-0.10122112
+0.17201129
+0.116371
+0.13443075
+-0.3267171
+-0.23860133
+-0.092047565
+0.09856403
+-0.15966126
+-0.42780057
+-0.27054727
+-0.17382775
+-0.19402348
+-0.50262624
+-0.6701677
+0.021166094
+-0.15367271
+-0.3535248
+-0.3223209
+-0.3930027
+-0.012587458
+-0.2514576
+-0.028994415
+-0.23040394
+-0.22344537
+-0.28225404
+-0.12920779
+-0.084865615
+-0.079808
+-0.24189578
+-0.077354565
+-0.1364608
+-0.08271066
+0.015865652
+-0.17308144
+-0.016932748
+-0.10400943
+-0.15847488
+-0.19929907
+-0.024590252
+-0.305961
+0.41650155
+0.71885103
+0.5064972
+0.2556136
+-0.2217093
+0.3904318
+0.679353
+0.41345686
+0.1750823
+-0.07011908
+0.21723142
+0.36451343
+0.2734496
+-0.1827238
+-0.2640027
+-0.07665969
+-0.07281056
+-0.17140535
+-0.506126
+-0.39344314
+-0.19199198
+-0.43100312
+-0.5216478
+-0.8140914
+-0.22539687
+-0.1332064
+-0.18383063
+-0.3015942
+-0.3543749
+-0.07875634
+-0.046881627
+-0.17341466
+-0.17210038
+-0.16427462
+-0.12995729
+-0.09128473
+-0.07223676
+-0.05202489
+-0.17732152
+0.032028172
+0.022708599
+-0.07037333
+-0.24315825
+-0.3907585
+0.09521279
+-0.07241904
+-0.15533188
+-0.030434519
+-0.262898
+0.796653
+0.9267637
+0.93120253
+0.9917096
+0.9490124
+0.8625081
+1.0733354
+1.1211755
+1.1176518
+0.9001717
+0.7897956
+1.1967996
+1.1863062
+1.0460231
+0.86984694
+0.7440283
+0.88651806
+0.9017338
+0.81466335
+0.6403854
+0.50749934
+0.5359783
+0.54264694
+0.5598802
+0.41759288
+0.21787402
+0.42994195
+0.5423997
+0.46424487
+0.4637137
+0.4655036
+0.5988346
+0.5442244
+0.71659744
+0.6306643
+0.52392393
+0.66216165
+0.57559747
+0.50626665
+0.53091234
+0.50743634
+0.57716715
+0.7824497
+0.41367468
+0.55546504
+0.3030582
+0.6136134
+0.36521676
+0.43919942
+0.33232304
+0.51073956
+0.9655301
+1.0148821
+0.8726425
+0.30961013
+0.747004
+1.1461548
+1.3142052
+0.889127
+0.45464084
+0.5808323
+1.0770975
+1.3939735
+0.9165097
+0.6586972
+0.57355326
+0.9547619
+0.9447146
+0.66483366
+0.30041847
+0.3404827
+0.5929992
+0.7068603
+0.41881943
+-0.11529228
+-0.06013718
+0.029292889
+0.2176899
+0.14616063
+0.14816451
+0.13036805
+0.1793373
+0.3953
+0.51387286
+0.35285914
+0.06709124
+0.2171802
+0.6583215
+0.5220034
+0.44539294
+0.054360673
+0.18225458
+0.47989392
+0.5178179
+0.4576618
+0.16889913
+0.27844474
+0.32638916
+0.39993882
+0.119894765
+0.67456526
+1.4996389
+1.7681378
+1.6962894
+1.266272
+0.73875403
+1.6141837
+1.7386745
+1.671539
+1.1571932
+0.546496
+1.1523583
+1.2499596
+1.2602416
+0.7421503
+0.19625238
+0.6587611
+0.66948915
+0.43528196
+-0.008682725
+0.05109705
+0.13888682
+0.24387836
+-0.13002548
+-0.3703551
+0.06102093
+0.0076322197
+-0.035532437
+-0.029681634
+-0.057815406
+0.20116982
+0.27798048
+0.22556874
+0.3058461
+0.039763346
+0.10804575
+0.42170766
+0.3397586
+0.44702667
+0.19944976
+0.12492277
+0.2690411
+0.31178012
+0.307435
+0.09525637
+0.31001845
+0.20959602
+0.30736595
+0.2639023
+0.07473994
+-0.20428133
+0.123462535
+0.08172282
+0.0273528
+0.012557347
+-0.050085112
+0.15972462
+0.4576377
+0.26537335
+0.05294297
+0.1920879
+0.43903905
+0.44806978
+0.24177204
+0.15497287
+0.004198166
+0.24119955
+0.23940569
+0.30403528
+0.10443368
+-0.03242823
+-0.009877937
+-0.056617204
+-0.034309167
+-0.30718032
+-0.21831672
+-0.33697575
+-0.06903099
+-0.21208347
+-0.26106125
+-0.03470626
+-0.17156434
+-0.034266062
+-0.11911982
+-0.06517054
+-0.0014468514
+0.13053921
+-0.021993743
+0.08158244
+-0.048275527
+0.073179156
+0.11620164
+0.18908599
+0.090895034
+-0.13516097
+-0.041694365
+0.19145414
+0.06233252
+-0.015241079
+-0.08720653
+0.27016148
+0.68275934
+0.9259101
+0.87553996
+0.6730488
+0.5436024
+0.93307287
+1.284303
+1.215596
+0.7024047
+0.6535529
+1.0312322
+1.2054113
+1.1569601
+0.78507113
+0.46270427
+0.96070755
+1.0094548
+0.8725796
+0.584176
+0.2608554
+0.68085426
+0.6351991
+0.5974386
+0.44071475
+-0.14620513
+-0.051413815
+0.123140134
+0.3022954
+0.3937261
+0.14715014
+0.14558095
+0.37810993
+0.6081454
+0.4194721
+-0.048754267
+0.08287452
+0.5189599
+0.62214893
+0.7360417
+-0.06856284
+0.1070881
+0.296386
+0.6012432
+0.60254496
+-0.24324551
+0.14447688
+0.18799835
+0.46327543
+0.45924807
+0.20411673
+1.1002504
+1.4868475
+1.5346047
+1.0632775
+0.33373544
+1.1446538
+1.4786532
+1.4592378
+0.9056299
+0.22967416
+1.0249681
+1.2026587
+1.0556481
+0.6419271
+0.16762647
+0.475342
+0.64084166
+0.45603147
+0.19102122
+-0.17340069
+0.14535804
+0.13595402
+0.09039172
+-0.185116
+0.11963739
+0.3589415
+0.3841168
+0.5203414
+0.20129839
+0.20421675
+0.22073998
+0.4301539
+0.6149839
+0.42226243
+0.31898078
+0.31484243
+0.34544006
+0.5597543
+0.4067382
+0.12620181
+0.39053708
+0.38691083
+0.5219121
+0.62844783
+0.3108787
+0.46809235
+0.39197984
+0.38944077
+0.4951729