CN112147889B - Combined obstacle crossing track planning method for four-foot robot - Google Patents

Combined obstacle crossing track planning method for four-foot robot Download PDF

Info

Publication number
CN112147889B
CN112147889B CN202010901246.1A CN202010901246A CN112147889B CN 112147889 B CN112147889 B CN 112147889B CN 202010901246 A CN202010901246 A CN 202010901246A CN 112147889 B CN112147889 B CN 112147889B
Authority
CN
China
Prior art keywords
robot
obstacle crossing
obstacle
cpg
leg
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202010901246.1A
Other languages
Chinese (zh)
Other versions
CN112147889A (en
Inventor
郭健
黄紫霄
朱晓璐
魏扬帆
王艳琴
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Science and Technology
Original Assignee
Nanjing University of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nanjing University of Science and Technology filed Critical Nanjing University of Science and Technology
Priority to CN202010901246.1A priority Critical patent/CN112147889B/en
Publication of CN112147889A publication Critical patent/CN112147889A/en
Application granted granted Critical
Publication of CN112147889B publication Critical patent/CN112147889B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles

Abstract

The invention discloses a combined obstacle crossing track planning method for a quadruped robot, which comprises the steps of establishing a CPG model, and controlling the quadruped robot to walk on a flat road surface with periodic gait through standard oscillation signals output by the model; when an obstacle appears on a flat road surface, determining an optimal obstacle crossing starting point according to obstacle distance information returned by the sensor, and changing the CPG rhythm regulation step length to enable the robot to reach the optimal obstacle crossing starting point in the previous step of obstacle crossing; and (4) drawing a track of the obstacle crossing foot end based on an improved composite cycloid rule, and controlling the robot to cross the obstacle. The method combines the traditional CPG strategy with the foot end trajectory planning strategy, and realizes the stable obstacle crossing of the four-footed robot.

Description

Combined obstacle crossing track planning method for four-foot robot
Technical Field
The invention relates to the field of gait planning of a four-footed robot, in particular to a combined obstacle crossing track planning method of the four-footed robot.
Background
With the development of industrial technology, the quadruped robot has good mobility and can traverse a complex environment with obstacles. Reasonable selection of the landing points under the terrain conditions with obstacles in distribution is the key capability of the quadruped robot, especially the special-purpose robot. While numerous control methods have been used to control the motion of quadruped robots, their performance is still far behind that of animals in the biological world.
Compared with other control strategies, the biological control method based on the Central Pattern Generator (CPG) can effectively improve the motion stability and environmental adaptability of the robot by using the characteristics of the motion mode of animals in the nature, and the energy consumption is lower than that of a foot-end track method under the same route. Through the motion observation of the quadruped organisms, the gait of the organisms on the flat ground approaches to the periodic gait, but tends to the free gait on the undulating ground, and the phase relation and the step length period in the gait period can be planned in real time according to the external environment. The traditional CPG lacks the interaction with external environment information, so the CPG is more suitable for generating regular rhythm gait on a flat road surface. The appearance of the obstacle breaks the rhythm of the robot, and if the CPG method is continuously adopted for obstacle crossing, although the obstacle crossing can be realized by adjusting feedback parameters, the control process is complicated, the traditional CPG obstacle crossing method is complex in design, and the generated angle signal cannot intuitively represent the obstacle crossing track. At the moment, the method based on foot end trajectory planning is more direct, the contact between the foot end and the obstacle can be effectively avoided, the obstacle shape is attached, and the performance is better.
Disclosure of Invention
The invention aims to provide a combined obstacle crossing track planning method for a four-footed robot, which solves the problem that the four-footed robot suddenly encounters obstacles when walking normally under CPG rhythm gait.
The technical solution for realizing the purpose of the invention is as follows: a four-foot robot composite obstacle crossing trajectory planning method comprises the following steps:
step 1, establishing a CPG model, and controlling a quadruped robot to walk on a flat road surface in a periodic gait through a standard oscillation signal output by the model;
step 2, when an obstacle appears on a flat road surface, determining an optimal obstacle crossing starting point, and changing the CPG rhythm regulation step length according to obstacle distance information returned by the sensor so that the robot reaches the optimal obstacle crossing starting point in the previous step of obstacle crossing;
and 3, drawing a track of the obstacle crossing foot end based on a composite cycloid rule, and controlling the robot to cross the obstacle.
Further, in step 1, a CPG model is established, and a quadruped robot is controlled to walk on a flat road surface with periodic gait by a standard oscillation signal output by the model, specifically:
the CPG model adopts a Hopf oscillator as a unit model of the CPG, the movement of hip joints and knee joints of four legs is respectively controlled through 4 Hopf harmonic oscillators, the coordination among the feet of the four feet is realized by constructing a specific phase relation among the 4 oscillators, and the formed mathematical model of the CPG model is as follows:
Figure BDA0002659836700000021
in the formula, x i And y i Is the output of each leg rhythm oscillator, x, of the four-legged robot i Is the hip joint trajectory of the ith leg, y i Is the knee joint trajectory of the jth leg; r is i 2 ＝x i 2 +y i 2 ；ω i Adjusting the coefficient for the frequency of the oscillator; μ is the oscillator amplitude adjustment coefficient; alpha is a constant coefficient and is used for controlling the speed of the oscillator converging to a limit ring;
Figure BDA0002659836700000022
the transformation matrix from the oscillator j to the oscillator i is used for explaining the phase relationship between every two oscillators and is defined as the following formula:
Figure BDA0002659836700000023
wherein
Figure BDA0002659836700000024
Representing the phase difference of oscillator i and oscillator j;
and converting the signal output by the CPG into an angle control signal of the hip and knee joint, wherein the mapping relation is as follows:
Figure BDA0002659836700000025
wherein, theta hi And theta ki Angle control signals for hip joint and knee joint, respectively, on the ith leg, A k And A h The amplitude of the knee and hip joint movements, respectively.
Further, in step 2, according to the obstacle distance information returned by the sensor, an optimal obstacle crossing starting point is determined, and the CPG rhythm adjustment step length is changed, so that the robot reaches the obstacle crossing starting point one step before obstacle crossing, specifically:
the control of the step length of a single leg is realized by adjusting the positive and negative values of the hip joint angle signal, so that the robot can fall to the optimal obstacle crossing starting point, and the correlation between the step length and the positive and negative hip joint angle values is as follows:
S i ＝L sinθ hi - +L sinθ hi +
wherein S is i Represents the step length of the ith leg of the four-legged robot, L represents the leg length, and theta hi - And theta hi + Respectively representing the positive and negative values of the hip joint angle signal.
Further, in step 3, a obstacle crossing foot end track is drawn based on a composite cycloid rule to control the robot to cross the obstacle, and the specific method is as follows:
the improved compound cycloid method is adopted to correct the step height function in the z-axis direction so as to solve the problem of leg lifting instant acceleration jump, and the compound cycloid equation is as follows:
Figure BDA0002659836700000031
wherein S and H respectively represent the step length and the step height of the foot end track of the quadruped robot; t is gait cycle; t is sampling time; x is a robot step function with respect to time t; z is a function of the robot step-up with respect to time t.
Further, in step 3, the optimal step length of the obstacle crossing trajectory is determined on the premise of the lowest energy consumption, and specifically:
a certain mathematical relationship exists between the leg lifting height and the optimal step length:
Figure BDA0002659836700000032
wherein S represents the step length of the obstacle-crossing leg, M is the mass of a single leg, M is the mass of the robot body, H is the leg lifting height, H is the height of the center of mass of the robot body in the upright state of the robot, and c is the equivalent distance (c belongs to [0, H/2 ]) for the leg swinging and landing process to work; and determining the leg lifting height H according to the known height information of the obstacle, solving the step length S which enables the robot to have the lowest energy consumption in the obstacle crossing process by using the mathematical model, and substituting the step length S into a foot end track formula to obtain the obstacle crossing foot end track.
A combined obstacle crossing track planning system of a four-foot robot uses the combined obstacle crossing track planning method of the four-foot robot to plan obstacle crossing tracks, and comprises the following steps:
the planar motion module is used for establishing a CPG model and controlling the quadruped robot to walk on a planar road surface in a periodic gait through standard oscillation signals output by the model;
the obstacle crossing preparation module is used for determining an optimal obstacle crossing starting point when an obstacle appears on a flat road surface, and changing the CPG rhythm regulation step length according to obstacle distance information returned by the sensor so that the robot can reach the optimal obstacle crossing starting point in one step before crossing the obstacle;
and the obstacle crossing module is used for drawing the track of the obstacle crossing foot end based on the composite cycloid rule and controlling the robot to cross the obstacle.
A computer device comprises a memory, a processor and a computer program which is stored on the memory and can run on the processor, and the processor can realize the combined obstacle crossing trajectory planning method for the quadruped robot when executing the computer program.
A computer-readable storage medium, on which a computer program is stored, which, when executed by a processor, implements the above-described four-footed robot composite obstacle crossing trajectory planning method.
Compared with the prior art, the invention has the following remarkable advantages: 1) Changing the CPG rhythm in one step before obstacle crossing based on the obstacle environment model, and enabling the swing legs of the robot to fall to the optimal planned obstacle crossing starting point; 2) Aiming at the problem that the traditional compound cycloid equation has sudden change of the acceleration of the initial point and the drop foot point, the compound cycloid equation is corrected, the obstacle crossing foot end track which is in a shape of an obstacle is designed, the energy consumption is reduced, and accurate and stable obstacle crossing is realized.
Drawings
FIG. 1 is a block flow diagram of the present invention.
FIG. 2 is an illustration of the advancing direction of a single leg of a quadruped robot
Fig. 3 is a schematic diagram of an obstacle crossing track of the quadruped robot.
Fig. 4 is a diagram of simulation obstacle surmounting of the webots platform.
Fig. 5 is a trajectory planning curve for the foot end of the obstacle crossing leg.
Fig. 6 shows the hip joint and knee joint angle changes of the quadruped robot.
Fig. 7 is a graph of foot end trajectory at various stages of an obstacle crossing leg.
Detailed Description
In order to make the objects, technical solutions and advantages of the present application more clearly understood, the present application is further described in detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the present application and are not intended to limit the present application.
As shown in fig. 1, a combined obstacle crossing trajectory planning method for a quadruped robot includes the following steps:
step 1, establishing a CPG model, and controlling a quadruped robot to walk on a flat road surface in a periodic gait through a standard oscillation signal output by the model;
further, the specific method of CPG modeling is:
the Hopf oscillators are used as a unit model of the CPG, the 4 Hopf harmonic oscillators respectively control the movement of hip joints and knee joints of four legs, and the inter-foot coordination of four feet is realized by constructing a specific phase relation among the 4 oscillators. The mathematical model of the formed CPG network is as follows:
Figure BDA0002659836700000041
in the formula, x i And y i Is the output of each leg rhythm oscillator, x, of the four-legged robot i Is the hip joint trajectory of the ith leg, y i Is the knee joint trajectory of the jth leg; r is i 2 ＝x i 2 +y i 2 ；ω i Adjusting the coefficient for the frequency of the oscillator; μ is the oscillator amplitude adjustment coefficient; alpha is a constant coefficient and is used for controlling the speed of the oscillator converging to a limit ring; r (theta) i j ) Is a conversion matrix from oscillator j to oscillator i for illustrating twoThe phase relationship between the two oscillators is defined as follows:
Figure BDA0002659836700000051
wherein theta is i j Representing the phase difference of oscillator i and oscillator j.
And converting the signal output by the CPG into an angle control signal of the hip and knee joint, wherein the mapping relation is as follows:
Figure BDA0002659836700000052
wherein, theta hi And theta ki Angle control signals for hip joint and knee joint on ith leg, respectively, A k And A h The amplitudes of the movements of the knee joint and hip joint, respectively. By varying theta hi And theta ki Generate different gait signals, thereby realizing the rhythm gait of the quadruped robot on the flat ground.
Step 2, when an obstacle appears on a flat road surface, determining an optimal obstacle crossing starting point, and changing the CPG rhythm regulation step length according to obstacle distance information returned by the sensor so that the robot reaches the optimal obstacle crossing starting point in the previous step of obstacle crossing;
further, the specific method for the robot to change the CPG rhythm regulation step length is as follows:
in order to simplify the calculation and facilitate the control, the output signal of only the hip joint angle is changed in the CPG model mapping described in step 1, fig. 2 is an example of the advancing direction of one leg of the quadruped robot, and the correlation between the step size and the positive and negative values of the hip joint can be obtained from the figure as follows:
S i ＝L sinθ hi - +L sinθ hi +
wherein S is i Represents the step length of the ith leg of the four-legged robot, L represents the leg length, and theta hi - And theta hi + Respectively represent the positive and negative values of the hip joint angle signal, taking a vertical line as a boundary,the left side is minus, the right side is plus or minus, so that the step length can be freely adjusted conveniently in the second step. And step one, the step is moved on the flat ground, and the step length of each period is not changed, namely the positive and negative are equal, so that the positive and negative are not required to be divided.
Step 3, drawing an obstacle crossing track based on a composite cycloid rule, setting a step length based on the lowest energy consumption principle, further obtaining a low-impact obstacle crossing track fitting the shape of an obstacle, and enabling the swing legs to cross the obstacle;
further, the specific method for planning the foot end track by improving the compound cycloidal method comprises the following steps:
in order to achieve ideal obstacle-surmounting gait, with safer movement, smooth gait and good performance, the planned tip trajectory needs to satisfy the following constraints:
(1) The foot end track of the quadruped robot starts to fall to the obstacle crossing starting point planned in advance and ends at the target point;
(2) In the whole swing period, the foot end and each part of the leg part do not collide and contact with the barrier;
(3) The foot end track in the swing period of the quadruped robot is smooth, and the joint angle, the angular velocity and the angular acceleration are continuous, smooth and have no sudden change;
(4) The joint angle, the angular speed and the joint moment of each leg of the robot do not exceed the allowable range;
(5) The leg lifting and landing with zero impact at the foot end are realized at the moment of swinging the leg lifting and landing;
the traditional method adopts a compound cycloid formal equation as the foot end locus of the swing leg of the quadruped robot, and the form is as follows:
Figure BDA0002659836700000061
wherein S and H respectively represent the step length and the step height of the foot end track of the quadruped robot; t is the gait cycle; t is sampling time; x (t) is a robot step function with respect to time t; z (T) is the robot step height function with respect to time T, whose acceleration equation is a multiple of the cosine function at T =0 and T = T m The instant requirement of leg lifting can be met by the jump of accelerationA large contact force is generated. Aiming at the problem of acceleration abrupt change, the invention corrects the step height function in the z-axis direction.
Designing a track equation at T =0 and T = T m At any moment, because the swing legs move on the z axis, the legs need to be lifted first and then dropped, and the z-axis displacement curve is solved by using a method of sine mode motion of the x axis of the cycloid equation
Figure BDA0002659836700000062
Where n is a natural number, n =0,1,2,3, \ 8230;. The velocity function can be determined by integration
Figure BDA0002659836700000063
Wherein C is a constant generated by integration, and according to the speed requirement of the foot end of the robot: to obtain
Figure BDA0002659836700000064
And
Figure BDA0002659836700000065
further obtaining:
Figure BDA0002659836700000066
when k =1 is taken, the trajectory of the foot end of the quadruped robot is displayed as an oblique line in an Oxz plane, and the performance of the quadruped robot for crossing the obstacle is influenced; if the k value is larger, the addition and subtraction of the speed of the foot end of the quadruped robot are frequently changed, and the performance consumption of the leg part is increased, so that the k =2 is reasonably considered.
Figure BDA0002659836700000071
Integral determination of displacement
Figure BDA0002659836700000072
Wherein, C 2 Is a constant generated by integration, z is required by the track t＝0 ＝0、
Figure BDA0002659836700000073
And
Figure BDA0002659836700000074
the motion curve equation in the z-axis direction is obtained by a piecewise function method as follows:
Figure BDA0002659836700000075
and (3) obtaining an improved composite cycloid equation after arrangement, namely an obstacle crossing trajectory function:
Figure BDA0002659836700000076
the robot can modify the parameters S, H and T according to different motion environments and speed requirements. The invention is based on the scene that the robot meets the obstacle under the CPG rhythm gait, the obstacle information can be obtained by a sensor, and if the obstacle can be crossed, the obstacle crossing strategy provided by the invention is implemented. The following mathematical model provides a theoretical basis for the existence of the optimal step size on the premise of the lowest energy consumption: a certain mathematical relationship exists between the leg lifting height and the optimal step length:
Figure BDA0002659836700000077
wherein M is the mass of a single leg, M is the mass of a robot body, H is the leg lifting height, H is the height of the mass center of the robot body in the upright state of the robot, and c is the equivalent distance (c is equal to 0, H/2) for doing work in the process of falling to the ground by swinging the phase leg. And determining the leg lifting height H according to the known height information of the obstacle, solving the step length S which enables the robot to have the lowest energy consumption in the obstacle crossing process by using the mathematical model, substituting the step length S into a foot end track formula to obtain an obstacle crossing foot end track, wherein the obstacle crossing schematic diagram is shown in figure 3.
Examples
In order to verify the validity of the scheme of the invention, simulation experiments are carried out.
A quadruped robot is built on a Webots simulation platform, and is shown in figure 4. The basic parameters of the robot are as follows: m =10kg, m =100kg, h =0.6m, the circular obstacle with the radius being 5 cm is constructed, and the obstacle crossing step height of the robot is set according to the obstacle height information: h =0.1m, c =0. Then based on the above parameters, the optimal step length can be calculated by the optimal step length formula:
Figure BDA0002659836700000081
the swing period T =0.5s was set and the foot end trajectory curve was obtained by simulation in MATLAB as shown in fig. 5. As can be seen from fig. 5, the simulated trajectory substantially meets the expected requirements. The obstacle crossing motion trajectory curve is smooth and continuous, the obstacle crossing position requirement is met, sudden change does not exist at the starting moment and the ending moment, and the acceleration and the speed are zero, so that the impact on the ground is small. During the crossing of the upper plane of the obstacle, the curve is almost horizontal, which means that both the speed and the acceleration are approximately equal to 0, which effectively reduces the impact of the obstacle that may be present during the actual obstacle crossing.
The angular changes of the hip joint and the knee joint can be obtained by resolving the cycloid equation planned based on the foot end locus through the inverse kinematics solution of the quadruped robot as shown in fig. 6. The response of the joint angle is consistent with the obstacle crossing trajectory shown in fig. 5, and it can be seen that the simulation result conforms to the planned obstacle crossing trajectory.
Fig. 7 shows the overall process of the composite obstacle crossing trajectory planning strategy presented herein. The first stage corresponds to the foot end track of the robot walking on a flat road with the periodic gait of the CPG; the second stage changes the CPG rhythm, adjusts the stride, and changes the rhythm corresponding to the obstacle crossing previous step to reach the track of the optimal obstacle crossing starting point; and the third stage corresponds to a composite cycloid foot end obstacle crossing track which crosses the optimal step length based on the lowest energy consumption, and the track has the characteristic of fitting the shape of an obstacle.
The invention mainly solves the problem of stable walking control of the quadruped robot when encountering obstacles suddenly under the CPG rhythm gait. Aiming at the background that a quadruped robot suddenly meets an obstacle on a flat road surface, a CPG and foot end track combined composite obstacle crossing strategy is provided, and the original CPG rhythm gait is switched to the obstacle crossing gait to realize stable obstacle crossing. Firstly, CPG rhythm is changed in one step before obstacle crossing based on an obstacle environment model, so that a swing leg of a robot falls to a pre-planned optimal obstacle crossing initial point, and then a composite cycloid equation is corrected aiming at the problem that the acceleration of the initial point and the falling point suddenly changes in the traditional composite cycloid equation. A planned obstacle crossing curve is obtained through simulation in MATLAB, a four-legged robot is built on a Webots platform, the obstacle crossing process under the strategy is shown, the effectiveness of the strategy is verified through the simulation result, the designed obstacle crossing foot end track is attached to the shape of the obstacle, the energy consumption is lower, and accurate and stable obstacle crossing is realized.
All possible combinations of the technical features in the above embodiments may not be described for the sake of brevity, but should be considered as being within the scope of the present disclosure as long as there is no contradiction between the combinations of the technical features.
The above-mentioned embodiments only express several embodiments of the present application, and the description thereof is more specific and detailed, but not construed as limiting the scope of the invention. It should be noted that, for a person skilled in the art, several variations and modifications can be made without departing from the concept of the present application, and these are all within the scope of protection of the present application. Therefore, the protection scope of the present patent shall be subject to the appended claims.

