Abstract：For trajectory planning of service robot manipulators in daily living environment with obstacles, a trajectory generation and adjustment method in human-robot collaboration is proposed. At first, an approach is designed to produce a trajectory with similar shape to the demonstrated one based on dynamic movement primitive (DMP) model. Here, the problem of shape distortion caused by multi-degree-of-freedom coupling is solved by projecting the 3D target point on a plane where the demonstration trajectory falls, then generating the 3D trajectory by using Rodrigues' rotation formula. Thus the shape character of the produced trajectory can be ensured in all directions. Secondly, the trajectory can be adjusted by inserting interactive points to meet the operation requirements in cases of complex environments with obstacles in different shapes, and then it is smoothened by dual parabolic interpolation algorithm. Lastly, an interactive interface is built in ROS (robot operating system) under the idea of human-robot collaboration. Operators can intuitively help a manipulator to generate and adjust the 3D trajectory of the end-effector in the environment with or without obstacles. Obstacle-avoidance experiments validate the intuitiveness and flexibility of the proposed approach, which can adapt to complex daily-living environment with multiple kinds of obstacles.
[1] Dragan A D, Srinivasa S S. Familiarization to robot motion[C]//ACM/IEEE International Conference on Human-Robot Interaction. Piscataway, USA: IEEE, 2014: 366-373.
[2] Billard A, Grollman D. Robot learning by demonstration [DB/OL]. (2013-12-10) [2016-03-09]. http://www.scholarpedia. org/article/Robot_learning_by_demonstration.
[3] Akgun B, Cakmak M, Yoo J W, et al. Trajectories and keyframes for kinesthetic teaching: A human-robot interaction perspective[C]//ACM/IEEE International Conference on Human-Robot Interaction. Piscataway, USA: IEEE, 2012: 391-398.
[4] Kuklinski K, Fischer K, Marhenke I, et al. Teleoperation for learning by demonstration: Data glove versus object manipulation for intuitive robot control[C]//6th International Congress on Ultra Modern Telecommunications and Control Systems and Workshops. Piscataway, USA: IEEE, 2014: 346-351.
[5] Albrecht S, Ramírez-Amaro K, Weikersdorfer D, et al. Imitating human reaching motions using physically inspired optimization principles[C]//IEEE/RAS International Conference on Humanoid Robots. Piscataway, USA: IEEE, 2011: 602-607.
[6] Mandery C, Terlemez O, Do M, et al. The KIT whole-body human motion database[C]//17th International Conference on Advanced Robotics. Piscataway, USA: IEEE, 2015: 329-336.
[7] Kirstein F, Fischer K, Solvason D. Human embodiment creates problems for robot learning by demonstration using a control panel[C]//ACM/IEEE International Conference on Human-Robot Interaction. Piscataway, USA: IEEE, 2014: 212-213.
[8] Schaal S. Dynamic movement primitives: A framework for motor control in humans and humanoid robotics[M]. Berlin, Germany: Springer-Verlag, 2006.
[9] Ilari J, Torras C. 2D path planning: A configuration space heuristic approach[J]. International Journal of Robotics Research, 1990, 9(1): 75-91.
[10] Rusu R B, Sucan I A, Gerkey B, et al. Real-time perception-guided motion planning for a personal robot[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2009: 4245-4252.
[11] Park D H, Hoffmann H, Pastor P, et al. Movement reproduction and obstacle avoidance with dynamic movement primitives with potential field[C]//IEEE/RAS International Conference on Humanoid Robots. Piscataway, USA: IEEE, 2008: 91-98.
[12] Rai A, Meier F, Ijspeert A, et al. Learning coupling terms for obstacle avoidance[C]//IEEE/RAS International Conference on Humanoid Robots. Piscataway, USA: IEEE, 2014: 512-518.
[13] Pastor P, Hoffmann H, Asfour T, et al. Learning and generalization of motor skills by learning from demonstration[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2009: 763-768.
[14] Fischer K, Jensen L C, Kirstein F, et al. The effects of social gaze in human-robot collaborative assembly[M]//Lecture Notes in Computer Science, vol.9388. Berlin, Germany: Springer-Verlag, 2015: 204-213.
[15] Ivanisevic I, Configuration V J. Configuration space as a means for augmenting human performance in teleoperation tasks[J]. IEEE Transactions on Systems, Man, and Cybernetics, Part B, 2000, 30(3): 471-484.
[16] 祁若龙,周维佳,王铁军.一种基于遗传算法的空间机械臂避障轨迹规划方法[J].机器人,2014,36(3):263-270. Qi R L, Zhou W J, Wang T J. An obstacle avoidance trajectory planning scheme for space manipulators based on genetic algorithm[J]. Robot, 2014, 36(3): 263-270.
[17] Ijspeert A J, Nakanishi J, Hoffmann H, et al. Dynamic movement primitives: Learning attractor models for motor behavior [J]. Neural Computation, 2013, 25(2): 328-373.
[18] Ijspeert A J, Nakanishi J, Schaal S. Movement imitation with nonlinear dynamic systems in humanoid robots[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2002: 1398-1403.
[19] Sorgi L. Two-view geometry estimation using the rodrigues rotation formula[C]//IEEE International Conference on Image Processing. Piscataway, USA: IEEE, 2011: 1009-1012.
[20] Gossow D, Leeper A, Hershberger D, et al. Interactive markers: 3-D user interfaces for ROS applications[J]. IEEE Robotics & Automation Magazine, 2011, 18(4): 14-15.
