宋荆洲, 白杨, 孙汉旭, 贾庆轩, 高欣, 王一帆. 基于接触力信息的解耦式力反馈手控器[J]. 机器人, 2014, 36(4): 477-484.DOI: 10.13973/j.cnki.robot.2014.0477.
SONG Jingzhou, BAI Yang, SUN Hanxu, JIA Qingxuan, GAO Xin, WANG Yifan. A Decoupled Force Feedback Haptic Device Based on Interaction Force Signal. ROBOT, 2014, 36(4): 477-484. DOI: 10.13973/j.cnki.robot.2014.0477.
A force feedback haptic device with a large workspace is developed for space teleoperation tasks, and the motion of the device in 3 directions is decoupled from each other. The velocity isotropic index and force isotropic index are analyzed through the Jacobin matrix. On this basis, a velocity control algorithm based on interaction force signal is proposed. Force signals for each axis are acquired in real time to estimate the magnitude and the direction of force exerted by the operator. And then the difference between the desired force and the acquired interaction force data is taken as the input of the PID (proportional-integral-derivative) controller. The PID control algorithm is used to control the motor speed. A proper data is given to control the motor to accomplish the movement. Experiments are conducted on a prototype mechanism. The results show that the proposed method can achieve better control results.
[1] Arata J, Kondo H, Sakaguchi M, et al. Development of a haptic device "DELTA-4" using parallel link mechanism[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2009: 294-300.[2] Arata J, Kondo H, Sakaguchi M, et al. A haptic device DELTA-4: Kinematics and its analysis[C]//3rd Joint EuroHaptics Conference and Symposium on Haptic Interfaces for Virtual Environment and Teleoperator Systems. Piscataway, USA: IEEE, 2009: 452-457.[3] Arata J, Ikedo N, Fujimoto H, et al. Force producibility improvement of redundant parallel mechanism for haptic applications[C]//IEEE/RSJ International Conference on IntelligentRobots and Systems. Piscataway, USA: IEEE, 2011: 2145-2150.[4] Arata J, Kondo H, Ikedo N, et al. Haptic device using a newly developed redundant parallel mechanism[J]. IEEE Transactions on Robotics, 2011, 27(2): 201-214. [5] Lee S U, Kim S. Analysis and optimal design of a new 6 DOF parallel type haptic device[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2006: 460-465.[6] Lee L F, Narayanan M S, Mendel F. Kinematics analysis of in-parallel 5 DOF haptic device[C]//IEEE/ASME International Conference on Advanced Intelligent Mechatronics. Piscataway, USA: IEEE, 2010: 237-241.[7] 曹永刚,张玉茹,马运忠.6-RSS型并联机构的工作空间分析与参数优化[J].机械工程学报,2008,44(1):19-24.Cao Y G, Zhang Y R, Ma Y Z. Workspace analysis and parameter optimization of 6-RSS parallel mechanism[J]. Journal of Mechanical Engineering, 2008, 44(1): 19-24.[8] 李浩,张玉茹,王党校.6-RSS并联机构工作空间优化算法对比分析[J].机械工程学报,2010,46(13):61-67.Li H, Zhang Y R, Wang D X. Comparative analysis of optimization algorithms in workspace optimization of parallel mechanisms[J]. Journal of Mechanical Engineering, 2010, 46(13): 61-67.[9] 李磊.双边遥操作系统设计和性能优化研究[D].长沙:国防科学技术大学,2011.Li L. Design of bilateral teleoperation system and research on performance optimization[D]. Changsha: National University of Defense Technology, 2011.[10] 倪涛,赵丁选,张红彦.电液手控器型遥操作机器人力反馈控制策略[J].农业机械学报,2010,41(12):190-194.Ni T, Zhao D X, Zhang H Y. Bilateral servo control of tele-robot based on electro hydraulic manipulator[J]. Transactions of the Chinese Society for Agricultural Machinery, 2010, 41(12): 190-194.[11] Yen P L, Lai C C. Dynamic modeling and control of a 3-DOF Cartesian parallel manipulator[J]. Mechatronics, 2009, 19(3): 390-398. [12] 曹永刚,张玉茹,王党校,等.面向口腔临床操作的力觉交互装置控制系统设计与实现[J].系统仿真学报,2007,19(5):1086-1089.Cao Y G, Zhang Y R, Wang D X, et al. Design and implementation of control system in haptic device for dental training system[J]. Journal of System Simulation, 2007, 19(5): 1086-1089.[13] 熊有伦,丁汉,刘恩沧.机器人学[M].北京:机械工业出版社,1993:110-111.Xiong Y L, Ding H, Liu E C. Robotics[M]. Beijing: China Machine Press, 1993: 110-111.[14] 金振林,高峰.新型基于6-PSS三维平台机构的并联微动机器人[J].仪器仪表学报,2001,22(6):566-569.Jin Z L, Gao F. A novel parallel micro-motion manipulator based on 6-PSS three-dimensional platform mechanism[J]. Chinese Journal of Scientific Instrument, 2001, 22(6): 566-569.[15] Force dimension Delta.3 haptic device[DB/OL]. [2013-10-15]. http://www.forcedimension.com/downloads/specs/specsheet-delta.3.pdf.[16] 刘海波,席振鹏.力反馈主手研究现状及其力控制方法研究[J].自动化技术与应用,2009,28(3):1-5,11.Liu H B, Xi Z P. An overview of the haptic device and force control[J]. Techniques of Automation and Applications, 2009, 28(3): 1-5,11.