A novel kinematics and statics correction algorithm of semi-cylindrical foot end structure for 3-DOF LHDS of legged robots

摘要

Abstract In this paper, aiming at the problem that the ideal modeling point of the foot end deviates from the actual contact point due to the rolling effect of the semi-cylindrical foot end in leg hydraulics drive system (LHDS), a novel and relatively simple kinematics and statics correction algorithm is proposed. This algorithm can effectively improve the accuracy of LHDS kinematics and statics, and it is still applicable when the body and the contact surface are at different angles. Firstly, this paper deduces the kinematics and statics when the foot end of LHDS is regarded as the point foot, analyzes and calculates the deviation under common working conditions. Secondly, in view of this phenomenon, a kinematics correction algorithm based on virtual DOF and a statics correction algorithm based on translation theorem of forces are proposed respectively. Finally, the proposed algorithm is verified by LHDS performance test platform under various working conditions. The results show that after applying the kinematics correction algorithm, the trajectory deviation reduction rate of the hip joint is over 65%; after applying the statics correction algorithm, the deviation reduction rate of foot end contact force is over 43%. The related research results can be applied to any similar foot end, which has engineering application value.