Claims (5)

1. A four-foot robot composite obstacle crossing track planning method is characterized by comprising the following steps:
step 1, establishing a CPG model, and controlling a quadruped robot to walk on a flat road surface in a periodic gait through a standard oscillation signal output by the model;
step 2, when an obstacle appears on a flat road surface, determining an optimal obstacle crossing starting point according to obstacle distance information returned by the sensor, and changing the CPG rhythm regulation step length to enable the robot to reach the optimal obstacle crossing starting point in the previous step of obstacle crossing;
step 3, drawing a track of the obstacle crossing foot end based on a composite cycloid rule, and controlling the robot to cross the obstacle;
in step 2, determining an optimal obstacle crossing starting point according to the obstacle distance information returned by the sensor, and changing the CPG rhythm regulation step length to enable the robot to reach the obstacle crossing starting point in the previous step of obstacle crossing, wherein the method specifically comprises the following steps:
the control of the step length of a single leg is realized by adjusting the positive and negative values of the hip joint angle signal, so that the robot can fall to the optimal obstacle crossing starting point, and the correlation between the step length and the positive and negative hip joint angle values is as follows:
S i ＝Lsinθ hi - +Lsinθ hi +
wherein S is i Represents the step length of the ith leg of the quadruped robot, L represents the leg length, and theta hi - And theta hi + Respectively representing the positive and negative values of the hip joint angle signal, taking a vertical line as a boundary, the left side is negative, and the right side is positive;
in step 3, drawing a track of the obstacle crossing foot end based on a composite cycloid rule to control the robot to cross the obstacle, wherein the specific method comprises the following steps:
the improved compound cycloid method is adopted to correct the step height function in the z-axis direction so as to solve the problem of leg lifting instant acceleration jump, and the compound cycloid equation is as follows:
Figure FDA0003828610290000011
wherein S and H respectively represent the step length and the step height of the foot end track of the quadruped robot; t is gait cycle; t is sampling time; x is a robot step function with respect to time t; z is a robot step-up function with respect to time t;
the method comprises the following steps of determining the optimal step length of the obstacle crossing track on the premise of lowest energy consumption, specifically:
a certain mathematical relationship exists between the leg lifting height and the optimal step length:
Figure FDA0003828610290000012
wherein M is the mass of a single leg, M is the mass of a robot body, h is the height of the mass center of the robot body in the upright state of the robot, and c (c belongs to [0, h/2 ]) is the equivalent distance of working in the process of falling to the ground by swinging phase legs; and determining H according to the known height information of the obstacle, solving S which enables the robot to have the lowest energy consumption in the obstacle crossing process through a mathematical model, and substituting the S into a foot end track formula to obtain the obstacle crossing foot end track.
2. The method for planning the composite obstacle crossing trajectory of the quadruped robot according to claim 1, wherein in step 1, a CPG model is established, and the quadruped robot is controlled to walk on a flat road surface with periodic gait by a standard oscillation signal output by the model, specifically:
the CPG model adopts a Hopf oscillator as a unit model of the CPG, the movement of hip joints and knee joints of four legs is respectively controlled through 4 Hopf harmonic oscillators, the coordination among the feet of the four feet is realized by constructing a specific phase relation among the 4 oscillators, and the formed mathematical model of the CPG model is as follows:
Figure FDA0003828610290000021
in the formula, x i And y i Is the output of each leg rhythm oscillator of the four-legged robot, x i Is the hip joint trajectory of the ith leg, y i Is the knee joint trajectory of the jth leg; r is a radical of hydrogen i 2 ＝x i 2 +y i 2 ；ω i Adjusting the coefficient for the oscillator frequency; μ is the oscillator amplitude adjustment coefficient; alpha is a constant coefficient and is used for controlling the speed of the oscillator converging to a limit ring;
Figure FDA0003828610290000022
for conversion of oscillator j to oscillator iThe matrix is used for explaining the phase relation between every two oscillators and is defined as the following formula:
Figure FDA0003828610290000023
wherein
Figure FDA0003828610290000024
Representing the phase difference of oscillator i and oscillator j;
and converting the signal output by the CPG into an angle control signal of the hip and knee joint, wherein the mapping relation is as follows:
Figure FDA0003828610290000025
wherein, theta hi And theta ki Angle control signals for hip joint and knee joint, respectively, on the ith leg, A k And A h The amplitudes of the movements of the knee joint and hip joint, respectively.
3. A four-legged robot composite obstacle crossing trajectory planning system, which is characterized in that the obstacle crossing trajectory planning method of any one of claims 1-2 is used for planning the obstacle crossing trajectory, and comprises the following steps:
the flat motion module is used for establishing a CPG model and controlling the quadruped robot to walk on a flat road surface in a periodic gait through a standard oscillation signal output by the model;
the obstacle crossing preparation module is used for determining an optimal obstacle crossing starting point according to obstacle distance information returned by the sensor when an obstacle appears on a flat road surface, and changing the CPG rhythm regulation step length to enable the robot to reach the optimal obstacle crossing starting point in the previous step of obstacle crossing;
and the obstacle crossing module is used for drawing the track of the obstacle crossing foot end based on the improved composite cycloid rule and controlling the robot to cross the obstacle.
4. A computer apparatus comprising a memory, a processor and a computer program stored on the memory and executable on the processor, the processor implementing the quadruped robotic compound obstacle crossing trajectory planning method of any one of claims 1-2 when executing the computer program.
5. A computer-readable storage medium having stored thereon a computer program which, when executed by a processor, implements the quadruped robotic compound obstacle crossing trajectory planning method of any one of claims 1-2.
CN202010901246.1A 2020-08-31 2020-08-31 Combined obstacle crossing track planning method for four-foot robot Active CN112147889B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010901246.1A CN112147889B (en) 2020-08-31 2020-08-31 Combined obstacle crossing track planning method for four-foot robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010901246.1A CN112147889B (en) 2020-08-31 2020-08-31 Combined obstacle crossing track planning method for four-foot robot

