[发明专利]一种级联多移动机器人灵活编队方法

权利要求书

1.一种级联多移动机器人灵活编队方法，其特征在于，包括:基于选定的编队队形，根据机器人间的距离、角度和航向，确定动力学模型；根据动力学模型及动力学模型约束，确定非线性移动机器人的灵活编队方法中强化学习架构的先验控制器；基于移动机器人位姿向量的超参数确定动作空间，所述动作空间包括相邻两个移动机器人的编队跟踪动作空间和每个移动机器人独立灵活避障所需动作空间；根据移动机器人姿态与速度的跟踪误差确定状态空间，所述状态空间包括：当前时间步每个移动机器人跟踪相应虚拟移动机器人的跟踪误差的状态空间、相邻移动机器人之间的状态空间以及每个移动机器人描述周围环境信息所需的状态空间；设定强化学习的奖励函数，所述奖励函数包括编队奖励函数和避障奖励函数；

基于所述先验控制器，通过与环境交互，根据动作空间、状态空间以及奖励函数执行强化学习训练，训练完成获得包括编队策略与灵活避障策略的级联多移动机器人灵活编队方法。

2.根据权利要求1所述的一种级联多移动机器人灵活编队方法，其特征在于，所述动力学方程描述如下：

其中，η＝[x,y,θ]^T代表每个移动机器人的位姿向量，其中(x,y)为每个移动机器人的位置，θ为每个移动机器人的角度；为移动机器人的速度，ω为移动机器人的当前角速度，v_r与v_l分别代表移动机器人的左右两轮的速度；

所述动力学模型约束形式如下：

3.根据权利要求2所述的一种级联多移动机器人灵活编队方法，其特征在于，确定非线性移动机器人的灵活编队方法中强化学习架构的先验控制器的方法具体包括：S31.确定虚拟期望移动机器人的期望轨迹定义为η_r＝[x_r,y_r,θ_r]^T，(x_r,y_r)为虚拟期望移动机器人的位置，θ_r为虚拟期望移动机器人的角度，移动机器人根据虚拟期望轨迹确定姿态的跟踪误差以及速度的跟踪误差表示为：

e_x为x方向的位置跟踪误差；e_y为y方向的位置跟踪误差；e_θ为方位角的跟踪误差；分别是x方向的速度跟踪误差和y方向的速度跟踪误差；为角速度跟踪误差；为虚拟机器人的期望角速度；

S32.确定相邻移动机器人之间距离、角度和航向之间的期望编队模型，具体描述如下：

其中，v₁，v₂分别代表相邻移动机器人需要跟踪的虚拟机器人对象，记为虚拟机器人1与虚拟机器人2，(x_v1,y_v1)为虚拟机器人1的位置，(x_v2,y_v2)为虚拟机器人2的位置,θ_v1为虚拟机器人1的角度，θ_v2为虚拟机器人2的角度；d_v2v1为相邻移动机器人v1,v2的相对距离；φ_v2v1相邻移动机器人v1,v2的相对角度；β_v2v1为保持相同方位角的移动机器人的角度修正量；

S33.结合(1)-(4)与反馈线性化非线性控制理论，相邻移动机器人的编队控制先验的描述形式如下：

其中，v与w为移动机器人满足预设编队要求的速度与角速度，为虚拟机器人1非线性编队先验控制器的性能超参数,为虚拟机器人2非线性编队先验控制器的性能超参数,性能超参数直接决定先验控制器的控制性能。

4.根据权利要求1所述的一种级联多移动机器人灵活编队方法，其特征在于，所述相邻两个移动机器人的编队跟踪动作空间表示如下；

其中，为移动机器人跟踪虚拟机器人1非线性编队先验控制器的性能超参数,为移动机器人的相邻移动机器人跟踪虚拟机器人2非线性编队先验控制器的性能超参数,

所述每个移动机器人独立灵活避障所需动作空间表示如下；

其中，v_discrete与ω_discrete分别为移动机器人离散化的速度指令与角速度指令。