The invention discloses a stability control method for rbiomimetic obosaur
crawling, comprising the following steps of: simplifying limbs into a
system of
mass points; establishing a D-H coordinate
system for each
rigid body connecting rod; then sequentially transforming to obtain a position
pose of a sole relative to an
organism coordinate
system, and planning advancing gaits as crouching, inclining a body toward the right side and swinging the
tail toward the right side, stepping a front left leg forward, stepping a rear left leg forward, inclining the body toward the left side and swinging the
tail toward the left side, stepping a rear right leg forward, stepping a front right leg forward, and inclining the body toward the right by a
transformation matrix between the
organism coordinate system and a ground coordinate system; and calculating the
gravity center of each limb constituent part and the overall
mass center of an obosaur in real time by using the
transformation matrix according to a driving function of thighs, shanks and hip joints to ensure that a
vertical projection falls on a polygonal region formed by footing points. A function relation between a total
mass center and joints is obtained through transformation between the
organism coordinate system and a fixed coordinate system, and thus each
joint variable is regulated, and the walking stability of a rbiomimetic obosaur is improved.