一种轮式移动舞台机器人在线优化镇定控制方法技术

一种轮式移动舞台机器人在线优化镇定控制方法，针对轮式移动舞台机器人在非完整约束条件下实现镇定控制需要，首先通过定义轮式移动舞台机器人的离散时间三阶动力学模型和随机选择的初始时刻有限时间窗口控制序列，计算时间窗口内的镇定控制误差序列和误差序列关于控制输入序列的梯度，再利用牛顿法建立每个采样时刻控制序列的更新机制，并结合滚动优化控制原理，计算在每个采样时刻的控制输入量，实现轮式移动舞台机器人的镇定控制。本发明专利技术设计方法的优点是理解简单、设置参数少、通用性强以及在线计算简便，满足了轮式移动舞台机器人快速镇定控制的实时性要求。

Online optimization stabilization control method for wheeled mobile stage robot

A kind of wheeled mobile robot online optimization stage stabilization control method for wheeled mobile robot to achieve stabilization control in the stage to the nonholonomic constraint conditions, time limited time window control sequence first through the discrete time definition of wheeled mobile robot stage three order kinetic model and the random selection of initial calculation, time window stabilization gradient control error sequence and sequence error on the control of the input sequence, then establish the update mechanism of each sampling time control sequence using Newton method, and combined with the rolling optimization principle, the calculation of sampling control inputs in each moment, realize the stabilization control of wheeled mobile robot stage. The design method of the invention has the advantages of simple understanding, less setting parameters, high versatility and simple on-line calculation, and satisfies the real-time requirement of the quick stabilization control of the wheeled mobile stage robot.

【技术实现步骤摘要】
一种轮式移动舞台机器人在线优化镇定控制方法
本专利技术涉及一种轮式移动舞台机器人在线优化镇定控制方法。
技术介绍
舞台演出艺术已成为我国日常文化生活的重要组成部分，其中轮式移动舞台机器人是呈现高品质舞台演出艺术的重要道具之一。通常在曲目演出时，舞台机器人需要根据演出曲目的变化快速移动到指定目标位置。移动舞台机器人快速到达指定位置，可视为移动机器人的镇定控制问题。镇定控制的目标是获得一个反馈控制律使得移动舞台机器人渐近到达目标位置。但轮式移动舞台机器人存在非完整约束限制，任意光滑连续的时不变静态状态反馈控制律都无法驱动轮式移动舞台机器人到达指定的目标位置，这对轮式移动舞台机器人的镇定控制提出了挑战性。通过对现有轮式移动机器人镇定控制方法的文献的检索发现，轮式移动舞台机器人镇定控制方法主要有：非连续镇定控制、时变镇定控制、混杂镇定控制和模型预测镇定控制，但非连续镇定控制、时变镇定控制和混杂镇定控制不能处理轮式移动舞台机器人执行机构的物理约束和移动区间限制，模型预测镇定控制需要在线构造目标函数的Hessian矩阵，在线计算量很大，而且这些控制方法理解复杂，控制效果的收敛速度缓慢。因为轮式移本文档来自技高网...

【技术保护点】
一种轮式移动舞台机器人在线优化镇定控制方法，其特征在于：所述控制方法包括如下步骤：1)、建立轮式移动舞台机器人移动过程的离散时间动力学模型，参见式(1)：

【技术特征摘要】
1.一种轮式移动舞台机器人在线优化镇定控制方法，其特征在于：所述控制方法包括如下步骤：1)、建立轮式移动舞台机器人移动过程的离散时间动力学模型，参见式(1)：其中，正常数Ts表示采样周期，变量k表示采样时刻；x1(k)和x2(k)分别表示在k时刻轮式移动舞台机器人在舞台直角坐标系中X方向和Y方向的位置坐标；x3(k)表示在k时刻轮式移动舞台机器人在直角坐标系中的方位角；u1(k)和u2(k)分别表示在k时刻轮式移动舞台机器人的线速度和角速度；考虑模型式(1)，定义轮式移动舞台机器人的状态列向量x＝[x1x2x3]T和控制列向量u＝[u1u2]T，其中，符号T表示向量的转置；2)、将模型式(1)简记为式(2)：x(k+1)＝f(x(k),u(k))(2)其中，f(x(k),u(k))＝[f1(x(k),u(k))f2(x(k),u(k))f3(x(k),u(k))]T，f1(x(k),u(k))＝x1(k)+Tsu1(k)cosx3(k)，f2(x(k),u(k))＝x2(k)+Tsu1(k)sinx3(k)，f3(x(k),u(k))＝x3(k)+Tsu2(k)，建立轮式移动舞台机器人的离散时间预测模型，参见式(3)：x(k+j+1|k)＝f(x(k+j|k),u(k+j|k)),j＝0,1,...,M-1(3)其中，x(k+j|k)表示轮式移动舞台机器人控制系统在时刻k对未来时刻k+j状态的预测向量；正整数M表示优化时间窗口；3)、令uk,M＝[uT(k|k)uT(k+...

【专利技术属性】
技术研发人员：何德峰，姬超超，倪洪杰，郭晓慧，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江,33