留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

基于超宽带测距的异构移动机器人轨迹跟踪控制

卫恒 吕强 王国胜 林辉灿 梁冰

卫恒, 吕强, 王国胜, 等 . 基于超宽带测距的异构移动机器人轨迹跟踪控制[J]. 北京航空航天大学学报, 2018, 44(7): 1461-1471. doi: 10.13700/j.bh.1001-5965.2017.0526
引用本文: 卫恒, 吕强, 王国胜, 等 . 基于超宽带测距的异构移动机器人轨迹跟踪控制[J]. 北京航空航天大学学报, 2018, 44(7): 1461-1471. doi: 10.13700/j.bh.1001-5965.2017.0526
WEI Heng, LYU Qiang, WANG Guosheng, et al. Trajectory tracking control for heterogeneous mobile robots based on UWB ranging[J]. Journal of Beijing University of Aeronautics and Astronautics, 2018, 44(7): 1461-1471. doi: 10.13700/j.bh.1001-5965.2017.0526(in Chinese)
Citation: WEI Heng, LYU Qiang, WANG Guosheng, et al. Trajectory tracking control for heterogeneous mobile robots based on UWB ranging[J]. Journal of Beijing University of Aeronautics and Astronautics, 2018, 44(7): 1461-1471. doi: 10.13700/j.bh.1001-5965.2017.0526(in Chinese)

基于超宽带测距的异构移动机器人轨迹跟踪控制

doi: 10.13700/j.bh.1001-5965.2017.0526
基金项目: 

国家自然科学基金 61663014

详细信息
    作者简介:

    卫恒  男, 博士研究生。主要研究方向:多机器人协同控制、多机器人SLAM

    吕强   男, 博士, 教授, 博士生导师。主要研究方向:自主移动机器人、计算机视觉、神经网络

    王国胜  男, 博士, 副教授, 硕士生导师。主要研究方向:移动机器人控制

    林辉灿  男, 博士研究生。主要研究方向:SLAM自主导航、四旋翼飞行器

    梁冰  女, 博士, 副教授, 硕士生导师。主要研究方向:四旋翼飞行器控制

    通讯作者:

    吕强.E-mail:rokyou@live.cn

  • 中图分类号: TP242

Trajectory tracking control for heterogeneous mobile robots based on UWB ranging

Funds: 

National Natural Science Foundation of China 61663014

