【求助帖】关于青少年挑战赛能量机关的问题

做了几天的能量机关的程序，因为没有设备和场地，暂时只能在模拟器里进行，有几个问题，希望有大神能帮忙解答一下
1.第一个版本是最弱智的版本，只用了识别并瞄准，实际情况就是太慢了，效率太低
2.第二个版本加入了PID控制器，用PID控制器控制云台的瞄准目标，模拟器里没问题，在借来的现实场地里发现只能打1.2，到3的时候就晕了
3.第三个版本是在网上和别人要的，只有了简单的算法，设计思路看懂了，但是实际情况一个都打不到

所以这个激活能量机关应该怎么设计程序呀，感觉这个程序搞定了基本上就能赢比赛了，太困扰我了呀

第一步是做收集数据,  然后你要知道所有目标和射击中心的差距, 然后差距可以换算为旋转角度,然后加上现在云台角度后, 那麽从数据中可以得出五组角度,然后依次运动射击就行,因为射击过程中不做判断,我们队伍称这种射击为盲射
优点是需要数据少,比较稳定,但是抗干扰能力比较差, 子弹浪费的多
还有一种是射的时候判断有没有射好,可以补射或重射 但需要稳定的识别

我也需要学习

现在有收获了不，发出来学习一下

冒泡排序+坐标换算