An online calibration method based on visual markers is proposed for the service manipulator with joint clearance to solve the drift problem. The marker mounted on the manipulator is recognized and its 6DoF (degree of freedom) is calculated by the stereo vision system firstly, and then the real positions of the joints are computed through solving the inverse kinematics of the manipulator, and thus the drift of joints' readings are estimated to accomplish the online calibration of the manipulator. Along with the property that the drift of joints' readings keeps stable within a short time, the proposed method can make the end-effector precisely reach the target operating position. Experiments of autonomous microwave-oven button pressing on a mobile robot platform equipped with a 5DoF low-cost manipulator with joint clearance demonstrate the validity of the proposed method. And auxiliary experiment validates the assumption of local stability of the joints' readings drift.
[1] Meeussen W, Wise M, Glaser S, et al. Autonomous door opening and plugging in with a personal robot[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2010: 729-736.[2] Klingbeil E, Carpenter B, Russakovsky O, et al. Autonomous operation of novel elevators for robot navigation[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2010: 751-758.[3] Maitin-Shepard J, Cusumano-Towner M, Lei J, et al. Cloth grasp point detection based on multiple-view geometric cues with application to robotic towel folding[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2010: 2308-2315.[4] Beetz M, Klank U, Maldonado A, et al. Robotic roommates making pancakes[C]//IEEE/RAS International Conference on Humanoid Robots. Piscataway, NJ, USA: IEEE, 2011: 529-536.[5] Zhu J M, Ting K L. Uncertainty analysis of planar and spatial robots with joint clearances[J]. Mechanism and Machine Theory, 2000, 35(9): 1239-1256. [6] 张跃明,唐锡宽,张兆东,等.空间机构间隙转动副模型的建立[J].清华大学学报,1996,36(8):105-109. Zhang Y M, Tang X K, Zhang Z D, et al. Modeling of revolute joint with clearances in spatial mechanism[J]. Journal of Tsinghua University: Science and Technology, 1996, 36(8): 105-109.[7] 宋月娥,吴林,戴明.机器人关节间隙误差分析[J].机械工程学报,2003,39(4):11-14. Song Y E, Wu L, Dai M. Error analysis of robot joint clearance[J]. Chinese Journal of Mechanical Engineering, 2003, 39(4): 11-14.[8] 高群.机器人精度理论研究及在测量机械臂开发中的应用[D].广州:中山大学,2007. Gao Q. Research on theory of robot accuracy and its application in the development of multi-joint arm[D]. Guangzhou: Sun Yat-Sen University, 2007.[9] Le Q V, Ng A Y. Joint calibration of multiple sensors[C]// IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2009: 3651-3658.[10] Pradeep V, Konolige K, Berger E. Calibrating a multi-arm multi-sensor robot: A bundle adjustment approach[C]//Interna- tional Symposium on Experimental Robotics. New Delhi, India: 2010.[11] Denavit J, Hartenberg R S. A kinematic notation for lower pair mechanisms based on matrices[J]. ASME Journal of Applied Mechanics, 1955, 22(2) : 215-221.[12] 石则昌,刘深厚.机构精确度[M].北京:高等教育出版社,1995. Shi Z C, Liu S H. The precision of mechanism[M]. Beijing: Higher Education Press, 1995.[13] Smisek J, Jancosek M, Pajdla T. 3D with Kinect[C]//2011 IEEE International Conference on Computer Vision Workshops. Piscataway, USA: IEEE, 2011: 1154-1160.[14] 陈鹏,刘璐,余飞,等.一种仿人机械臂的运动学逆解的几何求解方法[J].机器人,2012,34(2):211-216. Chen P, Liu L, Yu F, et al. A geometrical method for inverse kinematics of a kind of humanoid manipulator[J]. Robot, 2012, 34(2): 211-216.[15] Bruce J, Balch T, Veloso M. Fast and inexpensive color image segmentation for interactive robots[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2000: 2061-2066.[16] Acharya P K, Henderson T C. Parameter estimation and error analysis of range data[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 1988: 1709-1714.