Journal of Mechanical Engineering >

2017 , Vol. 53 >Issue 1: 21 - 27

DOI: https://doi.org/10.3901/JME.2017.01.021

Closed Loop Control Algorithm for Obstacle Avoidance Based on the Transformation of Master and Slave Tasks

  • ZHANG Jianhua ,
  • HU Ping ,
  • ZHANG Xiaojun ,
  • LIU Jinchang ,
  • LIU Xuan
Expand
  • 1. School of Mechanical Engineering， Hebei University of Technology， Tianjin 300130;
    2. High Technology Center of Ministry of Science and Technology， Beijing 100044

Online published: 2017-01-05

Fold

Abstract

The research on obstacle avoidance algorithm of redundant manipulator has always been one of the hotspots in the field of robot. A closed loop control algorithm for obstacle avoidance based on the transformation of master and slave tasks is proposed aiming at the shortcomings of the traditional algorithm. It achieves the switch of the task of obstacle avoidance and the task of the desired trajectory tracking by monitoring the minimum distance between the mechanical arm and the obstacle, thus it can solve the conflict between obstacle avoidance and desired trajectory tracking. When mechanical arms avoid obstacle, the end tracking accuracy is poor, based on this, the error control between the desired and actual end effector locations is introduced which makes the tracking accuracy significantly improved. In addition, the algorithm also has the advantages of small amount of computation and continuous variation of the velocity of escape and it can also be applied to collision avoidance of many obstacles and dynamic obstacle. The algorithm is verified by the simulation experiment of planar redundant robot with three degrees of freedom. The results show that the algorithm can effectively solve the conflict when the obstacle is on the desired tracking and the accuracy is high. It can also finish the obstacle avoidance of many obstacles and dynamic obstacle.

 

Key words： redundant manipulator; master slave task transformation; obstacle avoidance; closed-loop control

Cite this article

ZHANG Jianhua , HU Ping , ZHANG Xiaojun , LIU Jinchang , LIU Xuan . Closed Loop Control Algorithm for Obstacle Avoidance Based on the Transformation of Master and Slave Tasks[J]. Journal of Mechanical Engineering, 2017 , 53(1) : 21 -27 . DOI: 10.3901/JME.2017.01.021

References

 [1]  孙立宁，赵建文，杜志江. 单冗余度机器人避障能力指标的建立及在7自由度冗余手臂上的实践[J]. 机器人，2007，43(5)：223-229.

        SUN Lining，ZHAO Jianwen，DU Zhijiang. Concept and application on 7-DOF redundant manipulator of index to measure capability of collision-avoidance for single redundant manipulator[J]. Robot，2007，43(5)：223-229.

 [2]  管小清，常青，梁冠豪，等. 一种冗余机械臂的多运动障碍物避障算法[J]. 计算机测量与控制，2015，23(8)： 2802-2805.

        GUAN Xiaoqing，CHANG Qing，LIANG Guanhao，et al. Multiple mobile obstacles avoidance algorithm for redundant manipulator[J]. Computer Measurement & Control，2015，23(8)：2802-2805.

 [3]  申浩宇，吴洪涛，陈柏，等. 基于主从任务转化的冗余度机器人避障算法[J]. 机器人，2014，36(4)：425-429.

        SHEN Haoyu，WU Hongtao，CHEN Bai，et al. Obstacle avoidance algorithm for redundant robots based on transition between the primary and secondary tasks[J]. Robot，2014，36(4)：425-429.

 [4]  JIA Q X，ZHANG Q R，GAO X，et al. Dynamic obstacle avoidance algorithm for redundant robots with pre-selected minimum distance index[J]. Robot，2013，35(1)：17-22.

 [5]  鲍庆勇，李舜酩，沈峘，等. 自主移动机器人局部路径规划综述[J]. 传感器与微系统，2009，28(9)：1-4.

        BAO Qingyong，LI Shunming，SHEN Xuan，et al. Survey of local path planning of autonomous mobile robot[J]. Transducer and Microsystem Technologies，2009，28(9)：1-4.

 [6]  徐进. 基于蚁群算法的移动机器人路径规划算法研究[D]. 北京：北京化工大学，2009.

        XU Jin. The research of mobile robot path planning algorithm based on antcolony algorithm[D]. Beijing：Beijing University of Chemical Technology，2009.

 [7]  马仁利，关正西. 路径规划技术的现状与发展综述[J]. 现代机械，2008(3)：22 -24.

        MA Renli，GUAN Zhengxi. Summarization for present situation and future development of path planning technology[J]. Modern Machinery，2008(3)：22-24.

 [8]  姜力，周扬，孙奎，等. 七自由度冗余机械臂避障控制[J]. 光学精密工程，2013，21(7)：1795-1801．

        JIANG Li，ZHOU Yang，SUN Kui，et al. Obstacle avoidance control for 7-DOF redundant manipulations[J]. Optics and Precision Engineering，2013，21(7)：1795-1801.

 [9]  SHUKLA A，SINGLA E，WAHI P，et al. A direct variational method for planning monotonically optimal paths for redundant manipulators in constrained workspaces[J]. Robotics and Autonomous Systems，2013，61(2)：209-220.

[10]  MACIEJEWSKI A，KLEIN C. Obstacle avoidance for kinematically redundant manipulators in dynamically varying environments[J]. International Journal of Robotics Research，1985，4(3)：109-117.

[11]  GUO Z Y，HSIA T C. Joint trajectory generation for redundant robots in an environment with obstacles[J]. Journal of Robotic Systems，1993，10(2)：199-215.

[12]方承，赵京. 新颖的基于梯度投影法的混合指标动态避障算法[J]. 机械工程学报，2010，46(10)：46-49.

        FANG Cheng，ZHAO Jing. New dynamic obstacle avoidance algorithm with hybrid index based on gradient projection method[J]. Journal of Mechanical Engineering， 2010，46(10)：46-49.

Options
Outlines

/

〈 〉

　 Copyright © Journal of Mechanical Engineering, All Rights Reserved.
Powered by Beijing Magtech Co. Ltd,.