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.展开更多
Due to the intense vibration durirLg launching and rigorous orbital temperature environment, the kinematic parameters of space robot may be largely deviated from their nominal parameters. The disparity will cause the ...Due to the intense vibration durirLg launching and rigorous orbital temperature environment, the kinematic parameters of space robot may be largely deviated from their nominal parameters. The disparity will cause the real pose （including position and orientation） of the end effector not to match the desired one, and further hinder the space robot from performing the scheduled mission. To improve pose accuracy of space robot, a new self-calibration method using the distance measurement provided by a laser-ranger fixed on the end-effector is proposed. A distance-measurement model of the space robot is built according to the distance from the starting point of the laser beam to the intersection point at the declining plane. Based on the model, the cost function about the pose error is derived. The kinematic calibration is transferred to a non-linear system optimization problem, which is solved by the improved differential evolution （DE） algoritlun. A six-degree of freedom （6-DOF） robot is used as a practical simulation example, and the simulation results show： 1） A significant improvement of pose accuracy of space robot can be obtained by distance measurement only; 2） Search efficiency is increased by improved DE; 3） More calibration configurations may make calibration results better.展开更多
A method used to detect anomaly and estimate the state of vehicle in driving was proposed.The kinematics model of the vehicle was constructed and nonholonomic constraint conditions were added,which refer to that once ...A method used to detect anomaly and estimate the state of vehicle in driving was proposed.The kinematics model of the vehicle was constructed and nonholonomic constraint conditions were added,which refer to that once the vehicle encounters the faults that could not be controlled,the constraint conditions are violated.Estimation equations of the velocity errors of the vehicle were given out to estimate the velocity errors of side and forward.So the stability of the whole vehicle could be judged by the velocity errors of the vehicle.Conclusions were validated through the vehicle experiment.This method is based on GPS/INS integrated navigation system,and can provide foundation for fault detections in unmanned autonomous vehicles.展开更多
基金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.
基金Projects(60775049,60805033) supported by National Natural Science Foundation of ChinaProject(2007AA704317) supported by the National High Technology Research and Development Program of China
文摘Due to the intense vibration durirLg launching and rigorous orbital temperature environment, the kinematic parameters of space robot may be largely deviated from their nominal parameters. The disparity will cause the real pose （including position and orientation） of the end effector not to match the desired one, and further hinder the space robot from performing the scheduled mission. To improve pose accuracy of space robot, a new self-calibration method using the distance measurement provided by a laser-ranger fixed on the end-effector is proposed. A distance-measurement model of the space robot is built according to the distance from the starting point of the laser beam to the intersection point at the declining plane. Based on the model, the cost function about the pose error is derived. The kinematic calibration is transferred to a non-linear system optimization problem, which is solved by the improved differential evolution （DE） algoritlun. A six-degree of freedom （6-DOF） robot is used as a practical simulation example, and the simulation results show： 1） A significant improvement of pose accuracy of space robot can be obtained by distance measurement only; 2） Search efficiency is increased by improved DE; 3） More calibration configurations may make calibration results better.
基金Projects(90820302,60805027) supported by the National Natural Science Foundation of ChinaProject(200805330005) supported by Research Fund for Doctoral Program of Higher Education of China+1 种基金Projects(2009FJ4030) supported by Academician Foundation of Hunan Province,ChinaProject supported by the Freedom Explore Program of Central South University,China
文摘A method used to detect anomaly and estimate the state of vehicle in driving was proposed.The kinematics model of the vehicle was constructed and nonholonomic constraint conditions were added,which refer to that once the vehicle encounters the faults that could not be controlled,the constraint conditions are violated.Estimation equations of the velocity errors of the vehicle were given out to estimate the velocity errors of side and forward.So the stability of the whole vehicle could be judged by the velocity errors of the vehicle.Conclusions were validated through the vehicle experiment.This method is based on GPS/INS integrated navigation system,and can provide foundation for fault detections in unmanned autonomous vehicles.
