The application discloses a kind of cabin section
butt joint double-arm mechanism sub-stage coordinated trajectory tracking control methods, including solving left and right mechanical arm end motion trajectory through double-arm mechanism and cabin section coordinated
kinematics model, generating left and right mechanical arm end operation space target trajectory, calculating left and right mechanical arm each joint target displacement and speed, based on double-arm mechanism joint dynamics equation, using
control algorithm constructs mechanical arm joint calculation
torque controller, real-time output joint
control torque, realize joint trajectory accurate control, thereafter through acquisition double-arm mechanism joint actual displacement, double-arm mechanism
forward kinematics model, real-time solving mechanical arm end actual
pose, through deviation dynamic adjustment mechanical arm joint motion speed, to realize the coordinated operation of double-arm motion trajectory.The scheme guarantees joint level tracking accuracy and dynamic response performance, and effectively avoids the
safety risk in coordinated operation through end trajectory
closed loop monitoring, improves the reliability and adaptability of control from
system structure level.