0
  • 聊天消息
  • 系统消息
  • 评论与回复
登录后你可以
  • 下载海量资料
  • 学习在线课程
  • 观看技术视频
  • 写文章/发帖/加入社区
创作中心

完善资料让更多小伙伴认识你,还能领取20积分哦,立即完善>

3天内不再提示

基于STM32控制器和惯性测量传感器实现多功能水中蛇形机器人的设计

牵手一起梦 来源:电子产品世界 作者:王新怀,李小双, 2021-04-13 15:58 次阅读

作者:王新怀,李小双,何伟键,黄子明,黄原成,金杰

本文设计了一种可闭环控制的多功能水中蛇形机器人,主要解决现有无人潜水器不能进行运动姿态调整、续航能力低且功能较为单一的问题。蛇体内部装有的三轴加速度计、三轴陀螺仪、三轴磁力计可用于实时采集蛇形机器人运动时的加速度大小和方向、转向时的角速度和所处的方位,通过Kalman滤波算法对这九轴数据进行融合,可以得出机器人在行进时较为准确的航向角运动检测和定位功能;蛇体外表面覆盖有柔性太阳能电池板,可在电池电量不足时浮出水面进行充电;蛇体前端的可伸缩式机械臂、旋转钻头和探照灯,可用于水中作业;蛇体内的无线摄像头及多种传感器采集的信息经无线数传模块实时传输至人机界面,人机界面也可以对蛇体进行远程控制。通过人机界面与蛇体之间的交互,可以实现自动跟踪水下物体、显示蛇体运动路径、显示蛇体三维姿态、控制机械臂、图像化显示传感器数据等功能。

引言

在自然界中,生物蛇具有运动方式多变、良好的环境适应性及运动稳定性等典型特点,仿生机械学中模仿生物蛇的蛇形机器,它具有结构合理、控制灵活、性能可靠、可扩展性强等特性。蛇形机器人是一种高冗余度移动机器人,具有多于确定机器人空间位置和姿态所需的自由度,使得它可以摹仿生物蛇的无肢运动,蛇形机器人的这些特点使得它在复杂的海洋环境勘测中具有广阔的应用前景,如军事侦察、海底矿藏调查、输油管道检查、钻井平台水下结构检修、电缆检查、水下考古、海上养殖及江河水库的大坝检查等领域。

1 系统总体设计

采用STM32作为主控制器,它通过异步串口通讯将控制指令分别传输给16路舵机控制器、无线摄像头、直流电机控制器和探照灯;主控制器与人机界面、十自由度传感器、电量检测模块、温湿度传感器组和体外压力传感器之间实现了数据的双向传输;舵机控制器可发送16路独立的PWM波给舵机,以实现对机器人运动姿态的控制,并与十自由度传感器结合实现了对蛇体的闭环控制。电气系统整体架构如图1所示。

其次,一个重要的作用便是通过异步串口通讯方式实现与iNEMO board的通讯,使用开发板板载的惯性测量传感器,将三轴加速度计、三轴陀螺仪以及由三轴磁力计制作的电子罗盘所得出的数据融合起来,通过Kalman滤波算法克服了加速计在运动情况下的角度不稳定同时也防止了陀螺仪的累积误差,从而可得出相对较为准确的航向角。

2 传感器应用方式

(1)LPS331AP 气压计,用于检测蛇体内部的密闭性,在下水之前,通过人工给蛇体内部增压到一定值停止,观察气压计的读数是否在一定时间内大幅度下降,从而判断蛇体的密闭性。

(2)LSM303DLHC加速计与磁力计和L3GD20陀螺仪,通过LSM303DLHC三轴加速度计、三轴磁力计以及L3GD20三轴陀螺仪9轴的数据融合得到较为精确的航姿参数pitch_angular、roll_angular、yaw_angular,并把它们传送给STM32核心控制板,控制板通过接收的参数判断当前蛇体所处的运动姿态,进而对其进行控制。

(3)板载的温度传感器可用于测量蛇体内的温度变换情况。

(4)PH电极传感器,用于测量水中的PH(实际未使用该传感器,该项功能作为保留)。

