以4-DOF混联机器人为研究对象,分析了混联机器人的运动学,接着基于传统键合图建立了系统驱动部分(电动机和气动部分)键合图模型,基于旋量键合图建立了系统机械本体动力学模型,由于系统的并联部分引入冗余驱动,提出了采用输入力矩优化的方法,增加了1个补充方程,最终得到了该机器人完整的机、电、气耦合的多能域系统动力学全解模型。冗余驱动分支在随动和施加优化得到的力矩(力/位混合控制)两种情况下,借助键合图自动化仿真软件(20-sim)进行多能域动力学仿真;并进行样机的控制试验,将仿真与试验得到的驱动力矩进行对比,验证了所建机器人系统多能域动力学模型的正确性。通过试验可以证明:力/位混合控制时样机运行更加平稳且能有效提高机构的运动精度。
4-DOF hybrid robot is taken as the research object. Firstly the kinematics of hybrid robot is analyzed and the system driving (motor and pneumatic parts) bond graph model has established based on the traditional bond graph, the system dynamics model of mechanical has established based on the screw bond graph theory. Because the system uses parallel redundant actuation, added one additional equation base on the power input method optimization to finally get the robot complete machine, electricity and gas coupling of multi energy domains system dynamics model. In the two case of the redundant driving branch is casual and applies with optimized force (force/position hybrid control), according to the planning trajectory with bond graph automatic simulation software (20-sim) multi domain dynamic simulation; the control experiment of the prototype is carried out and the driving torques obtained by simulation are compared with the experimental results. So, the robot system can validate the correctness of the multi domain dynamics model. The experimental results show that the machine runs more smoothly and effectively improve the kinematic accuracy when the machine controlled through the hybrid force/position control.
[1] JOAO V F, MARA M da S. On the dynamic performance of parallel kinematic manipulators with actuation and kinematic redundancies[J]. Mechanism and Machine Theory, 2016(103):148-166.
[2] JIANG Yao, LI Tiemin, WANG Liping. Dynamic modeling and redundant force optimization of a 2-DOF parallel kinematic machine with kinematic redundancy[J]. Robotics and Computer-Integrated Manufacturing, 2015(32):1-10.
[3] WU Guanglei, CARO S, BAI Shaoping, et al.. Dynamic modeling and design optimization of a 3-DOF spherical parallel manipulator[J]. Robotics and Autonomous Systems, 2014(62):1377-1386.
[4] 丁华锋,祖琪,冯泽民. 基于虚功原理的一种新型锻造操作机主运动机构动力学分析[J]. 机械工程学报, 2016, 52(9):18-27. DING Huafeng, ZU Qi, FENG Zemin. Dynamic analysis of a new forging manipulator's main motion mechanism based on the principle of virtual work[J]. Journal of Mechanical Engineering, 2016, 52(9):18-27.
[5] WU Ying, YU Kaiping, JIAO Jian, et al. Dynamic modeling and robust nonlinear control of a six-DOF active micro-vibration isolation manipulator with parameter uncertainties[J]. Mechanism and Machine Theory, 2015(92):407-435.
[6] 龙亿,杨晓钧,李兵. 平面冗余驱动并联机构自适应滑模同步控制[J]. 中国机械工程, 2013, 24(20):2730-2734. LONG Yi, YANG Xiaojun, LI Bing. Adaptive sliding mode synchronous control of a planar redundantly actuated parallel mechanism[J]. China Mechanical Engineering, 2013, 24(20):2730-2734.
[7] 胡波, 路懿, 许佳音, 等. 新型过约束并联机构2RPU+UPU动力学模型[J]. 机械工程学报, 2011, 47(11):36-43. HU Bo, LU Yi, XU Jiayin, et al. Solving kinematics for a novel over-constrained 2UPR+UPU parallel manipulator[J]. Journal of Mechanical Engineering, 2011, 47(11):36-43.
[8] 郭菲,李永泉,宋肇经,等. 旋量键合图在并联机构动力学建模中的应用[J]. 机械工程学报, 2015, 51(23):16-20. GUO Fei, LI Yongquan, SONG Zhaojing, et al. Screw bond graph in the application of the parallel mechanism dynamics modeling[J]. Journal of Mechanical Engineering, 2015, 51(23):16-20.
[9] 李永泉,宋肇经,郭菲,等. 多能域过约束并联机器人系统动力学建模方法[J]. 机械工程学报, 2016, 52(21):17-20. LI Yongquan, SONG Zhaojing, GUO Fei, et al. Dynamic modeling method for overconstrained multi-energy domain parallel manipulator[J]. Journal of Mechanical Engineering, 2016, 52(21):17-20.
[10] 任福深,陈素丽,王威. 基于键合图理论的斜直井管柱上扣/卸扣系统设计与仿真[J]. 中国机械工程, 2014, 25(3):404-409. REN Fushen, CHEN Suli, WANG Wei. Modeling and simulation of string make-up and break-out system of slant drilling based on bond graph[J]. China Mechanical Engineering, 2014, 25(3):404-409.