【技术实现步骤摘要】
水下机器人多推进器耦合控制方法及系统
本专利技术涉及水下机器人控制
，尤其涉及一种搭载不少于六个推进器的水下机器人多推进器耦合控制方法及系统。
技术介绍
水下机器人无论是在军事，还是在人类生产生活中都有广泛应用，而对其良好的操作方法和运动控制是水下机器人顺利完成任务的重要前提和保障。然而，由于水下机器人在水中运动过程中，复杂多变的水域环境很可能会使水下机器人的某一个推进器处于非正常工作状态。目前水下机器人的多自由度姿态控制多采用多推进器解耦控制的方式来实现，如果某一个推进器出现异常工作，水下机器人姿态控制将会很差，甚至出现失控的情况。传统水下机器人对推进器的异常处理基本只有停机处理。
技术实现思路
鉴于目前存在的上述不足，本专利技术提供一种水下机器人多推进器耦合控制方法及系统，可以使水下机器人在某一个或者多个推进器出现异常的情况下正常工作，大大的提高了水下机器人的可靠性和安全性。为达到上述目的，本专利技术的实施例采用如下技术方案：一种水下机器人多推进器耦合控制方法，所述水下机器人多推...
【技术保护点】
1.一种水下机器人多推进器耦合控制方法，其特征在于，所述水下机器人多推进器耦合控制方法包括以下步骤：/n检测推进器状态并获得正常工作的推进器信息；/n通过姿态传感器获得水下机器人的姿态数据；/n通过耦合控制模块结合姿态数据和正常工作的推进器信息计算出水下机器人自稳状态的控制输出；/n将控制输出发送给推进器执行。/n
【技术特征摘要】
1.一种水下机器人多推进器耦合控制方法，其特征在于，所述水下机器人多推进器耦合控制方法包括以下步骤：
检测推进器状态并获得正常工作的推进器信息；
通过姿态传感器获得水下机器人的姿态数据；
通过耦合控制模块结合姿态数据和正常工作的推进器信息计算出水下机器人自稳状态的控制输出；
将控制输出发送给推进器执行。
2.根据权利要求1所述的水下机器人多推进器耦合控制方法，其特征在于，所述姿态传感器包括电子罗盘、加速度计和陀螺仪，姿态传感器输出值为电子罗盘、加速度计、陀螺仪原始数据通过传感器融合算法融合后的值。
3.根据权利要求2所述的水下机器人多推进器耦合控制方法，其特征在于，所述通过姿态传感器获得水下机器人的姿态数据包括：姿态传感器三维角度输出值分别为航向角、俯仰角和横滚角；三维角速度输出值分别为航向角速度、俯仰角速度和横滚角速度；姿态传感器安装位置为X轴方向指向水下机器人的前进方向。
4.根据权利要求1所述的水下机器人多推进器耦合控制方法，其特征在于，所述耦合控制模块包括非线性PID控制算法、静止坐标系到运动坐标系的转换关系和推进器在坐标系的位置映射。
5.根据权利要求4所述的水下机器人多推进器耦合控制方法，其特征在于，所述非线性PID方向控制算法包括：利用相应的非线性化函数对PID控制器中的控制输入量进行非线性转换，构造出KP[e(t)]、KI[e(t)]、KD[e(t)]，得到非线性PID控制模型如式(1.1)所示：
其中：KP[e(t)]为非线性比例参数，KI[e(t)]为非线性积分参数，KD[e(t)]为非线性微分参数，e(t)为系统误差，u(t)为PID控制器的输出。
6.根据权利要求5所述的水下机器人多推进器耦合控制方法，其特征在于，所述非线性PID方向控制算法包括：
首先对式(1.1)进行离散化处理，用数字形式的差分方程代替连续系统的微分方程；
为了用数字形式的差分方程代替连续系统的微分方程，便于计算机实现，将微分项近似用求和及增量式表示：
将式(1.2)代入(1.1)，则可得到离散的PID表达式：
上式中，采样周期足够小才能保证系统具有一定精度；E(k)为第k次采样时的偏差值，E(k-1)为第(k-1)次采样时的偏差值，k＝0，1，2…；P(k)为第k次采样时的控制输出。
7.根据权利要求4所述的水下机器人多推进器耦合控制方法，其特征在于，所述静态坐标系到运动坐标系的转换关系包括：水下机器人姿态方向方面涉及两个坐标系，即运动坐标系相对于静止坐标系的取向；运动坐标系变换到静止坐标系为经过三个维度旋转得到的，从动坐标到静坐标的欧拉定...
【专利技术属性】
技术研发人员：邢瑞毅，孙端晨，方俊波，刘吉辉，杨元侃，
申请(专利权)人：欧舶智能科技上海有限公司，
类型：发明
国别省市：上海;31
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。