另外一个作用便是通过无线数传模块把开发板搭载的传感器感知的环境信息以及机器人整体的姿态信息反馈给地面PC控制终端,并实时地把传感器信息显示在基于LabView开发的上位机窗口中,同时上位机窗口中可以选择水蛇运动的模式,包括前行、后退、转弯、上游、下潜、上浮、下沉、调速等,并把控制指令通过无线数传模块传给主控制板。

3 数据融合的理论推导

由加速度计、陀螺仪、磁力计及运算单元构成的航姿参考系统,能够为蛇形机器人提供航向、横滚和侧翻信息,用来为机器人提供准确可靠的姿态与航行信息,其内部对多传感器数据进行融合的航姿解算单元为卡尔曼滤波器

4 方案设计实现

4.1 摄像头模块

摄像头拟采用usb 2.4G无线摄像头,独立于主控制板之外,摄像头采集的图像信息直接传给地面控制终端,由专用接收器接收并显示在PC上位机窗口中。

4.2 驱动关节设计

蛇形机器人每个关节处采用两个舵机进行正交连接,实现每个关节2个自由度的控制,使得蛇形机器人能够在三维空间运动,如图2与图3所示。

4.3 供电系统

采用11.1V,4000Mah,20C锂电池组为整个系统供电,为提高机器人的续航能力,采用太阳能电池板通过升压电路对锂电池进行充电,机器人外壳采用透明材料(取自空饮料瓶),内表面覆盖柔性太阳能电池板,通过多块柔性太阳能电池板串并联可实现对锂电池12V/2W充电,太阳能电池板对锂电池充电时,机器人漂浮在水面上(实际作品未使用太阳能电池板,该项功能保留,待后续开发)。

4. 4 人机界面HMI的开发

这里使用自动化组态软件LabView来开发蛇形机器人的人机界面,其工作流程图如图4所示。

5 测试与验证

5. 1 Maya运动仿真

从整个制作的过程来看,机器人整体的机械结构设计较为复杂,但是最终还是完成了结构的设计、加工与装配。运动姿态在Maya软件上进行了仿真测试,为蛇形机器人的步态设计带来了方便,如图9所示。

5. 2 实验室测试

在Maya软件上实现了蛇形机器人的动态仿真后,在实验室进行了“悬空测试”,验证所设计的步态的可靠性,如图10所示。

5. 3 下水测试

为了进一步验证步态设计的实际可行性以及蛇形机器人的整体防水性,团队进行了一次下水试验。试验结果表明,由于蛇形机器人自身的重力略小于其所能达到的最大浮力,蛇形机器人在水中静止状态下可以实现漂浮,与理论计算结果相符,在水面上的二维蜿蜒步态运动效果较好,如图11所示。

6 总结与展望

6. 1 创新之处

(1)借助于iNEMO board,使得让原本开环的蛇形机器人系统实现了闭环控制,相比于传统各类蛇形机器人的开环控制有了巨大的突破。

(2)正交连接的舵机组成的动力结构实现了机器人的三维运动,使得运动姿态更加丰富,应用领域也会更加广泛。

(3)模块化的蛇形机器人骨架设计思想,使得某一关节出现问题时可以进行独立更换。

(4)基于LabView制作的上位机软件功能强大,实现了各种数据和指令的实时传输以及摄像头捕捉到的视频显示。

6. 2 展望

蛇形机器人是一种新型的仿生物机器人,与传统的轮式或两足步行式机器人不同的是,它实现了像蛇一样的“无肢运动”,是机器人运动方式的一个突破,具有结构合理、控制灵活、性能可靠、可扩展性强等优点。

本文设计的水下蛇形机器人希望将来能够在海洋复杂环境勘测中得到应用,如军事侦察、海底矿藏调查、输油管道检查、钻井平台水下结构检修、电缆检查、水下考古、海上养殖及江河水库的大坝检查等领域。

责任编辑:gt