More Information
  • 摘要:

    针对超宽带(UWB)测距过程中随机出现的奇异值,设计了改进的基于最小协方差的马氏距离奇异值检测模块;针对全向机器人的运动学和动力学特点,提出了一种基于滑模+PID控制的逆动力学前馈轨迹跟踪算法;针对UWB定位算法中出现的坐标跳动、边缘效应以及微型四旋翼的运动学特点,设计了基于扩展卡尔曼滤波(EKF)的轨迹跟踪控制算法;并在MATLAB和Gazebo仿真软件中分别进行了验证。为在实际环境验证轨迹跟踪控制算法的速度闭环控制和位置闭环控制以及UWB定位的实时性、准确性,搭建了基于UWB的异构多机器人系统,完成了四旋翼定点悬停、单个全向机器人轨迹跟踪、异构多机器人协同控制实验。实验结果表明,UWB定位系统和机器人控制算法能够满足控制的实时性和稳定性要求。

     

  • 图 1  双向测距算法

    Figure 1.  Two-way ranging algorithm

    图 2  双向测距算法实测结果

    Figure 2.  Measured results of two-way ranging algorithm

    图 3  基于MCD的马氏距离奇异值检测算法流程图

    Figure 3.  Flowchart of Mahalanobis distance singular value detection algorithm based on MCD

    图 4  基于稳健马氏距离奇异值去除之后的测距结果

    Figure 4.  Ranging results based on robust Mahalanobis distance after removal of singular value

    图 5  三边测量法的实测结果

    Figure 5.  Measured results of trilateration algorithm

    图 6  四轮全向机器人坐标系

    Figure 6.  Coordinate system of four-wheeled omnidirectional robot

    图 7  基于UWB的crazyflie2.0自主控制流程图

    Figure 7.  Flowchart of crazyflie2.0 autonomous control based on UWB

    图 8  轨迹跟踪仿真实验结果

    Figure 8.  Trajectory tracking simulation experimental results

    图 9  轨迹跟踪误差随时间变化

    Figure 9.  Variation of trajectory tracking deviation with time

    图 10  基于EKF crazyflie2.0运行轨迹

    Figure 10.  crazyflie2.0 running trajectory based on EKF

    图 11  多机器人研究平台

    Figure 11.  Multi-robot research platform

    图 12  多机器人系统网络示意图

    Figure 12.  Schematic diagram of multi-robot system network

    图 13  crazyflie2.0定点悬停UWB实测结果

    Figure 13.  Measured UWB results of crazyflie2.0 fixed point hovering

    图 14  单机器人sin x轨迹跟踪

    Figure 14.  Single robot sin x trajectory tracking

    图 15  crazyflie2.0协同任务实验轨迹

    Figure 15.  Experimental trajectory of crazyflie2.0 collaborative task

    图 16  全向机器人协同任务实验轨迹

    Figure 16.  Experimental trajectory of omnidirectional robot collaborative task

  • [1] SUEOKA S, IRIE T.The study for control of the robot plane with GPS and IMU[J].Journal of Medical Virology, 2016, 13:417-418.
    [2] SASANI S, ASGARI J, AMIRI-SIMKOOEI A R.Improving MEMS-IMU/GPS integrated systems for land vehicle navigation applications[J].GPS Solutions, 2016, 20(1):89-100. doi: 10.1007/s10291-015-0471-3
    [3] LI J, SONG N, YANG G, et al.Improving positioning accuracy of vehicular navigation system during GPS outages utilizing ensemble learning algorithm[J].Information Fusion, 2017, 35(C):1-10. http://dblp.uni-trier.de/db/journals/inffus/inffus35.html#LiSYLC17
    [4] SAEEDI S, TRENTINI M, SETO M, et al.Multiple-robot simultaneous localization and mapping:A review[J].Journal of Field Robotics, 2016, 33(1):3-46. doi: 10.1002/rob.21620
    [5] LOPEZ E, GARCIA S, BAREA R, et al.A multi-sensorial simultaneous localization and mapping (SLAM) system for low-cost micro aerial vehicles in GPS-denied environments[J].Sensors, 2017, 17(4):802. doi: 10.3390/s17040802
    [6] AGHILI F, SU C Y.Robust relative navigation by integration of ICP and adaptive Kalman filter using laser scanner and IMU[J].IEEE/ASME Transactions on Mechatronics, 2016, 21(4):2015-2026. doi: 10.1109/TMECH.2016.2547905
    [7] STACHNISS C, KRETZSCHMAR H. Pose graph compression for laser-based SLAM[M]//CHRISTENSEN H, KHATIB O. Robotics research. Berlin: Springer, 2017: 271-287.
    [8] ENDRES F, HESS J, STURM J, et al.3-D mapping with an RGB-D camera[J].IEEE Transactions on Robotics, 2017, 30(1):177-187. http://ieeexplore.ieee.org/abstract/document/6594910
    [9] GAO X, ZHANG T.Unsupervised learning to detect loops using deep neural networks for visual SLAM system[J].Autonomous Robots, 2017, 41(1):1-18. doi: 10.1007/s10514-015-9516-2
    [10] CAO J, ZENG B, LIU J, et al.A novel relocation method for simultaneous localization and mapping based on deep learning algorithm[J].Computers & Electrical Engineering, 2017, 63(10):79-90. http://linkinghub.elsevier.com/retrieve/pii/S0045790617305943
    [11] ERYILDITIM A, GULDOGAN M B.A Bernoulli filter for extended target tracking using random matrices in an UWB sensor network[J].IEEE Sensors Journal, 2016, 16(11):4362-4373. doi: 10.1109/JSEN.2016.2544807
    [12] crazyflie2. 0[EB/OL]. [2017-04-20]. https://www.bitcraze.io.
    [13] 张一淳, 张雪波, 方勇纯, 等.基于主动偏心轮的全方位移动机器人航位推算与跟踪控制[J].机器人, 2015, 37(3):361-368. http://mall.cnki.net/magazine/Article/JQRR201503014.htm

    ZHANG Y C, ZHANG X B, FANG Y C, et al.Dead reckoning and tracking control of omnidirectional mobile robots[J].Robot, 2015, 37(3):361-368(in Chinese). http://mall.cnki.net/magazine/Article/JQRR201503014.htm
    [14] MADHUSUDHAN M G.Control of crazyflie nano quadcopter using Simulink[M].Long Beach:California State University, 2016.
    [15] JAFAROV S M, ZEYNALOV E R, MUSTAFAYEVA A M.Synthesis of robust controller-regulators for omnidirectional mobile robot with irregular movement[J].Procedia Computer Science, 2016, 102:469-476. doi: 10.1016/j.procs.2016.09.429
    [16] HAMMER F, YUDANTO R, KAI N, et al.Performance evaluation of 3D-position estimation systems[J].IEEE Sensors Journal, 2016, 16(16):6416-6424. doi: 10.1109/JSEN.2016.2581489
    [17] 阴盼强, 路东明, 袁渊, 等.基于马氏距离的改进非局部均值图像去噪算法[J].计算机辅助设计与图形学学报, 2016, 28(3):404-410. http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=ranj201402020

    YIN P Q, LU D M, YUAN Y, et al.An improved non-local means image de-noising algorithm using Mahalanobis distance[J].Journal of Computer-Aided Design & Computer Graphics, 2016, 28(3):404-410(in Chinese). http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=ranj201402020
    [18] ROUSSEEUW P J, DRIESSEN K V.A fast algorithm for the minimum covariance determinant estimator[J].Technometrics, 1999, 41(3):212-223. doi: 10.1080/00401706.1999.10485670
  • 加载中
图(16)
计量
  • 文章访问数:  565
  • HTML全文浏览量:  107
  • PDF下载量:  386
  • 被引次数: 0
出版历程
  • 收稿日期:  2017-08-11
  • 录用日期:  2017-11-19
  • 网络出版日期:  2018-07-20

目录

    /

    返回文章
    返回
    常见问答