基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法技术

本发明专利技术公开了一种基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法，属于微重力机器人控制领域。本发明专利技术针对多个采样周期不同的中性浮力机器人之间的耦合问题以及优化问题进行研究，利用delta算子理论将不同采样周期的中性浮力机器人在控制器端模拟统一的采样周期，当其中某一个或者某几个中性浮力机器人需要更新控制量时，可以通过预测的方式来获取其他中性浮力机器人的状态，从而将其他中性浮力机器人的状态考虑到约束中求解自己的控制量，使得整体系统能够保证耦合概率约束非保守地满足，同时保证系统性能的良好。本发明专利技术结合计算机控制的特点，将复杂的在线优化问题转化为二次规划的问题，大大减少了计算量，适于工程应用。

【技术实现步骤摘要】
基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法
本专利技术属于微重力机器人控制领域，涉及一种中性浮力机器人姿态与轨迹控制方法，具体涉及一种基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法。
技术介绍
在微重力环境下进行的实验是验证地面空间技术的基本步骤之一。复杂空间操作的测试和演示要求地面测试系统提供长时间、大规模、精确、可控和几乎真实的微重力测试环境，以模拟空间运动与空间的相同程度。因此，应用中性浮力系统来进行微重力环境下的实验被广泛研究。同时，多个中性浮力系统联合执行任务也变得越来越重要。然而，在中性浮力系统中，机器人工作于水下环境，不仅各个控制力之间相互耦合，机器人严重受到水的黏性阻力影响，同时多个机器人需要知道其他机器人的姿态与轨迹以防止出现碰撞等问题。此外，机器人与控制器之间的通信通过无线网络进行，控制信号的丢失与时延也会影响对机器人姿态和轨迹的控制。因此，在中性浮力机器人姿态与轨迹控制方法设计中，寻求一种可以处理各种各样约束并且可以解决无线网络影响的控制方法显得尤为重要。当前由于模型预测控制方法具有对模型精度要求不高，系统鲁棒性好，稳定性好并且能够实时弥补由于模型失配、畸变、干扰等因素引起的不确定性，动态性能好，可以处理多变量约束等优点，广泛应用于电力系统、大化工过程、航空领域等。一般来说，模型预测控制方法包含三个过程：预测模型，反馈校正和滚动优化。其中，预测模型具有预测功能，可以根据系统当前时刻的控制输入以及过程的历史信息预测过程输出的未来值；反馈校正是通过将输出的量测值与模型的预估值进行比较，得出模型的预测误差，再利用模型预测误差来校正模型的预测值，从而得到更为准确的将来输出的预测值；滚动优化指的是优化过程不是一次离线完成的，而是反复在线进行的，即在每一采样时刻，优化性能指标只涉及该时刻起到未来有限的事件，而到下一个采样时刻，这一优化时段会同时向前推移。然而，现有的模型预测控制方法不能有效地解决多个耦合系统，且各个系统采样周期不同时的带约束优化问题，从而无法有效地控制各个系统。
技术实现思路
本专利技术的目的在于提供一种基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法，该方法结合计算机控制的特点，将复杂的在线优化问题转化为二次规划的问题，能够有效解决现有技术在中性浮力机器人姿态与轨迹控制上对耦合与抗扰方面不足的问题，大大减少了计算量，适于工程应用。本专利技术是通过以下技术方案来实现：本专利技术公开了一种基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法，包括以下步骤：步骤一：将中性浮力系统动力学模型写成状态空间方程式并进行线性化，得到线性模型；步骤二：利用delta方法将线性模型离散化，得到系统的离散化形式；步骤三：建立步骤二得到系统的优化问题，并将优化问题中的局部概率约束与耦合概率约束通过变化得到确定性的局部约束和耦合约束；步骤四：通过求解受局部约束与耦合约束的优化问题，得到最优控制量，从而对中性浮力系统进行控制。优选地，步骤一中，将中性浮力系统动力学模型写成状态空间方程式并进行线性化的具体操作为：考虑中性浮力机器人在体坐标系下的动力学模型如式(1)：其中，M为惯性质量矩阵，C(v)为科里奥利力矩阵，D(v)为机器人在水中受到的黏性阻力，g(η)为负浮力系数，τ为系统输入，为中性浮力机器人的加速度，v为中性浮力机器人的速度；所考虑的中性浮力机器人在地理坐标系Oxnynzn和机器人体坐标系Oxbybzb的关系如下式(2)：其中，是η的导数，J(η)为运动系数矩阵；分别指机器人在Oxn、Oyn和Oyz方向的位置；分别指机器人的横滚角，俯仰角以及偏航角，为机器人线速度向量，为机器人角速度向量；联立式(1)和式(2)，得到中性浮力机器人惯性坐标系下的动力学模型：其中，Mη(η)＝J-T(η)MJ-1(η)；Dη(η,v)＝J-T(η)D(v)J-1(η)，gη(η)＝J-T(η)g(η)；令x1＝η，和u＝τ，则式(3)表示为：其中，是x(t)的导数，x1(t)和x2(t)是系统的两个状态；将式(4)进行线性化处理，得到系统(5)：其中，和为系统线性化后的参数，x(t)为系统的状态，u(t)为系统的控制量；且(x0,u0)为系统(5)的平衡点，同时考虑系统(5)受到有界随机扰动ω(t)的影响，且ω(t)服从一定的概率分布，则得到：并且取：优选地，步骤二中，利用delta方法将线性模型离散化的具体操作为：考虑Np个中性浮力机器人通过无线网络与对应的控制器进行通信，并且这Np个中性浮力机器人控制器之间是通过可靠网络进行连接通信。使用无线网络通信需考虑时延与丢包问题，还需要考虑因为各个中性浮力机器人采样周期不同引起的需要更新控制量的控制器对其他中性浮力机器人状态不能准确判断的问题。因此，使用delta算子方法对系统(6)、(7)进行离散化，并且使用预测数据来解决丢包与时延问题，以对各个中性浮力机器人进行准确地控制。经过delta算子方法离散化后的系统模型变为：δxp(tk)＝Apxp(tk)+Bpup(tk)+Gpωp(tk)yp(tk)＝Cpxp(tk)+Dpup(tk)其中，T为选定的基础采样周期，即每个中性浮力机器人的控制器都以T为周期来离散化各自的系统；再将delta算子系统写成离散化的形式得到：xp(tk+1)＝(TAp+Ip)xp(tk)+TBPuP(tk)+TGpωp(tk)(8)yp(tk)＝Cpxp(tk)+Dpup(tk)(9)。优选地，步骤三具体操作为：考虑每个中性浮力机器人都受到关于输出yp(tk)的局部概率约束：Pr{yp(tk)≤hp}≥lp(10)且每个中性浮力机器人耦合输出量scp之和满足如下形式的约束；scp(tk)＝Ecpxp(tk)+Fcpup(tk)(11)其中，行向量Cp，Dp，Ecp，Fcp，标量hp，bc和概率lp∈[0,1]，pc∈[0,1]都是事先根据实际情况设定的常量。优选地，利用双模控制器的思想为每个中性浮力机器人设计如下形式的模型预测控制器：up(tk+i|tk)＝Kpxp(tk+i|tk)+cp(tk+i|tk),i＝0,1,…其中，Kp为离线确定的线性状态反馈增益矩阵，使得对于子系统(Ap,Bp)，Ap+BpKp是严格稳定的；对于选定的有限预测时域N，cp(tk+i|tk)，i＝0,1,…,N-1是通过在线求解下述优化问题得到的；当i≥N时，cp(tk+i|tk)＝0，考虑局部成本函数：其中，Lp可以离线求得，通过求解如下优化问题：minJp(C(tk))约束为式(10)与(12)，得到最优控制量与现有技术相比，本专利技术具有以下有益的技术效果：本专利技术公开的基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法，针对多个采样周期不同的中性浮力机器人之间的耦合问题以及优化问题进行研究，利用delta算子理论将不同采样周期的中性浮力机器人在控制器端模拟统一的采样周期，当其中某一个或者某几个中性浮力机器人需要更新控制量时，可以通过预测的方式来获取其他中性浮力机器人的状态，从而将其他中性浮力机器人的状态考虑到约束中求解自己的控制量，使得整体系统能够保证耦合概率约束非保守地满足，同时保证系统性能的良好。本专利技术结合计算机控制的本文档来自技高网...