Publications (2)

Publication Number Publication Date
CN112147889A CN112147889A (en) 2020-12-29
CN112147889B true CN112147889B (en) 2022-11-25

Family

ID=73890375

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010901246.1A Active CN112147889B (en) 2020-08-31 2020-08-31 Combined obstacle crossing track planning method for four-foot robot

Country Status (1)

Country Link
CN (1) CN112147889B (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113110484A (en) * 2021-04-30 2021-07-13 深圳市优必选科技股份有限公司 Gait trajectory planning method and device, readable storage medium and robot
CN113771046B (en) * 2021-10-25 2023-06-30 中国北方车辆研究所 Method for planning swing track of minimized Jerk index
CN115840453B (en) * 2023-02-10 2023-05-05 季华实验室 Self-adaptive foot end obstacle avoidance method and device for four-foot robot, electronic equipment and medium

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103092196A (en) * 2011-10-28 2013-05-08 同济大学 Two-foot robot track generating and modulating method based on certified program generator (CPG) mechanism
CN110328670A (en) * 2019-08-27 2019-10-15 山东科技大学 The quiet gait planning method of quadruped robot based on landform fuzzy self-adaption
CN110842921A (en) * 2019-11-19 2020-02-28 山东大学 Gait planning method for climbing and crossing of large-gradient terrain or high-obstacle of four-footed robot

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4836592B2 (en) * 2006-02-09 2011-12-14 ソニー株式会社 Robot apparatus and control method thereof

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103092196A (en) * 2011-10-28 2013-05-08 同济大学 Two-foot robot track generating and modulating method based on certified program generator (CPG) mechanism
CN110328670A (en) * 2019-08-27 2019-10-15 山东科技大学 The quiet gait planning method of quadruped robot based on landform fuzzy self-adaption
CN110842921A (en) * 2019-11-19 2020-02-28 山东大学 Gait planning method for climbing and crossing of large-gradient terrain or high-obstacle of four-footed robot

Also Published As

Publication number Publication date
CN112147889A (en) 2020-12-29

Similar Documents

Publication Publication Date Title
CN112147889B (en) Combined obstacle crossing track planning method for four-foot robot
CN110315543B (en) Biped robot gait generation and optimization method
JP4836592B2 (en) Robot apparatus and control method thereof
JP5052013B2 (en) Robot apparatus and control method thereof
CN108572553B (en) Motion closed-loop control method of quadruped robot
CN105965506A (en) Humanoid biped robot walking posture control method based on genetic algorithm
CN109760761A (en) A kind of quadruped robot motion control method based on bionic principle and intuition
Shao et al. Recent advances on gait control strategies for hydraulic quadruped robot
Han et al. A heuristic gait template planning and dynamic motion control for biped robots
Deng et al. Cpg-inspired gait generation and transition control for six wheel-legged robot
Chung et al. A CPG-inspired controller for a hexapod robot with adaptive walking
Yu et al. Biped robot gait planning based on 3D linear inverted pendulum model
Xie et al. Adaptive walking on slope of quadruped robot based on CPG
Aghaabbasloo et al. Biped robot joint trajectory generation using PSO evolutionary algorithm
Son et al. Generation of adaptive gait patterns for quadruped robot with CPG network including motor dynamic model
CN115256391A (en) Crawling track planning and motion control method for humanoid robot
Teng et al. Center of gravity balance approach based on CPG algorithm for locomotion control of a quadruped robot
CN105438305B (en) A kind of application method of bionical six limbs insect robot
Yu et al. Gait Planning for Biped Robot Based on Variable Center-of-Mass Height Hybrid Strategy
Lu et al. A novel multi-configuration quadruped robot with redundant DOFs and its application scenario analysis
Zhang et al. Optimal energy gait planning for humanoid robot using geodesics
CN108717267B (en) Central mode reverse control method of hexapod robot
Lu et al. Generation and analyses of the reinforced wave gait for a mammal-like quadruped robot
Han et al. Modeling and co-simulation of lower limb exoskeleton
Zhang et al. Development and attitude control of a Hexapod bionic-Robot

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
CB03 Change of inventor or designer information

Inventor after: Guo Jian

Inventor after: Huang Zixiao

Inventor after: Zhu Xiaolu

Inventor after: Wei Yangfan

Inventor after: Wang Yanqin

Inventor before: Huang Zixiao

Inventor before: Zhu Xiaolu

Inventor before: Guo Jian

Inventor before: Wei Yangfan

Inventor before: Wang Yanqin

CB03 Change of inventor or designer information
GR01 Patent grant
GR01 Patent grant