Operating Unknown Constrained Mechanisms Based on Motion Prediction and Impedance Control
SUN Yixiang, CHEN Weidong
1. Key Laboratory of System Control and Information Processing, Ministry of Education of China, Shanghai Jiao Tong University, Shanghai 200240, China; 2. State Key Laboratory of Robotics and System, Harbin Institute of Technology, Harbin 150080, China
Abstract:In order to meet the needs for assistive robot manipulators in operating various constrained mechanisms,a control method based on motion prediction and impedance control is proposed.A rolling manipulation strategy of exploration-prediction -adjustment is employed,through impedance control to provide compliant interaction between the assistive manipulator and unknown constrained mechanisms.Firstly,the motion capability of the constrained mechanism is explored to build its motion model according to the passed motion trajectory of the manipulator.Then,motion direction of the mechanism is predicted based on the motion model.Finally,the trajectory of manipulator is adjusted in alignment with the predicted direction, while the magnitude of the velocity is dynamically adjusted according to the interaction force.Based on this continuous rolling adjustment,safety and efficiency of a manipulator for operating unknown constrained mechanisms are enhanced.Experiments of autonomous door opening utilizing a 6DoF assistive manipulator with a six-dimensional force/torque sensor demonstrate the validity of the proposed method.
[1] Quigley M,Batra S,Gould S,et al.High-accuracy 3D sensing for mobile manipulation:Improving object detection and door opening[C]//IEEE International Conference on Robotics and Automation.Piscataway,NJ,USA:IEEE,2009:2816-2822.
[2] Liu G J,Ahmad S,Ren L.Hybrid control of door-opening by modular re-configurable robots[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems.Piscataway,NJ,USA:IEEE,2009:954-959.
[3] Shimada M,Asakura T.Interactive manipulator interface with task planner[C]//IEEE IECON 22nd International Conference on Industrial Electronics,Control,and Instrumentation.Piscataway,NJ,USA:IEEE,1996:481-486.
[4] Ojdanic D,Graser A.A fast motion planning for a 7DOF rehabilitation robot[C]//IEEE 10th International Conference on Rehabilitation Robotics.Piscataway,NJ,USA:IEEE,2007:171-178.
[5] Pujas A,Dauchez P,Pierrot F.Hybrid position/forco control:Task description and control scheme determination for a real implementation[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems.Piscataway,NJ,USA:IEEE,1993:481-486.
[6] Petrovskaya A,Ng.A Y.Probabilistic mobile manipulation in dynamic environments,with application to opening doors[C]//International Joint Conference on Artificial Intelligence.New York,NJ,USA:ACM,2007:2178-2184.
[7] Schmid A J,Gorges N,Goger D,et al.Opening a door with a humanoid robot using multi-sensory tactile feedback[C]//IEEE International Conference on Robotics and Automation.Piscataway,NJ,USA:IEEE,2008:285-291.
[8] Lutscher E,Lawitzky M,Cheng G,et al.A control strategy for operating unknown constrained mechanisms[C]//IEEE International Conference on Robotics and Automation.Piscataway,NJ,USA:IEEE,2010:819-824.
[9] Hogan N.Impedance control:An approach to manipulation,Part Ⅰ-Ⅲ[J]//ASME Journal of Dynamic Systems,Measurement and Control,1985,107(1):1-25.
[10] Whitney D E.Force feedback control of manipulator fine motions[J]//ASME Journal of Dynamic Systems,Measurement and Control,1977,99(2):91-97.
[11] Chen W D,Sun Y X,Huang Y T.A collision detection system for an assistive robotic manipulator[J].Communications in Computer and Information Science,2010,97(1):117-123.