【技术保护点】
1.一种基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法，其特征在于，包括以下步骤：步骤一：将中性浮力系统动力学模型写成状态空间方程式并进行线性化，得到线性模型；步骤二：利用delta方法将线性模型离散化，得到系统的离散化形式；步骤三：建立步骤二得到系统的优化问题，并将优化问题中的局部概率约束与耦合概率约束通过变化得到确定性的局部约束和耦合约束；步骤四：通过求解受局部约束与耦合约束的优化问题，得到最优控制量，从而对中性浮力系统进行控制。

【技术特征摘要】
1.一种基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法，其特征在于，包括以下步骤：步骤一：将中性浮力系统动力学模型写成状态空间方程式并进行线性化，得到线性模型；步骤二：利用delta方法将线性模型离散化，得到系统的离散化形式；步骤三：建立步骤二得到系统的优化问题，并将优化问题中的局部概率约束与耦合概率约束通过变化得到确定性的局部约束和耦合约束；步骤四：通过求解受局部约束与耦合约束的优化问题，得到最优控制量，从而对中性浮力系统进行控制。2.根据权利要求1所述的基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法，其特征在于，步骤一中，将中性浮力系统动力学模型写成状态空间方程式并进行线性化的具体操作为：考虑中性浮力机器人在体坐标系下的动力学模型如式(1)：其中，M为惯性质量矩阵，C(v)为科里奥利力矩阵，D(v)为机器人在水中受到的黏性阻力，g(η)为负浮力系数，τ为系统输入，为中性浮力机器人的加速度，v为中性浮力机器人的速度；所考虑的中性浮力机器人在地理坐标系Oxnynzn和机器人体坐标系Oxbybzb的关系如下式(2)：其中，是η的导数，J(η)为运动系数矩阵；分别指机器人在Oxn、Oyn和Oyz方向的位置；分别指机器人的横滚角，俯仰角以及偏航角，为机器人线速度向量，为机器人角速度向量；联立式(1)和式(2)，得到中性浮力机器人惯性坐标系下的动力学模型：其中，Mη(η)＝J-T(η)MJ-1(η)；Dη(η,v)＝J-T(η)D(v)J-1(η)，gη(η)＝J-T(η)g(η)；令x1＝η，和u＝τ，则式(3)表示为：其中，是x(t)的导数，x1(t)和x2(t)是系统的两个状态；将式(4)进行线性化处理，得到系统(5)：其中，和为系统线性化后的参数，x(t)为系统的状态，u(t)为系统的控制量；且(x0,u0)为系统(5)的平衡点，同时考虑系统(5)受到有界随机扰动ω(t)的影响，且ω(t)服从一定的概率分布，则得到：并且取：3.根据权利要求2所述的基于分布式模型预测控制的中性浮力机器人姿态与轨迹控制方法，其特征在于，步骤...

【专利技术属性】
技术研发人员：袁源，徐杨，袁建平，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西,61