声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容侵权或者其他违规问题,请联系本站处理。 举报投诉
  • 传感器
    +关注

    关注

    2515

    文章

    47698

    浏览量

    738693
  • 控制器
    +关注

    关注

    112

    文章

    15029

    浏览量

    170358
  • 机器人
    +关注

    关注

    206

    文章

    26831

    浏览量

    201033
收藏 人收藏

    评论

    相关推荐

    智能机器人对于传感器的需求

    必不可少的。  最后,最不可缺少的一点也就是传感器的安装问题。智能机器人的安全问题首先是它的自我保护,另外一方面则是机器人为保护人类安全不受侵犯采取的措施。人类在工作时,总是利用自己的感觉反馈,
    发表于 01-20 14:56

    扭矩传感器实现机器人敏捷操作

    和较短的静区时间。”Klaus Kunze 说。通过倍福的标准EtherCAT 端子,完美地实现了力传感器和伺服驱动的连接。倍福的 SSI终端从机器人腿的位置传感器采集数据。机械臂和躯
    发表于 01-21 17:11

    机器人传感器

    ,就能依靠经验,学习到很多更好的作业方法,并且熟练掌握。 机器人传感器可分为机器人内部传感器机器人外部
    发表于 01-03 17:09

    机器人传感器的类别和应用原理

    一般机器人系统由机械手、环境、任务和控制器四个互相作用的部分组成。我们称一般安装在机器人机械手上的传感器为内传感器(Inner Senson
    发表于 11-08 15:55

    超声波传感器机器人避障中有什么作用

    机器人是由计算机控制的复杂机器,它具有类似的肢体及感官功能;动作程序灵活;有一定程度的智能;在工作时可以不依赖
    发表于 02-27 23:29

    基于ARM9的DF-1机器人传感器系统设计

    感知外部环境信息和自身状态,获得反馈信息,实现系统的闭环控制。目前在仿人机器人中应用的传感器种类繁多,例如视觉传感器、电子罗盘、加速度计和超
    发表于 06-21 07:04

    采用ARM9实现嵌入式仿人机器人传感器系统设计

    0引言传感器技术是仿人机器人研究的关键技术之一。仿人机器人之所以能在已知或未知的环境中完成一定的作业功能,是因为它能够通过传感器感知外部环境
    发表于 07-29 06:09

    如何设计智能灭火机器人控制器

    性能与可靠的机械控制性能的同时保证,才能在短时间内准确寻找到火源并灭火回家。在此以ARM9处理为核心,对基于嵌入式系统的智能灭火机器人进行了设计。本文将从硬件和软件方面讲述智能灭火机器人
    发表于 07-31 06:23

    工业机器人控制器有什么功能

    工业机器人控制器功能多任务功能一台机器人可进行多个任务的操作;
    发表于 09-12 09:10

    机器人传感器应用

    随着智能化的程度提高,机器人传感器应用越来越多。智能机器人主要有交互机器人传感机器人和自主
    发表于 09-16 09:05

    机器人传感器分类方法

    一般机器人系统由机械手、环境、任务和控制器四个互相作用的部分组成。我们称一般安装在机器人机械手上的传感器为内传感器(Inner Senson
    发表于 09-16 08:45

    高精度传感器如何在创造机器人的自然动作中发挥作用?

    元件。手臂、躯体、车轮等机器人主体的可动部都装有小型伺服电机,控制器将精准地控制每个电机的动作。同时,角度传感器则准确地检测电机旋转的角度和速度。  为了让陪伴
    发表于 03-04 14:41

    机器人是什么?

    机器人还有很长的路要走。传感器以电子信号的形式向控制器发送信息。传感器也给机器人控制器有关它的
    发表于 03-31 10:31

    相扑机器人控制器资料分享

    描述相扑机器人控制器我的 Sumo 机器人比赛项目,我使用了 ATmega2560 -16au 微控制器和 BTN7960B 电机驱动、6
    发表于 06-28 06:38

    通过多轴工业机器人来聊聊机器人控制系统以及控制器实现

    机器人控制系统当中。那么今天,我们就通过多轴工业机器人来聊聊机器人控制系统以及控制器
    发表于 02-24 17:05