1.一种基于迭代学习的扫地机器人轨迹控制方法,其特征在于,包括:S1,迭代学习动力学模型建立步骤;
建立扫地机器人轨迹控制的迭代学习动力学模型,如下: (1) (2)其中, ; ; ;
; 表示扫地机器人在第 次迭代学习时轨迹控制动力学输出;
表示扫地机器人在第 次迭代学习时轨迹控制动力学输入; 、和 分别表示第 次迭代学习时 时刻扫地机器人在平面坐标轴的横坐标位置、纵坐标位置以及方向角; 、 和 分别表示第 次迭代学习时 时刻扫地机器人在平面坐标轴的横坐标位置、纵坐标位置以及方向角; 表示第 次迭代学习时扫地机器人的线速度, 表示第 次迭代学习时扫地机器人的方向角速度;
表示采样周期; , 表示扫地机器人最大运行周期;
S2,参数设置步骤;
设置迭代学习最大次数为 及控制方法最大运行次数为 ;
设置控制参数 ;令迭代学习次数 时扫地机器人轨迹控制动力学系统输入, ,计算对应的迭代学习控制适应度值函数 ,设置当前最优迭代输入 ,及设置当前最优迭代学习控制适应度值为;
设置种群数目为 ,进化种群概率为 ,其中 且 ;
S3,参数比较步骤;获取 内服从均匀分布的随机数 ,比较 与 的大小,如果,执行S4,如果 ,执行S5;
S4,全局搜索步骤;
全局搜索获得的迭代控制输入 如下式: (3)
其中, 表示第 次迭代学习时搜索的最优解对应的维度 数值, ;
表示第 次迭代学习时搜索的最优解对应的维度 数值, 和分别表示第 次和第 次迭代学习时第 代搜索的解对应的维度 数值, ;和表示 内服从均匀分布的随机数; 表示求最小值操作; 表示绝对值;
计算种群产生的迭代控制输入 对应的迭代学习控制适应度值 ;
S5,局部搜索步骤;
局部搜索获得的迭代控制输入 如下式: (4)
其中,和 为 内服从均匀分布的随机数, 表示求最大值操作;
计算种群产生的迭代控制输入 对应的迭代学习控制适应度值 ;
S6,更新步骤;
更新最优迭代控制输入和最优控制适应度值;
如果迭代学习控制适应度值 小于当前最优迭代学习控制适应度值,更新当前最优迭代学习控制适应度值为 ,且将对应的迭代控制输入 更新为当前最优解 ;
令控制参数 ;
S7,运行次数判断步骤;
重复执行S3 S6,直至 达到最大运行次数 ,令 ,执行S8;
~
S8,迭代学习次数判断步骤;
如果迭代学习次数达到 ,则输出当前最优迭代学习控制适应度值 及最优解 ,并停止执行,否则转向S3继续执行;
S9,跟踪轨迹输出步骤;
将获得的最优解 代入建立的扫地机器人轨迹控制的迭代学习动力学模型(1),获得跟踪上理想跟踪轨迹的动力学输出 。
2.根据权利要求1所述的基于迭代学习的扫地机器人轨迹控制方法,其特征在于,所述迭代学习控制适应度值函数 ,表示如下: (5)其中, 和 为大于0的权重因子; 表示扫地机器人在第 次迭代学习时轨迹控制动力学输入; 为第 次迭代控制跟踪误差; ,表示扫地机器人轨迹控制的理想跟踪轨迹; 表示向量2‑范数。