面向海洋能驱动机器人的多源节能避障控制方法与系统

面向海洋能驱动机器人的多源节能避障控制方法与系统，涉及海洋能驱动机器人领域。本发明是为了解决现有的危险规避方法没有考虑海洋能驱动机器人在危险规避过程中的能量捕获与消耗的问题。本发明采集当前决策周期下海洋能驱动机器人航行区域的海洋环境信息以及海洋能驱动机器人的自身位置、姿态和速度信息，并获得速度限制集合、避碰动作集合以及下一决策周期内能达到的速度集合，对所有集合取交集，获得当前决策周期的动作空间窗口；在动作空间窗口内采样获得当前候选对水线速度和角速度，并通过状态转换方程获取当前候选轨迹簇；利用评价函数在候选轨迹簇中选取最优速度和角速度，实现当前决策周期下海洋能驱动机器人的多源节能避障控制。