欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2022116078532
申请人: 广东海洋大学
专利类型:发明专利
专利状态:未下证
专利领域: 控制;调节
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种欠驱动水下机器人鲁棒轨迹跟踪控制方法,其特征在于,包括以下步骤:S1、构建欠驱动自主水下机器人五自由度运动学和动力学模型;

S2、基于五自由度运动学和动力学模型,通过视线法将五个自由度误差转换为位置误差、俯仰角误差和偏航角误差;

S3、通过位置误差、俯仰角误差、偏航角误差及预设性能函数构建误差转换函数;

S4、通过误差转换函数构建 辅助控制器,通过 辅助控制器产生虚拟速度;

S5、构建并采用自适应固定时间滤波器对 辅助控制器产生的虚拟速度进行滤波,得到滤波后的结果;

S6、构建 实际控制器,基于滤波后的结果通过 实际控制器获取欠驱动水下机器人的控制力和力矩,完成欠驱动水下机器人的控制;

S7、构建并通过 动态系统根据 辅助控制器和 实际控制器,使位置误差、俯仰角误差、偏航角误差在固定时间内收敛到零的邻域,完成欠驱动水下机器人的跟踪;

五自由度运动学和动力学模型表达式为:其中 表示欠驱动自主水下机器人的真实位移; 表示俯仰角; 表示偏航角;

分别表示 方向上的真实速度; 、 、 、 和 表示时变未知海洋扰动; 、 、 、 和 表示水动力系数; 、 、 、 和 表示质量和惯性参数; 、 和 表示待设计的控制器; 表示海水密度; 表示重力加速度;表示海水排水量; 表示纵向稳心高度;字符上一点表示求导;

步骤S2的具体方法为:

根据公式:

获取位置误差 、俯仰角误差 和偏航角误差 ;其中 为体坐标系中跟踪位置误差;

步骤S4中 辅助控制器的表达式为:其中:

表示虚拟速度, 包括 、 和 方向的虚拟速度; ;

; 为预设性能函数; ; 、 和 均为大于0的增益参数 ; 为 误 差转 换 函 数 ; ; 表示 s ig n 函 数 ,, ; 、 和 为中间参数; 表示期望的时变三维轨迹;

步骤S5中自适应固定时间滤波器的表达式为:其中 和 均为滤波器参数; 为未知正常量的估计值; 为滤波误差,, 为滤波后的结果; 表示sign函数;a和b均为指数参数, ,;

步骤S6中 实际控制器的表达式为:其中 为欠驱动水下机器人的控制力和力矩, 包括欠驱动水下机器人在 、 和方向的控制力和力矩; ; ; ;  ,, 和 为增益参数; 为速度误差变量, , ; 为大于0的常数; 为大于0的实数。

2.根据权利要求1所述的欠驱动水下机器人鲁棒轨迹跟踪控制方法,其特征在于,体坐标系中跟踪位置误差的计算表达式为:其中 表示期望的时变三维轨迹。

3.根据权利要求2所述的欠驱动水下机器人鲁棒轨迹跟踪控制方法,其特征在于,步骤S3的具体方法为:根据公式:

构建预设性能函数 ;其中 , 、 和 均为大于0的常数;t表示时间;

根据公式:

构建误差转换函数;其中 , 为转换后的位置误差函数; 为转换后的俯仰角误差函数; 为转换后的偏航角误差函数; 。

4.根据权利要求1所述的欠驱动水下机器人鲁棒轨迹跟踪控制方法,其特征在于,步骤S7中 动态系统的表达式为:其中 , 为x方向的外部不确定性扰动, 为 方向的外部不确定性扰动, 为 方向的外部不确定性扰动; 。