水下机器人控制系统培训

水下搜救机器人

系统设计

主讲人:陈巍目录1、研究的目的和意义2、水下机器人运动建模3、水下机器人系统设计方案4、水下机器人姿态及控制原理5、仿真验证及分析研究的目的和意义

我国拥有近18000公里的海岸线，北起鸭绿江口，南止于北仑河口。约300万平方公里的海洋国土，是一个真正的海洋大国，但对海洋资源的开发利用尚处于起步阶段。

因此，强大的水下探测设备的发展已经成为提高我国海洋维护和充分利用资源的重要保障，智能化、多功能无人水下航行器的研究是大势所趋。水下机器人的概念、分类1、载人水下机器人2、遥控式水下机器人3、自治式水下机器人TUV-拖曳式水下机器人ROV-遥控式水下机器人UUV-自主航行水下机器人AUV-人工智能控制水下机器人

非完全自主机器人，需要水面平台上的人员通过数据传输缆向水下机器人传输控制信号以完成实时操作

完全自主的智能型机器人，其没有线缆的束缚，运动更为灵活，主要通过水下潜器核心控制板中预设好的程序进行活动，并能根据实时环境和任务的变化，进行智能控制。系缆自由运动水下遥控机器人（tetheredfree-swimmingROVs）底部爬行水下遥控机器人（bottom-crawlingROVs）结构附着型水下遥控机器人（structurallyreliantROVs）水下机器人的用途水下机器人的主要应用1、安全搜救：检查水下部件结构好坏等。2、管道检查：海底油管检查等。3、科研教学：冰层下观察等。4、水下娱乐：深海潜水器等。5、考古：包括水下沉船考察等。6、渔业：网箱监测等。水下机器人的国内外发展现状及趋势

西方发达国家已经在水下机器人制造领域研究了六七十年的时间，也取得了一定的成绩，在这期间水下机器人制造技术发展迅速。十九世纪五十年代美国加快了在水下机器人研制方面的脚步，最终于1960年研制成功了世界上第一个真正意义上的ROV。（1）我国在1986年开始先后研制成功了多艘300米级的水下机器人ROV。（2）水下机器人ROV通常在一艘船或者一个位于水面的平台上操控，为提高效率，需扩大搜索范围。（3）水下机器人ROV由于操作人员能在水面平台上通过由一系列功能强大的计算机组成的工作站对水下机器人进行运行与控制。我国水下机器人研制起步较慢，大概从二十世纪八十年代开始，由中科院沈阳自动化研究所、上海交通大学及哈尔滨工程学院牵头率先进行水下机器人的研制工作，并在短短30年里取得了傲人的成绩，多项水下机器人项目成功下水试验。在新时期，各领域对水下机器人的应用范围、功能等提出了更高的要求：水下机器人运动控制系统设计简述

水下机器人ROV在水面平台操作人员的控制之下，也需要适当感知周围环境变化，进行选择性自主避障，同时及时反馈环境信息，以帮助操作者做出正确的决策保证任务更好的完成。这就需要针对具体的结构框架，进行较为智能的运动控制。并不存在一套现有的能够满足所有水下机器人ROV运动的控制系统，其一般需要根据具体任务环境搭载多种不同种类的传感器，并通过传输线缆将数据传到水面平台，以保证操作者能及时有效的操控机器人。水下机器人运动控制方法水下机器人ROV在水中运动时进行精确控制存在的主要影响：1、任务过程中机械手进行的各种运动2、任务过程中可能进行的物品收集或释放3、水下机器人在水下运动过程中引起的周围水流以及水下本身存在的水流的干扰4、水动力系数的不确定性ROV的智能控制方法神经网络控制模糊控制自适应控制因此我们采用常用于飞行器控制方面的Backstepping自适应控制算法，并做出一些改进，以适合水下机器人的运动模型。机体构造与航行原理仿制四旋翼飞行器的电机布局采用正反桨的方案水下机器人整体结构设计设计理念框架浮力配置

采用高分子材料主要材料,其密度为0.5千克每立方米。这种材料的优势在于可以进行车铣切削加工，从而能打造更完美的流线型外观重力配置防水压力舱材料上选择亚克力为主要材料，主要原因如下：1、亚克力的硬度高，平均达洛氏硬度值8、9度左右。2、亚克力的透明度高，透光率在92%以上。3、亚克力有良好的加工性能。照明系统水下机器人上安装了2个射灯，安装在机器人的左右两侧，其中一个向前照射，主要为了能让机器人看清前方物体；另一个照射机械手；主要是为了看清前方物体从而方便机械手的抓取。机械手作为完成所有核心任务的主要部件之一气动和电机的驱动的两种方法进行选择推进器的布局和受力分析

由于推进器重量不轻，其数量直接影响水下机器人整体的重力和浮力，而其布局又是影响运动控制的关键。因此本节着重解决推进器的布局问题，并对机器人整体在水下的受力进行简要分析。推进器的布局遵循以下两个原则：1、应尽可能将所放置的推进器产生推力的三个轴的合力交汇于同一点。2、平移运动时，理论上推进器的放置最好与壳体的坐标系保持在同一条平行线上水下机器人空间运动受力分析机器人在水下运动时，有五种力会影响其运动：1、环境干扰力2、重力3、浮力4、推进器推力5、托举力环境干扰力求得相对流速：其中，

为流速，

为流向角，

为艏向角。对时间微分后可得到相对加速度：重力浮力推进器推力坐标系的定义及坐标转换矩阵动力系统模型模型建立水下机器人ROV控制系统结构水下机器人运动控制系统控制模式自动定深和自动定高速度控制定位控制嵌入式控制系统硬件设计

采用Freescale公司的IMX283芯片作为CPU主控芯片，对控制系统内ARM最小系统模块、电机驱动模块、姿态检测模块、通信接口模块进行了模块化设计。主控模块设计ARM9+coterx-m3的双核心控制模式，机器人还采用了STM32F103VET6（coterx-m3内核）作为实时运动控制器电机驱动模块设计电路采用四个STD60NF06T4（NMOS）搭建H桥采用L6385驱动MOS管，通过与非门进行逻辑匹配姿态检测模块设计使用MPU-6000用于获取三轴加速度和角速度的变化，解决姿态算法的四要素和变换的欧拉角；AK8975得到漂移角，惯性补偿运动。通信接口模块设计

控采用飞思卡尔IMX283芯片，基于ARM926的核，主要负责串口与水下的基于STM32的姿态解算板进行通信，以太网通信方式主要考虑到STM32芯片之间的CAN通信易丢失帧。基于四元数法的捷联姿态描述方向余弦法：欧拉角法：四元数法：

基于四元数法的捷联姿态描述

基于Backstepping的水下机器人控制

采用反步法（Backstepping）、滑模控制（SlidingMode）、线性二次型最小二乘法（LQR）、神经网络自适应、反馈线性化以及H∞控制等方法对四旋翼飞行器进行控制。

滤波器的设计二阶滤波器的阻尼比，为自然频率从输入

到输出

的传递函数为：Backstepping控制器的设计1、定义位置误差：2、定义速度误差3、定义变量4、定义姿态角误差

5、定义角速度误差静水域下定位控制仿真试验波浪干扰下深度控制仿真试验场外试验无控制状态运动控制器作用下环境1运动模式2电机电流3姿态变化4电机电流姿态变化静水域上浮下沉≈2.5A≈0°≈3.1A≈0°前进