An iterative method is introduced successfully to solve the inverse kinematics of a 6-DOF manipulator of a tunnel drilling rig based on dual quaternion, which is difficult to get the solution by Denavit-Hartenberg(D-H...An iterative method is introduced successfully to solve the inverse kinematics of a 6-DOF manipulator of a tunnel drilling rig based on dual quaternion, which is difficult to get the solution by Denavit-Hartenberg(D-H) based methods. By the intuitive expression of dual quaternion to the orientation of rigid body, the coordinate frames assigned to each joint are established all in the same orientation, which does not need to use the D-H procedure. The compact and simple form of kinematic equations, consisting of position equations and orientation equations, is also the consequence of dual quaternion calculations. The iterative process is basically of two steps which are related to solving the position equations and orientation equations correspondingly. First, assume an initial value of the iterative variable; then, the position equations can be solved because of the reduced number of unknown variables in the position equations and the orientation equations can be solved by applying the solution from the position equations, which obtains an updated value for the iterative variable; finally, repeat the procedure by using the updated iterative variable to the position equations till the prescribed accuracy is obtained. The method proposed has a clear geometric meaning, and the algorithm is simple and direct. Simulation for 100 poses of the end frame shows that the average running time of inverse kinematics calculation for each demanded pose of end-effector is 7.2 ms on an ordinary laptop, which is good enough for practical use. The iteration counts 2-4 cycles generally, which is a quick convergence. The method proposed here has been successfully used in the project of automating a hydraulic rig.展开更多
针对液压重载机械臂的动态倾覆稳定性问题,提出了一种基于改进快速扩展随机树(Rapidly-exploring Random Tree,RRT)算法的路径规划方法。与只对危险工况的静态稳定性校核不同,该算法以机械臂运动过程中的动态倾覆稳定性最优为目标,在机...针对液压重载机械臂的动态倾覆稳定性问题,提出了一种基于改进快速扩展随机树(Rapidly-exploring Random Tree,RRT)算法的路径规划方法。与只对危险工况的静态稳定性校核不同,该算法以机械臂运动过程中的动态倾覆稳定性最优为目标,在机械臂的关节空间内进行路径规划。以7个关节变量组成的七维数组作为采样点,结合正运动学与力矩法建立机械臂的动态倾覆稳定性计算模型,利用双采样点择优原则,选择其在对应位姿下抗倾覆稳定力矩最优的随机点作为采样点,以增强算法的启发性。在Matlab平台进行的仿真实验表明,改进RRT算法规划路径的倾覆裕度在3种典型工况下分别提升了37%、28%和38%,有效地改善了液压重载机械臂作业平台的抗倾覆稳定性。展开更多
基金Project(2013CB035504)supported by the National Basic Research Program of China
文摘An iterative method is introduced successfully to solve the inverse kinematics of a 6-DOF manipulator of a tunnel drilling rig based on dual quaternion, which is difficult to get the solution by Denavit-Hartenberg(D-H) based methods. By the intuitive expression of dual quaternion to the orientation of rigid body, the coordinate frames assigned to each joint are established all in the same orientation, which does not need to use the D-H procedure. The compact and simple form of kinematic equations, consisting of position equations and orientation equations, is also the consequence of dual quaternion calculations. The iterative process is basically of two steps which are related to solving the position equations and orientation equations correspondingly. First, assume an initial value of the iterative variable; then, the position equations can be solved because of the reduced number of unknown variables in the position equations and the orientation equations can be solved by applying the solution from the position equations, which obtains an updated value for the iterative variable; finally, repeat the procedure by using the updated iterative variable to the position equations till the prescribed accuracy is obtained. The method proposed has a clear geometric meaning, and the algorithm is simple and direct. Simulation for 100 poses of the end frame shows that the average running time of inverse kinematics calculation for each demanded pose of end-effector is 7.2 ms on an ordinary laptop, which is good enough for practical use. The iteration counts 2-4 cycles generally, which is a quick convergence. The method proposed here has been successfully used in the project of automating a hydraulic rig.
文摘针对液压重载机械臂的动态倾覆稳定性问题,提出了一种基于改进快速扩展随机树(Rapidly-exploring Random Tree,RRT)算法的路径规划方法。与只对危险工况的静态稳定性校核不同,该算法以机械臂运动过程中的动态倾覆稳定性最优为目标,在机械臂的关节空间内进行路径规划。以7个关节变量组成的七维数组作为采样点,结合正运动学与力矩法建立机械臂的动态倾覆稳定性计算模型,利用双采样点择优原则,选择其在对应位姿下抗倾覆稳定力矩最优的随机点作为采样点,以增强算法的启发性。在Matlab平台进行的仿真实验表明,改进RRT算法规划路径的倾覆裕度在3种典型工况下分别提升了37%、28%和38%,有效地改善了液压重载机械臂作业平台的抗倾覆稳定性。
