Method, device, electronic device, computer program for controlling walking robot, and walking robot

By planning and controlling the center of gravity and mechanical leg trajectories using a dynamic model, the method addresses excessive impact forces in walking robots, enhancing stability and reducing damage during landings.

JP2024543978AActive Publication Date: 2024-11-26TENCENT TECHNOLOGY (SHENZHEN) CO LTD

Patent Information

Application Number
JP2024532530
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Priority Date
2022-07-25
Filing Date
2023-05-06
Publication Date
2024-11-26
Estimated Expiration
2043-05-06

AI Technical Summary

Technical Problem

Walking robots, particularly quadrupedal robots, experience excessive impact forces during landing, leading to potential damage due to stiff movements and repulsion, which current control methods fail to adequately address.

Method used

A method and apparatus for controlling a walking robot by determining expected trajectories for the center of gravity and mechanical leg foot ends, using a dynamic model to adjust joint movements upon contact with a surface, reducing impact forces and repulsion through planned trajectories.

Benefits of technology

The solution effectively reduces impact forces on joints, minimizes body rebound, and enhances impact resistance during landing, ensuring stable and damage-free operations.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024543978000001_ABST
    Figure 2024543978000001_ABST
Patent Text Reader

Abstract

A method, device, electronic device, computer-readable storage medium, computer program product, and walking robot for controlling a walking robot. The walking robot includes a base and at least two mechanical legs, each of which includes at least one joint, and a method for controlling the walking robot includes the steps of: determining a first expected trajectory corresponding to the walking robot in response to the walking robot dropping until the walking robot touches a flat surface, and determining a second expected trajectory corresponding to the walking robot, the first expected trajectory indicating an expected trajectory of a center of gravity of the walking robot, and the second expected trajectory indicating an expected trajectory of a foot end of the at least two mechanical legs; and controlling a movement of each joint after the walking robot touches the flat surface based on a dynamics model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory.
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present application relates to planning and control technology for walking robots in the technical field of walking robots (footed robots), and in particular to a method, an apparatus, an electronic device, a computer-readable storage medium, a computer program product, and a walking robot for controlling a walking robot.

[0002] This application is filed based on and claims priority to a Chinese patent application having application number 202210877092.6 and filing date July 25, 2022, the entire contents of which are hereby incorporated by reference into this application. [Background technology]

[0003] As artificial intelligence and walking robot technology are widely applied in civilian and industrial fields, walking robots based on artificial intelligence and walking robot technology are playing an increasingly important role in fields such as smart transportation and smart homes, and are also facing higher demands.

[0004] At present, walking robots (e.g., quadruped walking robots) can already perform many different kinds of movements, such as bounding, flipping, etc. When walking robots perform these movements, their movements are often stiff during the landing process, and the impact force received by each joint is greater than the impact force threshold, which increases the rebound force on the body and increases the probability of damage to the walking robot. Summary of the Invention [Problem to be solved by the invention]

[0005] In response to the above-mentioned problems, embodiments of the present application provide a method, an apparatus, an electronic device, a computer-readable storage medium, a computer program product, and a walking robot for controlling a walking robot. [Means for solving the problem]

[0006] 1. A method of controlling a walking robot, the walking robot including a base and at least two mechanical legs, each mechanical leg including at least one joint, the method comprising: determining a first expected trajectory corresponding to the walking robot in response to the walking robot falling until it contacts a flat surface, and determining a second expected trajectory corresponding to the walking robot, the first expected trajectory indicating an expected trajectory of a center of gravity of the walking robot, and the second expected trajectory indicating an expected trajectory of foot ends of at least two of the mechanical legs; and controlling the movement of each of the joints after the walking robot contacts the plane based on a dynamic model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory.

[0007] An apparatus for controlling a walking robot, the walking robot including a base and at least two mechanical legs, each of the mechanical legs including at least one joint, the apparatus comprising: a planning computation module configured to determine a first expected trajectory corresponding to the walking robot in response to the walking robot falling until it contacts a flat surface, and to determine a second expected trajectory corresponding to the walking robot, the first expected trajectory indicating an expected trajectory of a center of gravity of the walking robot, and the second expected trajectory indicating an expected trajectory of foot ends of at least two of the mechanical legs; and a control module configured to control movement of each of the joints after the walking robot contacts the plane based on a dynamics model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory.

[0008] A walking robot, With the base, a lower limb unit connected to the base, the lower limb unit including at least two mechanical legs, each of the mechanical legs including a hip joint and a knee joint, the hip joint including at least two degrees of freedom, and the knee joint including at least one degree of freedom; and an electronic device, the electronic device being installed on the walking robot and used to execute the method for controlling a walking robot provided by an embodiment of the present application.

[0009] An electronic device for controlling a walking robot, A processor; A memory having a computer-executable program stored therein, the computer-executable program executing, when executed by the processor, a method for controlling a walking robot provided by an embodiment of the present application.

[0010] A computer-readable storage medium having a computer-executable program stored therein, the computer-executable program, when executed by a processor, causing the processor to perform a method for controlling a walking robot provided by an embodiment of the present application.

[0011] A computer program product includes a computer-executable program, which, when executed by a processor, realizes a method for controlling a walking robot provided by an embodiment of the present application. Effect of the Invention

[0012] The embodiment of the present application has at least the following beneficial effects: By planning the center of gravity of the walking robot after landing and the trajectory of the mechanical legs, and controlling the movement of each of the above-mentioned joints of the walking robot based on the planned center of gravity and the trajectory of the foot end of the mechanical legs, the impact force received by each joint during the landing process of the walking robot can be reduced, the rebound force on the body can be reduced, the impact resistance of the walking robot during the landing process can be improved, and the probability of damage to the walking robot can be further reduced.

[0013] In order to clearly describe the technical means of the embodiments of the present application, the following briefly introduces the drawings that need to be used in the description of the embodiments. It is obvious that the drawings in the following description are merely some exemplary embodiments of the present application, and those skilled in the art can obtain other drawings based on these drawings without creative labor. The following drawings are intentionally not drawn to scale in proportion to the actual size. [Brief description of the drawings]

[0014] [Figure 1] 1 shows a schematic diagram of a walking robot according to an embodiment of the present application. [Diagram 2] 1 shows a flowchart of a method for controlling a walking robot according to an embodiment of the present application. [Diagram 3] 1 is a schematic diagram showing the moment when a walking robot according to an embodiment of the present application comes into contact with a flat surface. [Figure 4] 1A and 1B are schematic diagrams showing changes in the center of gravity during the landing process of a walking robot according to an embodiment of the present application. [Diagram 5] 1A and 1B are schematic diagrams showing a mechanical leg of a walking robot according to an embodiment of the present application contacting a flat surface during the landing process. [Figure 6] 1 is a schematic diagram of the calculation principle of the cubic spline difference value provided by an embodiment of the present application; [Figure 7] FIG. 2 shows a comparison diagram between a first expected trajectory and an actual trajectory of the center of gravity of a walking robot according to an embodiment of the present application. [Figure 8A] FIG. 2 shows a simulation diagram of a walking robot according to an embodiment of the present application before landing. [Figure 8B] FIG. 2 shows a simulation diagram of the walking robot according to the embodiment of the present application after landing. [Figure 9] FIG. 1 illustrates an exemplary block diagram of a walking robot according to an embodiment of the present application. [Figure 10] 1 shows a structural diagram of a device for controlling a walking robot according to an embodiment of the present application. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0015] In order to make the objectives, technical means and advantages of the present application more clear, exemplary embodiments of the present application are described in detail below with reference to the drawings. Obviously, the described embodiments are only some embodiments of the present application, and are not all embodiments of the present application. It should be understood that the present application is not limited to the exemplary embodiments described herein.

[0016] As shown in the examples and claims of this application, unless otherwise clearly indicated by the context, the terms "a," "one," "a kind," and / or "the" do not specifically refer to the singular, but may include the plural. Generally speaking, the terms "comprise" and "comprise" merely indicate the inclusion of specifically identified steps and elements. These steps and elements do not constitute an exclusive list and may include other steps or elements.

[0017] Although the embodiments herein make various references to certain modules in the apparatus provided in accordance with the embodiments herein, any number of different modules may be used and operated in the user terminal and / or server. The modules are merely illustrative, and different aspects of the apparatus and methods may use different modules.

[0018] In the embodiments of the present application, a flowchart is used to explain the operations performed in the method and device provided according to the embodiments of the present application. As should be understood, the operations described above or below are not necessarily performed in exact order. Conversely, various steps can be performed in order, such as in reverse order or simultaneous processing, if necessary. At the same time, other operations can be added to these processes, or operations of one or more steps can be deleted from these processes.

[0019] In order to facilitate a description of the embodiments of the present application, the following introduces some concepts related to the embodiments of the present application.

[0020] The walking robot provided in the embodiment of the present application is a robot that uses mechanical legs to move, and the walking robot is used to simulate the movement patterns of animals based on the results of engineering and scientific research, and to copy the movement abilities of animals, using animals as bioengineering objects. Walking robots can adapt to various environments (including structured environments (such as roads, railways, and processed flat surfaces) and unstructured environments (such as mountains, swamps, and uneven surfaces)), adapt to various changes in terrain, overcome various obstacles, and effectively reduce the load and improve the energy utilization efficiency of the system. Walking robots can be divided into one-legged robots, two-legged robots, four-legged robots, six-legged robots, and eight-legged robots, etc., according to the number of legs. Here, four-legged robots have better static stability than two-legged robots, and their movements are simpler and more flexible than six-legged robots and eight-legged robots, so four-legged robots are the usual choice when studying walking robots. The gait of a quadruped robot refers to the temporal and spatial coordination of the four mechanical legs that enable the quadruped robot to move continuously. The gait of a quadruped robot comes from the gait of four-legged animals and may include, but is not limited to, three simplified forms: Walk, Trot, and Bound.

[0021] The method for controlling a walking robot provided in the embodiments of the present application may be based on artificial intelligence (AI). Artificial intelligence is a theory, method, technology, and application system that uses a digital computer or a machine controlled by a digital computer to simulate, expand, and extend human intelligence, sense the environment, acquire knowledge, and use the knowledge to obtain optimal results. In other words, artificial intelligence is a comprehensive technology of computer science that is used to understand the essence of intelligence and create new intelligent machines that respond in a manner similar to human intelligence. For example, a method for controlling a walking robot based on artificial intelligence can plan the motion trajectory and gait of the walking robot in a manner similar to how humans guide the motion of living animals, making the motion of the walking robot flexible and bionic. By studying the design principles and realization methods of various intelligent machines, artificial intelligence enables the method for controlling a walking robot provided in the embodiments of the present application to automatically and efficiently design the subsequent motion trajectory and gait of the walking robot based on the current motion state of the walking robot.

[0022] As described above, the method for controlling a walking robot provided by the embodiments of the present application relates to technologies such as artificial intelligence and machine learning, and the method for controlling a walking robot provided by the embodiments of the present application will be described below in conjunction with the drawings.

[0023] FIG. 1 is a schematic diagram of a walking robot provided in an embodiment of the present application.

[0024] As shown in Fig. 1, a walking robot (referred to as an exemplary walking robot) provided in the embodiment of the present application will be described using a four-legged walking robot as an example. Image 1-1 in Fig. 1 shows an internal perspective view of the walking robot, and image 1-2 shows an external structural view of the walking robot.

[0025] In an embodiment of the present application, the exemplary walking robot can move based on four mechanical legs, where each mechanical leg may include an upper leg and a lower leg, and each mechanical leg may include at least one joint. For example, each mechanical leg may include multiple lower leg joints, which may be, for example, hip joints with two degrees of freedom and knee joints with one degree of freedom.

[0026] In an embodiment of the present application, multiple motors may further be arranged on each mechanical leg, and the multiple motors can be used to control two degrees of freedom of the hip joints and one degree of freedom of the knee joints of a quadruped robot, respectively, or in combination.

[0027] It is necessary to explain that various sensors, such as an Inertial Measurement Unit (IMU) sensor and a joint angle encoder, may be further arranged in the walking robot, where the IMU sensor can provide acceleration and posture information of the walking robot in real time, and the joint angle encoder can provide joint angle information (e.g., joint angle angle, angular velocity feedback value, etc.) of each joint of the walking robot in real time.

[0028] In the embodiment of the present application, the exemplary walking robot can realize movements such as somersaults or bounds under the control of the above-mentioned multiple motors, and can fall onto a flat surface in the form of free landing when the execution of these movements is completed. In order to ease the degree of stiffness of the movement of the walking robot during the landing process of the walking robot, reduce the impact force received by each joint and the rebound force on the body, and reduce the probability of damage caused by the landing of the walking robot, the walking robot is often controlled during the free landing process of the walking robot and the process of the walking robot contacting a flat surface.

[0029] In order to control the free fall process of a walking robot, for example, if the process of each foot end of a quadruped walking robot contacting a flat surface is equivalent to the action process of two virtual springs in the x-axis and z-axis (vertical direction perpendicular to the plane) directions, if a control scheme (e.g., a PD control scheme) is used to adjust the stiffness and damping parameters of the virtual springs, the output torque of each joint motor can be derived as equivalent, so that the walking robot can land skillfully. Also, for example, the mechanical legs and the environment can be equivalent to two different models (e.g., an RLC model), and based on these two models, data-driven (a kind of machine learning control scheme) can be used to derive the output torque of each joint motor, so that the walking robot can land skillfully.

[0030] However, the above schemes for controlling the free fall of a walking robot all create a spring damping model in the mechanical leg model of the walking robot or the environment model, and the dynamic constraints and characteristics of the walking robot are embodied by the mechanical legs and the change in the center of gravity, so the above schemes for controlling the free fall of a walking robot have deviations from the dynamic constraints and characteristics of the walking robot, which affects the control effect.

[0031] Therefore, to address the above-mentioned problems, an embodiment of the present application provides a method for controlling a walking robot, the walking robot including a base and at least two mechanical legs, each of the mechanical legs including at least one joint, the method including the steps of: determining a first expected trajectory corresponding to the walking robot and determining a second expected trajectory corresponding to the walking robot in response to the walking robot dropping until the walking robot touches a flat surface, where the first expected trajectory indicates an expected trajectory of a center of gravity of the walking robot, and the second expected trajectory indicates an expected trajectory of foot ends of the at least two mechanical legs; and controlling a movement of each of the joints after the walking robot touches the flat surface based on a dynamics model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory.

[0032] An embodiment of the present application further provides an apparatus for controlling a walking robot, the walking robot including a base and at least two mechanical legs, each mechanical leg including at least one joint, the apparatus including a planning calculation module configured to determine a first expected trajectory corresponding to the walking robot in response to the walking robot dropping until it contacts a flat surface, and to determine a second expected trajectory corresponding to the walking robot, where the first expected trajectory indicates an expected trajectory of a center of gravity of the walking robot, and the second expected trajectory indicates an expected trajectory of a foot end of the at least two mechanical legs; and a control module configured to control movement of each of the joints after the walking robot contacts the plane based on a dynamics model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory.

[0033] An embodiment of the present application further provides a walking robot, comprising: a base; a lower limb unit connected to the base, the lower limb unit including at least two mechanical legs, where each of the mechanical legs includes a hip joint and a knee joint, the hip joint including at least two degrees of freedom, and the knee joint including at least one degree of freedom; and electronic equipment, the electronic equipment being installed on the walking robot, and the electronic equipment being used to execute the method for controlling a walking robot provided by the embodiment of the present application.

[0034] An embodiment of the present application provides a computer-readable storage medium having a computer-executable program stored therein, the computer-executable program, when executed by a processor, causing the processor to perform a method for controlling a walking robot provided by an embodiment of the present application.

[0035] An embodiment of the present application provides a computer program product, which includes a computer executable program, which, when executed by a processor, implements the method of controlling a walking robot provided by the embodiment of the present application.

[0036] The method for controlling a walking robot provided in the embodiments of the present application can not only automatically realize the planning of trajectory and gait for the walking robot, but also ensure that the impact force received by each joint and the rebound force on the body are reduced during the landing process of the walking robot, thereby ensuring the landing function and providing an impact-resistant protective effect for the walking robot at the same time.

[0037] It should be noted that the method for controlling a walking robot provided in the embodiments of the present application described below is performed by an electronic device used to control the walking robot, and the electronic device may be integrated on the walking robot or may be independent from the walking robot, and the embodiments of the present application are not limited thereto.

[0038] Fig. 2 shows a flowchart of a method for controlling a walking robot provided by an embodiment of the present application. The control method for controlling a walking robot provided by an embodiment of the present application may include steps S201 and S202 shown in Fig. 2. As described above, the walking robot includes a base and at least two mechanical legs, and each mechanical leg includes at least one joint.

[0039] In step S201, in response to the walking robot falling until it contacts a plane, a first expected trajectory corresponding to the walking robot is determined, and a second expected trajectory corresponding to the walking robot is determined.

[0040] It is necessary to explain that the first expected trajectory indicates the expected trajectory of the center of gravity of the walking robot, and the second expected trajectory indicates the expected trajectory of the separated foot ends of at least two mechanical legs.

[0041] As an example, step S201 may be performed by any electronic device. The electronic device here may be a terminal or a server, or the electronic device here may be jointly performed by a terminal and a server, and is not limited thereto. Here, the terminal may be a smartphone, a computer (e.g., a tablet PC, a laptop, and a desk computer, etc.), a smart wearable device (e.g., a smart watch and a smart glass), a smart voice dialogue device, a smart home appliance (e.g., a smart TV), an in-vehicle terminal, or an aircraft, etc., and the server may be an independent physical server, a server cluster or a distributed system consisting of multiple physical servers, and may further be a cloud server providing basic cloud computing services such as cloud services, cloud databases, cloud computing, cloud functions, cloud storage, network services, cloud communications, middleware services, domain name services, security services, content delivery networks (CDNs), and big data and artificial intelligence platforms.

[0042] In the embodiment of the present application, the terminal and the server may be located within or outside the blockchain network, and are not limited thereto. In the embodiment of the present application, the terminal and the server may further upload and store any one of the data stored therein to the blockchain network, thereby preventing the data stored therein from being tampered with and improving the security of the data.

[0043] For example, in the process of the walking robot falling, the contact situation between at least two mechanical legs of the walking robot and a plane (e.g., the ground, the surface of a table, etc.) may change, so that the walking robot may include a plurality of motion forms in the process of contacting the plane, for example, from a form in which all mechanical legs are separated from the plane, to a form in which some mechanical legs are in contact with the plane, and further, a form in which all mechanical legs are in contact with the plane. Since the initial speed of the falling of the walking robot is different, it is necessary to determine the contact information of the walking robot contacting the plane, and to determine the first expected trajectory and the second expected trajectory based on the posture and state information of the walking robot at the time of contact. Hereafter, the process of determining the contact information of the walking robot contacting the plane will be described in conjunction with FIG. 3, but the embodiments of the present application will not be described repeatedly here.

[0044] As described above, the first expected trajectory indicates the expected trajectory of the center of gravity of the walking robot. For example, the first expected trajectory may include position information, velocity information, acceleration information, etc., expected at each time step of the center of gravity of the walking robot. The first expected trajectory may be represented by a timing numerical sequence consisting of related information of the center of gravity corresponding to each time step. Of course, the first expected trajectory may also be represented by other data structures, and the present application is not limited thereto. The process of determining the first expected trajectory will be described later in conjunction with FIG. 4, but will not be repeated here.

[0045] One end of the mechanical leg that is far from the base is called the foot end, and the second expected trajectory indicates the expected trajectory of the foot end of each of the at least two mechanical legs. For example, the second expected trajectory may include position information, velocity information, acceleration information, angular velocity information, angular acceleration information, etc. expected at each time step of the foot end of each mechanical leg. Also, for example, the second expected trajectory may further include position information, velocity information, acceleration information, angular velocity information, angular acceleration information, etc. expected at each time step of each joint of each mechanical leg. Similarly, the second expected trajectory can be represented by a timing sequence consisting of related information of each mechanical leg corresponding to each time step. Of course, the second expected trajectory may also be represented by other data structures, and the present application is not limited thereto. Later, the process of determining the second expected trajectory will be described in conjunction with Figs. 5 to 6, but the present application will not repeat the description here.

[0046] Here, one time step may be referred to as one frame. The time difference between adjacent time steps may be the same or different. For example, within a certain time immediately after the walking robot contacts a flat surface, the movement of the walking robot and the change in the force received are greater than a change threshold, so the difference between the time steps may be smaller than the time length threshold, thereby improving the flexibility of the movement control of the walking robot in the initial stage. In the process in which the walking robot gradually reaches a stable state, the difference between the time steps may be greater than the time length threshold, thereby saving computation power. The embodiment of the present application does not limit the time difference between adjacent time steps.

[0047] In step S202, the movement of each joint after the walking robot comes into contact with the flat surface is controlled based on the dynamics model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory.

[0048] It is necessary to explain that the dynamics model is used to determine the change relationship of the motion information of each joint (e.g., including angle, angular velocity, angular acceleration, and joint torque), the motion information of the center of gravity (e.g., including angle, angular velocity, and angular acceleration), and the external contact force. That is, the dynamics model corresponding to a walking robot is used to indicate the change relationship of the information of the angle, angular velocity, angular acceleration, joint torque, and external contact force corresponding to each joint and the center of gravity respectively during the motion process of the walking robot. For example, the dynamics model can describe the change relationship from the perspective of energy change. For example, the dynamics model can further describe the change relationship from the perspective of momentum change or received force change. The present application is not limited thereto.

[0049] In the process from the moment the walking robot falls until it contacts the plane to the moment the walking robot stably stands on the plane, the acting forces received by the walking robot include gravity, the driving force of each joint motor, and the contact force (also called support force) provided to the walking robot by the plane. Based on the three forces of gravity, driving force, and contact force, as well as basic information of the walking robot such as the size, mass, moment of inertia, and joint connection method of each part of the body of the walking robot, a dynamics model corresponding to the walking robot can be correspondingly created. The contact force and driving force received by the walking robot in different postures are different. Based on the dynamics model corresponding to the walking robot, the contact force between the plane and the walking robot at each time step is determined, thereby making the actual trajectory of the center of gravity of the walking robot coincide with the first expected trajectory.

[0050] In an embodiment of the present application, based on a dynamics model corresponding to the walking robot and a contact force between the plane and the walking robot at each time step, a motor torque provided by each joint motor at each time step can be further determined, thereby making the trajectories of the foot ends of the at least two mechanical legs coincide with the second expected trajectory.

[0051] That is, the contact force between the plane and the walking robot is determined based on the dynamics model, the first expected trajectory, and the second expected trajectory, and the motor torque provided by each joint motor is determined, and the movement of each joint is controlled based on the determined contact force and motor torque.

[0052] It is necessary to explain that "match" in the embodiments of the present application refers to the fact that, when the real machine is actually tested, the actual trajectory of the center of gravity of the walking robot is very close to the first expected trajectory (the trajectory deviation is smaller than the trajectory deviation threshold) and is therefore the same, or the trajectories of the feet ends of at least two mechanical legs that are apart from each other are very close to the second expected trajectory and are therefore the same. Due to the limitations of the performance of the joint motors, the joint motors are often unable to output ideal torque. At the same time, considering the changes in the external environment (for example, other disturbances such as wind suddenly occur), it is often difficult to control the walking robot to completely match the first expected trajectory and the second expected trajectory. Therefore, the match described in the embodiments of the present application may refer to the difference between the actual trajectory and the expected trajectory being smaller than the difference threshold.

[0053] In some embodiments of the present application, based on a dynamics model corresponding to the walking robot, contact forces required for the center of gravity of the walking robot to reach the position, velocity, and acceleration specified by the first expected trajectory at each time step can be calculated. The contact forces are support forces that the plane provides to the foot ends of each mechanical leg. Also, based on the dynamics model corresponding to the walking robot and the contact forces, joint control information required for the mechanical legs of the walking robot to reach the posture specified by the second expected trajectory at each time step can be calculated and obtained.

[0054] In the embodiment of the present application, the joint control information may be the acceleration of each joint motor or the torque of the joint motor. In a real physical system, there is a difference in the accuracy of the measurement of the acceleration and torque of the joint motor. Therefore, in a real application, a person skilled in the art can select a physical quantity with a higher accuracy from the acceleration and torque of the joint motor according to the actual situation for subsequent calculation.

[0055] FIG. 3 is a schematic diagram showing the moment when a walking robot 3-1 according to an embodiment of the present invention comes into contact with a flat surface 3-2.

[0056] As described above, cushioning the landing of the walking robot can be achieved through determining the contact state between at least two mechanical legs and a plane at a current time. The so-called current time refers to the latest system time reached over time in the landing process of the walking robot. For example, the contact state between at least two mechanical legs and a plane at a current time includes information such as whether at least two mechanical legs of the walking robot contact the plane, the number of contact points between the at least two mechanical legs and the plane, and the position of each contact point, thereby determining the first expected trajectory and the second expected trajectory of the walking robot.

[0057] In some embodiments of the present application, the contact state is determined by current state information corresponding to the walking robot at the current time.

[0058] In an embodiment of the present application, an IMU sensor in the walking robot can be called to determine current state information of the walking robot. For example, first, the IMU sensor can collect acceleration information (which may include accelerations in multiple directions (e.g., vertical and horizontal) of the walking robot) and current posture information of the walking robot at the current time, and a joint angle encoder can be called to determine joint angle information (e.g., joint angle angle, angular velocity feedback value, etc.) of each joint of the walking robot at the current time. Next, the current posture information and joint angle information (e.g., joint angle angle, angular velocity feedback value) can be written into leg odometry to calculate position information (which can be expressed by adopting y1), and the position information may include the calculated positions of at least two mechanical legs of the walking robot at the current time. In addition, the acceleration information can be input to a state space observer, which can output a position observation result (which can be expressed by adopting ym) based on the acceleration information and a state estimation result of the walking robot at the current time obtained from the history. The position observation result may include the observed positions of at least two mechanical legs of the walking robot at the current time. Here, the state estimation result of the walking robot at the current time may be obtained by estimating the state of the walking robot at the current time when a time before the current time is reached, and the state estimation result of the walking robot at the current time may be stored in a vector or other data structure, but is not limited thereto. Then, based on the position information and the position observation result, the state of the walking robot at the time next to the current time can be estimated.

[0059] For example, the position information and the position observation result can further be input to an Extended Kalman Filter (EKF) unit, which performs state estimation to obtain the state estimation result of the walking robot at the next time. The so-called Extended Kalman Filter is a kind of extended form in the nonlinear case of the standard Kalman Filter (abbreviated as Kalman Filter), and realizes linearization of the nonlinear function by performing Taylor expansion on the nonlinear function, omitting higher-order terms, and leaving the first-order terms of the expansion terms.

[0060] In the embodiment of the present application, the position information and the position observation result can be input to a Kalman filter unit or an input to a state estimation model obtained based on machine learning, so that the state can be estimated by the Kalman filter unit or the state estimation model to obtain a state estimation result of the walking robot at the next time. Here, the state estimation result of the walking robot at the next time can be simultaneously used for controlling the walking robot and as an input to the state space observer for the next state estimation, that is, the estimation result obtained by the state estimation can be used for feedback control of the walking robot, thereby forming a closed loop.

[0061] Below, several embodiments are described that determine contact information based on the current state information of a walking robot.

[0062] When the contact information between any machine leg and a plane changes, any one of the state values ​​corresponding to the machine leg may change suddenly, so the contact information between the machine leg and the plane at the current time can be determined by the current state value of the machine leg. Therefore, in the embodiment of the present application, the manner of determining the contact information based on the current state information includes: obtaining the history state value of any one of the machine legs at a time before the current time, and determining the current state value of any one of the machine legs from the current state information, so that it can be determined whether there is a sudden change in the current state value of any one of the machine legs based on the history state value.

[0063] In the embodiment of the present application, the presence of a sudden change in the current state value refers to the difference between the current state value and the history state value being greater than a preset difference value. Based on this, the difference between the history state value and any one of the current state values ​​can be calculated. If the calculated difference value is greater than the preset difference value, it is determined that there is a sudden change in the current state value, and if the calculated difference value is equal to or less than the preset difference value, it is determined that there is no sudden change in the current state value. For example, assuming that the history state value is 20 and the preset difference value is 50, if the current state value is 100, the result of subtracting 20 from 100 is 80, which is greater than 50, so it can be determined that there is a sudden change in the current state value. If the current state value is 30, the result of subtracting 20 from 30 is 10, which is less than 50, so it can be determined that there is no sudden change in the current state value.

[0064] If it is determined based on the historical state values ​​that there is a sudden change in the current state value of any one of the machine legs, and if the current state value of the machine leg is greater than the historical state value, it is determined that the machine leg contacts the plane at the current time. If it is determined based on the historical state values ​​that there is no sudden change in the current state value of any one of the machine legs, the contact information between the machine leg and the plane at the previous time is taken as the contact information at the current time. That is, if any one of the machine legs is in contact with the plane at the previous time, it is determined that the machine leg is also in contact with the plane at the current time, and if any one of the machine legs is not in contact with the plane at the previous time, it is determined that the machine leg is not in contact with the plane at the current time.

[0065] In some embodiments of the present application, the current status information may include joint motor torques, current values, or voltage values ​​of the at least two mechanical legs.

[0066] It is necessary to explain that when the mechanical leg of the walking robot is suspended in the air without contacting a flat surface (e.g., not touching the ground), the load of the mechanical leg is only the mass of the mechanical leg, and the mass of the mechanical leg of the walking robot can be ignored compared to the total mass, so the load is smaller than the load threshold, and the feedback current value and the joint motor torque of each joint are relatively smaller than the corresponding threshold. When the mechanical leg of the walking robot contacts a flat surface (e.g., touches the ground), the load of the walking robot includes, in addition to its entire mass, an equivalent inertial force moving downward under the action of its own inertia, so the load is larger than the load threshold, and the feedback current value and the joint motor torque of each joint are relatively larger than the corresponding threshold. Based on this, when it is detected that the joint motor torque or the feedback current value suddenly increases from a small value (the change amount is larger than the change amount threshold within a threshold time length), it is determined that the walking robot has landed on a flat surface (e.g., the ground) from the air.

[0067] In some embodiments of the present application, the current state information includes the height of the center of gravity of the walking robot, the orientation of the center of gravity, and current joint angle information corresponding to at least two mechanical legs.

[0068] In an embodiment of the present application, based on the height of the center of gravity of the walking robot, the posture of the center of gravity, and each joint angle information of the walking robot detected by an external vision or motion capture system, the time when the end of the foot of the walking robot will contact a plane is calculated, and it is thereby possible to determine whether the corresponding leg will contact a plane at the current time.

[0069] Here, the method of detecting contact information between the mechanical leg and a plane at the current time based on the current state information includes: calculating the height of any one of the mechanical legs from the plane based on the height of the center of gravity, the attitude of the center of gravity, and current joint angle information corresponding to any one of the mechanical legs; determining that any one of the mechanical legs is in contact with the plane at the current time if the calculated height is less than a height threshold (e.g., a numerical value of 0, or 0.005, etc.); and determining that any one of the mechanical legs is not in contact with the plane at the current time if the calculated height is greater than the height threshold.

[0070] In some embodiments of the present application, the current status information may include current plantar tactile feedback values ​​corresponding to at least two mechanical legs, the plantar tactile feedback values ​​being generated by plantar tactile sensors of the corresponding mechanical legs.

[0071] In the embodiment of the present application, the sole tactile sensor can determine whether the corresponding mechanical leg contacts a plane at the current time. In addition, when any one of the sole tactile sensors detects that the corresponding mechanical leg contacts the plane, it generates a first value as the sole tactile feedback value, and when it detects that the corresponding leg does not contact the plane, it generates a second value as the sole tactile feedback value. Here, the first value and the second value can be set according to actual needs, for example, the first value is 1 and the second value is 0, or the first value is 0 and the second value is 1, etc. Here, the method of detecting contact information between the mechanical legs and a plane at the current time based on the current status information includes: obtaining a current plantar tactile feedback value corresponding to the mechanical legs from the current status information; determining that any one of the mechanical legs is in contact with the plane at the current time if the obtained current plantar tactile feedback value is a first numerical value; and determining that any one of the mechanical legs is not in contact with the plane at the current time if the obtained current plantar tactile feedback value is a second numerical value.

[0072] In some embodiments of the present application, the current state information includes a current acceleration of the walking robot in a vertical direction, a historical acceleration of the walking robot in a vertical direction at a time prior to the current time is known, and if it is determined that an abrupt change occurs in the current acceleration based on the historical acceleration, it is determined that the walking robot has landed.

[0073] It is necessary to explain that when the walking robot stands stably on a flat surface, the acceleration in the z-axis direction of the walking robot collected by the IMU sensor is 1 times the acceleration of gravity g, when the walking robot is in a completely weightless state in the air, the acceleration in the z-axis direction of the walking robot collected by the IMU sensor is close to 0, and when the walking robot is on a flat surface and its feet step hard on the surface to fly, and when it cushions itself against the surface after landing, the acceleration in the z-axis direction of the walking robot collected by the IMU sensor is both greater than 1 times the acceleration of gravity g. As is clear from this, at the moment the walking robot lands, a sudden change occurs in the vertical acceleration of the walking robot.

[0074] In the embodiment of the present application, the existence of a sudden change in the current acceleration refers to the difference value between the current acceleration and the historical acceleration being greater than the difference value threshold, and based on this, the electronic device can calculate the difference value between the historical acceleration and the current acceleration. If the calculated difference value is greater than the difference value threshold, it is determined that a sudden change occurs in the current acceleration, and if the calculated difference value is equal to or less than the difference value threshold, it is determined that a sudden change does not occur in the current acceleration. For example, assuming that the historical acceleration is 2 and the difference value threshold is 5, if the current acceleration is 9, the result of subtracting 2 from 9 is 7, which is greater than 5, so it can be determined that a sudden change occurs in the current acceleration, and if the current acceleration is 4, the result of subtracting 2 from 4 is 2, which is less than 5, so it can be determined that a sudden change does not occur in the current acceleration.

[0075] It should be understood that the above describes some exemplary implementations of determining contact information of the machine legs, but does not provide all examples, and the embodiments of the present application are not limited thereto.

[0076] Next, the process of determining the first expected trajectory of the walking robot will be described with reference to Fig. 4. Fig. 4 shows a diagram of changes in the height of the center of gravity during the landing process of the walking robot of the embodiment of the present application.

[0077] In Fig. 4, two curves are shown, where the solid line 4-1 is a schematic curve showing the change in the position height of the center of gravity of the walking robot during the landing process with time steps, the x-axis is the time steps, the y-axis is the height (in centimeters), and the dashed line 4-2 is the height of the center of gravity of the walking robot in a stationary state. The solid line 4-1 shows a schematic change in the component of the first expected trajectory in the z-axis direction. As shown by the solid line 4-1, after the walking robot touches the ground, the height of the center of gravity of the walking robot gradually decreases and then gradually increases.

[0078] As shown in Fig. 4, the walking robot first falls with a relatively large acceleration (greater than the acceleration threshold) until one mechanical leg contacts the plane. At this time, the mechanical leg that contacts the plane withstands the acting force from the plane, and the descent speed of the center of gravity gradually decreases. As the four mechanical legs contact the plane in turn, the four mechanical legs all withstand the acting force from the plane on the walking robot and constantly maintain contact with the plane until the center of gravity of the walking robot reaches a desired rest height.

[0079] Based on this, in order to realize the cushioning effect during the landing process of the walking robot and reduce the rebound force on the body of the walking robot, an optimization goal can be set based on the relationship between the solid line 4-1 and the dashed line 4-2 in Fig. 4, so that the expected trajectory can realize the desired cushioning effect as much as possible. For example, the optimization goal may be to reduce the overshoot, to reduce the integral of the vertical height with time to a relatively small value, to have the minimum height higher than the safe height threshold, to have the change value of the force be smaller than the change value threshold, and to have the change speed of the vertical height satisfy a predetermined constraint, etc.

[0080] In some embodiments of the present application, an approximation model corresponding to a walking robot can be used to determine the expected trajectory of the center of gravity of the walking robot. In the approximation model, the walking robot is approximated to a single rigid body, and in the process of the walking robot contacting a flat surface, the resultant force of at least two mechanical legs forms an upward thrust against the single rigid body. Further, the support force of the walking robot is determined based on the upward thrust against the single rigid body.

[0081] For example, a walking robot can be approximated as one single rigid body with mass m. In a situation where the walking robot includes four mechanical legs, the resultant forces of the four mechanical legs form an upward thrust u on the single rigid body. Based on such an approximate model, and further in conjunction with Newton's second law, equation (1) (called the dynamics equation) can be determined.

[0082]

number

[0083] Here, vertically upward is the positive direction, g is the gravity coefficient and has a value equal to -9.81 (the negative sign indicates that the direction of gravity is vertically downward), and [Equation 2] indicates the acceleration in the vertical direction.

[0084]

number

[0085] The dynamic equations are written in the form of State Space Representation, i.e., Equation (2) shown below.

[0086]

number

[0087] Equation (2) can be abbreviated to the form of equation (3): In the examples of this application, boldface is used to represent vectors (matrices).

[0088]

number

[0089] where, [Equation 5]. Correspondingly, equation (3) can be discretized according to the time step (the length of the time step is Δt) to obtain equation (4).

[0090]

number

[0091]

number

[0092] A d =A c Δt+I, B d =B c Let Δt be the time t. This is based on Model Predictive Control (MPC). Equation (5) can be obtained from equation (4).

[0093]

number

[0094] Here, x1 represents a vector consisting of the vertical height of the center of gravity, the vertical velocity of the center of gravity, and the acceleration of gravity corresponding to the first time step, and x2 represents a vector consisting of the vertical height of the center of gravity, the vertical velocity of the center of gravity, and the acceleration of gravity corresponding to the second time step. k represents a vector consisting of the vertical height of the center of gravity, the vertical velocity of the center of gravity, and the acceleration due to gravity, corresponding to the k-th time step. Here, x0 represents a vector consisting of the vertical height of the center of gravity, the vertical velocity of the center of gravity, and the acceleration due to gravity, corresponding to the initial time. Equation (5) can also be abbreviated to equation (6).

[0095]

number

[0096]

number

[0097] Equation (6) describes the mathematical formula corresponding to each time step. Based on this, the optimization goal corresponding to the embodiment of the present application can be designed based on the corresponding expected buffer effect during the fall of the walking robot, thereby realizing the acquisition of the optimal first expected trajectory. For example, the first expected trajectory makes the combined value of the fluctuation amount of the center of gravity of the walking robot, the total amount of impact force received by the walking robot, the squatting amount of the walking robot, and the sudden change amount of the impact force received by the walking robot reach an extreme value. Each of the above has a corresponding weighting coefficient and can be combined in various ways.

[0098] For example, the optimal thrust U can be obtained by setting the optimization goal-Z function shown in equation (7).

[0099]

number

[0100] Where X ref is a constant vector and represents the rest height shown by the dashed line in Figure 4. [Equation 11] represents the minimum height of the center of gravity during the entire process.

[0101]

number

[0102] Here, the first term of the Z function [Equation 12] can be a kind of expression form of the amount of fluctuation of the center of gravity of the walking robot, that is, the value after weighting the dynamics equation that the walking robot should satisfy (weighting coefficient is L). For example, in Fig. 4, the first term is shown as the value after weighting the area of ​​the gray region. The smaller [Equation 13] is, the smaller the fluctuation of the center of gravity is during the process of the walking robot falling, which means that the walking robot is more stable.

[0103]

number

number

[0104] The second term of the Z function [Equation 14] can be used as a form of expression for the total amount of impact force received by the walking robot, that is, it is the weighted value (weighting coefficient is K) of the integral over time of the sum of the planar reaction forces received by the walking robot. The smaller [Equation 15] is, the smaller the total impact force received by the walking robot during the process of falling is.

[0105]

number

number

[0106] The third term of the Z function [Equation 16] represents the value after weighting the distance between the lowest point of the center of gravity of the walking robot and the rest height during the entire falling process (the weighting coefficient is Q). The smaller [Equation 17] is, the lower the degree of crouching of the walking robot during the falling process (i.e., the walking robot does not need to crouch extremely low (less than the threshold of the crouching posture) and can maintain balance). The third term of the Z function [Equation 18] can be used as a kind of expression form of the amount of crouching of the walking robot.

[0107]

number

number

number

[0108] The fourth term of the Z function [Equation 19] represents the weighted value (weighting coefficient W) of the difference in the reaction force that the plane provides to the walking robot between adjacent time steps. The smaller [Equation 20] is, the smaller the sudden change in the impact force received by the walking robot as it falls. The fourth term of the Z function [Equation 21] can be used as a kind of expression of the sudden change in the impact force received by the walking robot.

[0109]

number

number

number

[0110] The above is merely a type of combination method of the Z function, and each of the above Z functions is merely an exemplary form representing the amount of change in the center of gravity of the walking robot, the total amount of impact force received by the walking robot, the amount of crouching of the walking robot, and the sudden change in the impact force received by the walking robot, and the embodiments of the present application are not limited thereto.

[0111] In the embodiment of the present application, the importance of each of the weighting coefficients is adjusted according to each of the weighting coefficients. For example, the larger K is, the greater the importance of the impact force received by the walking robot in the method of controlling a walking robot provided by the embodiment of the present application.

[0112] In the embodiment of the present application, the weighting scheme includes multiple types. For example, the weighting scheme may be a multiplication weighting scheme, in which case the first term of the Z function can be expressed as [Number 22]. The weighting scheme may also be a power weighting scheme or an addition scheme, and the embodiment of the present application is not limited thereto. By analogy therewith, each of the remaining Z functions can also be calculated with a different weighting scheme, and the embodiment of the present application will not be described repeatedly here.

[0113]

number

[0114] In the process of calculating the Z function, the following constraints must also be taken into account:

[0115] For example, the first constraint is u0≦u U Here, u0 represents the impact force (called instantaneous impact force) that the walking robot receives at the first moment (called instantaneous time) when it comes into contact with the plane, and this impact force is the maximum impact force u that the walking robot can withstand. U Smaller. The maximum impact force that a walking robot can withstand is u U is determined by the structural characteristics of the walking robot and the strength of the rigid body, and an exemplary value is 200 N. The present application is not limited to the exemplary value.

[0116] For example, the second constraint is F L ≦u≦F U F L represents the lower limit of the support capacity that the plane can provide, and F U represents the upper limit of the support capacity that the plane can provide. F L is usually 0, and the support force cannot be made smaller than 0.

[0117] For example, the third constraint is [Equation 23]. The third constraint dictates that the height of the center of gravity of the walking robot in the z-axis direction at each time is always higher than the minimum height [Equation 24], where [Equation 24] is a column vector consisting of sequence values ​​of the minimum height.

[0118]

number

number

[0119] In addition, based on different configurations of the walking robot, more or less constraints (to the above first constraint, second constraint, and third constraint) may be further included, and the embodiments of the present application are not limited thereto.

[0120] By mathematically converting equation (7) into an equivalent equation, we can obtain equation (8).

[0121]

number

[0122] By mathematically converting equation (8) into an equivalent equation, we can obtain equation (9).

[0123]

number

[0124] By mathematically converting equation (9) into an equivalent equation, we can obtain equation (10).

[0125]

number

[0126] By mathematically converting equation (10) into an equivalent equation, equation (11) can be obtained.

[0127]

number

[0128] Here, W satisfies equation (12).

[0129]

number

[0130] Here, the variable U is not included in [Equation 30], and therefore the minimum value of the Z function is not affected, and therefore it is not necessary to calculate [Equation 31].

[0131]

number

number

[0132] That is, [Mathematical formula 32] can finally be expressed as equation (13).

[0133]

number

[0134]

number

[0135] Here, [Number 34].

[0136]

number

[0137] Based on the obtained U that minimizes Z and [Equation 35], the optimal first expected trajectory in Fig. 4, i.e., the numerical sequence of the center of gravity in the z-axis direction corresponding to each time step, can be obtained. In some embodiments of the present application, the first expected trajectory of the walking robot can be further planned using a full model of the walking robot, thus improving the accuracy of the first expected trajectory, but it often requires a relatively high computing power to realize real-time planning.

[0138]

number

[0139] In the embodiment of the present application, the movement trajectory of the center of gravity of the walking robot after landing is planned based on an approximation model (or a full model), thereby reducing the impact force received by each joint and the rebound force on the body during the landing process of the walking robot, thereby ensuring the landing function while providing good impact resistance protection for the walking robot.

[0140] Next, the process of determining the second expected trajectory of the walking robot will be described with reference to Figures 5 and 6. Figure 5 shows a schematic diagram of the mechanical leg of the walking robot in the landing process of the embodiment of the present application contacting a flat surface. Figure 6 shows a schematic diagram of the calculation principle of the cubic spline difference value provided in the embodiment of the present application.

[0141] As shown in FIG. 5, the four mechanical legs of the walking robot do not land at the same time, but have a sequence of front and back. After the first mechanical leg contacts the ground, it is necessary to ensure that the contact position between the first mechanical leg and the ground is maintained unchanged throughout the entire landing process. The remaining mechanical legs contact the plane in turn, and always maintain contact with the plane after contact until the center of gravity of the walking robot reaches a desired rest height. Thus, in some embodiments of the present application, at the instant when one mechanical leg lands, a contact position where one end of one mechanical leg away from the base contacts the plane is determined, and the contact position is set as an expected trajectory corresponding to the one mechanical leg, and can be maintained unchanged at each time. Based on the first expected trajectory, the motion trajectory of the foot end of the remaining mechanical leg is determined, and the motion trajectory is set as an expected trajectory corresponding to the remaining mechanical leg. Finally, the expected trajectory corresponding to the one further mechanical leg and the expected trajectory corresponding to the remaining mechanical leg are determined as second expected trajectories corresponding to the walking robot. Here, one machine leg refers to the first machine leg that comes into contact with the ground.

[0142] For example, the step of determining the motion trajectories of the detached foot ends of the remaining mechanical legs based on the first expected trajectory includes the steps of: determining, at an instantaneous time when one mechanical leg lands (contacts a plane), an initial position of the foot end of the remaining mechanical leg based on a position corresponding to the instantaneous time in the first expected trajectory; determining, based on the first expected trajectory, a position coordinate of the corresponding foot end of the remaining mechanical leg corresponding to a stable time, where, at the stable time, the attitude of the center of gravity of the walking robot is restored to be parallel to the plane, the four mechanical legs are in complete contact with the plane, and the leg lengths of the four mechanical legs are equal; and interpolating values ​​(e.g., interpolating using a cubic spline difference value) based on the initial position of the foot end corresponding to the instantaneous time and the position coordinate of the corresponding foot end of the remaining mechanical legs corresponding to the stable time, thereby determining the motion trajectory of the detached foot end of the remaining mechanical leg.

[0143] In the embodiment of the present application, at the instant when one mechanical leg lands, the position coordinates of the foot ends of the remaining mechanical legs can be calculated in correspondence with the position of the center of gravity and the posture of the walking robot, and the position coordinates of the foot ends can be set as the initial positions of the foot ends at the instant when the mechanical leg lands. The calculation process of the position coordinates of the corresponding foot ends at the instant when the remaining mechanical legs become stable is similar, and the embodiment of the present application will not be described repeatedly here.

[0144] For example, as shown in posture 5-1 of the walking robot in Figure 5, at the instant when one mechanical leg lands, the position coordinates of the foot ends of the other three mechanical legs can be calculated in correspondence with each other based on the position of the center of gravity and posture of the walking robot, and the position coordinates of the foot ends can be set as the initial positions of the foot ends at the time of landing.

[0145] In an embodiment of the present application, the electronic device can input sensor information of the walking robot collected at the current time to the leg odometry, so that the leg odometry can calculate the positions of at least two mechanical legs of the walking robot at the current time based on the sensor information and obtain position information.

[0146] Here, the position information of the position coordinates of the foot end may include the direction position vectors of at least the other three mechanical legs in the world coordinate system. Different direction position vectors correspond to different coordinate axis directions, and one direction position vector is used to indicate the positions of at least two mechanical legs of the walking robot in the corresponding coordinate axis directions. Here, the manner in which the leg odometry calculates the direction position vector corresponding to the horizontal axis direction includes the following. First, a rotation matrix can be calculated based on the current posture information. The so-called rotation matrix refers to a matrix that realizes mapping of any one vector to the robot base coordinate system by changing the direction of the vector. Here, the base posture angle of the walking robot can be determined based on the current posture information, and the rotation matrix can be calculated based on the base posture angle. In addition, a reference position vector can be calculated based on the joint angle information of each joint, and the reference position vector is used to indicate the relative position between the center of gravity of the base of the walking robot and the foot end of each mechanical leg. Then, the rotation matrix can be employed to map the reference position vector into the robot base coordinate system to obtain the target position vector, where the rotation matrix can be multiplied by the reference position vector to obtain the target position vector.

[0147] Also, first, a three-dimensional position vector of the center of gravity of the walking robot in the world coordinate system can be obtained. Then, the component of the target position vector in the horizontal axis direction and the component of the three-dimensional position vector in the horizontal axis direction are merged to obtain a direction position vector corresponding to the horizontal axis direction. The merging process here may include an addition process.

[0148] It is necessary to explain that the method of calculating the direction position vector corresponding to the other coordinate axis direction (e.g., vertical axis and longitudinal axis) by the leg odometry is similar to the method of calculating the direction position vector corresponding to the horizontal axis direction, and will not be described repeatedly here. In addition, the position information may further include other vectors such as a foot end position vector or a foot end velocity vector in a robot base coordinate system in addition to including at least two direction position vectors in the world coordinate system. Here, the foot end position vector is used to indicate the three-dimensional position of the foot end of at least two mechanical legs of the walking robot in the robot base coordinate system, and the method of calculating the foot end position vector by the leg odometry may include performing an inverse process on the target position vector to obtain the foot end position vector. The foot end velocity vector is used to indicate the three-dimensional velocity of the foot end of at least two mechanical legs of the walking robot in the robot base coordinate system, and the method of calculating the foot end velocity vector by the leg odometry may include performing a derivative calculation process on the target position vector (pf) and performing an inverse process on the derivative calculation result to obtain the foot end velocity vector.

[0149] As shown in posture 5-2 of the walking robot in Figure 5, in a situation where the absolute position of the first mechanical leg does not change, if the posture of the center of gravity of the walking robot eventually becomes parallel to the plane, the four mechanical legs are in complete contact with the plane, and the leg lengths of the four mechanical legs are restored to equal, then the position coordinates of the foot end positions of the other three mechanical legs and their contact points with the ground will be the position coordinates of the foot end at the end of the landing process.

[0150] In the process of the walking robot changing from posture 5-1 in Fig. 5 to posture 5-2 in Fig. 5, the numerical sequence of the x and y directions of the foot end positions of the other three mechanical legs is realized by cubic spline difference values ​​(Cubic Spline Interpolation) of the positions at the initial time and end time. Similarly, the numerical sequence of the x and y directions of the center of gravity of the walking robot is realized by cubic spline difference values ​​of the positions at the initial time and end time.

[0151] As shown in Fig. 6, the cubic spline difference value provided by the embodiment of the present application is to divide the known data into several segments, construct a cubic function for each segment, and ensure that the curve passes through a certain point and meets a certain speed constraint at a certain point. For example, when the known data includes three data such as (pa, va, ta), (pb, tb), and (pc, vc, tc), p represents position, v represents speed, and t represents time, and the known data is divided into two segments, the calculation principle of the cubic spline difference value can be seen in Fig. 6. First, two cubic functions of f1(t) and f2(t) can be constructed, and then an equation system can be created based on the two cubic functions and the known data, so that the coefficients (a0, a1, a2, a3, b0, b1, b2, b3) of the cubic polynomial can be obtained by the equation system. After determining the coefficients of the cubic polynomials, the two cubic functions can then be used to determine the position and corresponding velocity of the walking robot at any one time, thereby realizing control of the walking robot.

[0152] In an embodiment of the present application, a sequence of values ​​in the z direction of the other three mechanical legs can be determined in correspondence with the first expected trajectory. Here, after one mechanical leg of the walking robot contacts a plane, the length of the remaining mechanical leg changes with the change in the height of the center of gravity of the walking robot. Therefore, the sequence of values ​​in the z direction of the other three mechanical legs may be described as the height at which the foot ends of the three mechanical legs can exactly contact the ground when the center of gravity of the walking robot reaches the position indicated by the first expected trajectory in the z direction. Also, the sequence of values ​​in the z direction of the other three mechanical legs may be determined using a cubic spline difference value, and the embodiment of the present application is not limited thereto.

[0153] Next, in conjunction with Figures 7, 8A, and 8B, the process of controlling the movement of each joint after the walking robot contacts a flat surface will be described. Here, Figure 7 shows a comparison diagram between the first expected trajectory of the embodiment of the present application and the actual trajectory of the center of gravity of the walking robot. Figure 8A shows a simulation diagram of the walking robot of the embodiment of the present application before landing. Figure 8B shows a simulation diagram of the walking robot of the embodiment of the present application after landing.

[0154] A scheme for controlling a walking robot based on the dynamics equations and the first expected trajectory of the walking robot is also called Model Predictive Control (MPC). A control scheme for each joint that combines the dynamics equations and the second expected trajectory is also called Whole-Body Dynamics Control (WBC).

[0155] In the embodiment of the present application, the MPC and the WBC are used together to realize the shock absorber control during the landing process. Here, the process of realizing the shock absorber control includes optimizing the controller output (i.e., the torque of each joint motor) by calculating the trajectory of the future control variable (i.e., the first expected trajectory and the second expected trajectory). The optimization process is performed in one limited time window, and is optimized using the initial system information of the time window. Here, the start time of the time window is the moment when the walking robot contacts the flat surface, and the end time is the time when the walking robot stands stably.

[0156] As an example, the dynamics equation of a walking robot may be expressed as equation (14).

[0157]

number

[0158] The first six lines of equation (14) (shown in equation (15) below) are the mass dynamics information of the walking robot.

[0159]

number

[0160] Here, M p represents the mass and inertia matrix corresponding to the base. [Number 38] represents the six-dimensional center of gravity position and orientation vector, and is an array corresponding to the first expected trajectory. In the embodiment of the present application, the center of gravity position includes the position in the gravity direction (z direction), and the x direction, y direction, and rotation angle direction are all zero. f is the contact force that the plane provides to the four foot ends, and the contact forces that the plane provides to each foot end are all three-dimensional forces, so the total number of dimensions of f is 12. C p represents the gravity term, centrifugal force term, and Coriolis force term of the base. [Equation 39] represents the transpose of the Jacobian matrix of the base. Based on this, MPC can be applied to obtain the contact force f that the plane provides to the walking robot. That is, by determining the contact force between the plane and the walking robot at each time step based on the dynamic model corresponding to the walking robot, the actual trajectory of the center of gravity of the walking robot can be made to match the first expected trajectory.

[0161]

number

number

[0162] The lower half of equation (14) (shown in equation (16) below) is the dynamics information of the joints of the walking robot.

[0163]

number

[0164] Here, M θ represents the mass and inertia matrix corresponding to each joint, and θ represents the angle of all drivable degrees of freedom (including the degrees of freedom corresponding to the 12 joint motors in the quadruped robot shown in FIG. 1 or FIG. 5). Cθ includes the gravity term, centrifugal force term, and Coriolis force term of the drivable joint. [Equation 41] represents the transpose of the Jacobian matrix of the drivable joint. [Equation 42] represents the acceleration of the 12 actively drivable joint angles of the walking robot. τ is the input torque of the 12 joints. The contact force f calculated based on equation (15) and other parameters of the robot dynamics model are all known, and the joint torque τ of each robot can be calculated by applying equation (16).

[0165]

number

number

[0166] In the present embodiment, equation (16) may be further written in the form of equation (17).

[0167]

number

[0168] Here, [Mathematical formula 44] can be obtained by equation (18).

[0169]

number

[0170]

number

[0171] Here, [Number 46]. x d , and [Equation 47] are determined by the second expected trajectory, k p , and k d is the coefficient of the PD control.

[0172]

number

number

[0173] That is, based on a dynamics model corresponding to the walking robot and the contact force between the plane and the walking robot at each time step, a motor torque provided by each joint motor at each time step is determined, thereby causing the trajectory of one end of each mechanical leg away from the base to match the second expected trajectory.

[0174] As shown in Figure 7, curve 7-1 shows the first expected trajectory, where the y-axis is the height of the center of gravity of the walking robot and the x-axis is time. In Figure 7, curve 7-2 shows the actual trajectory of the center of gravity, which determines the height of the center of gravity of the walking robot at different times by the data collection device mentioned above. As can be seen from the above, through the control of the MPC and the whole body dynamics, the actual height of the center of gravity of the walking robot can follow the center of gravity position planned by the simplified model mentioned above, and the smooth control of the landing can be realized.

[0175] As shown in posture 8-11 to posture 8-14 in FIG. 8A, in the simulation test, when the walking robot falls from a height of 0.75 meters, the leg length is contracted at the moment of contact with the ground. Then, as shown in posture 8-21 to posture 8-28 in FIG. 8B, in the process of landing buffering, the distance between the base of the walking robot and the ground is gradually shortened. The leg part provides a reaction force to the center of gravity of the walking robot, and under the action of the reaction force, the posture of the body of the walking robot realizes deceleration, but at the same time, in the process of rebounding the height of the body of the walking robot, the height of the foot end of the walking robot does not bounce off the ground, and the overshoot in the whole process of changing the height of the center of gravity is reduced. At the end of smooth control, the walking robot can stand on the ground in one preset posture, and the posture and the rebound process of the height of the center of gravity are generally consistent with the desired one.

[0176] Figures 7 to 8B all show that in a situation where the walking robot has a relatively large falling velocity in the z-direction (greater than the velocity threshold) at the moment it contacts the ground, applying the embodiments of the present application can reduce the impact on the joints during the entire landing process of the walking robot, reduce the rebound force on the upper body, and eliminate the phenomenon of the legs jumping up and then landing again, thereby ensuring the landing function while providing good impact-resistant protection for the walking robot.

[0177] In the embodiment of the present application, a model is created for a walking robot in free fall motion, and the motion trajectory of the center of gravity and the position trajectory of the foot end of the walking robot after landing are planned based on the model, and the control torque of each motor is calculated based on the planned motion trajectory of the center of gravity and the position trajectory of the foot end to control the walking robot, thereby reducing the impact force received by each joint during the landing process of the walking robot, reducing the rebound of the body, ensuring the landing function, and at the same time, providing good impact protection effect for the walking robot.

[0178] An embodiment of the present application proposes a walking robot 900. Figure 9 shows an exemplary block diagram of a walking robot 900 according to an embodiment of the present application.

[0179] The walking robot 900 may include a base 910 and a lower limb unit 920 connected to the base 910, and the lower limb unit 920 may include at least two mechanical legs (e.g., four lower limbs). Each of the mechanical legs may include a hip joint and a knee joint, the hip joint may include at least two degrees of freedom, and the knee joint may include at least one degree of freedom (e.g., each lower limb may include two degrees of freedom of the hip joint and one degree of freedom of the knee joint).

[0180] The lower limbs refer to the walking members used to realize the movement of the walking robot, such as mechanical legs and motors that connect the mechanical legs with the base and are used to realize the movement control of the mechanical legs. The embodiments of the present application are not limited to the specific configuration type of the lower limbs and the number of the lower limbs.

[0181] The base refers to the main body part of the walking robot, and may be, for example, the torso part of the walking robot, and the embodiments of the present application are not limited to the specific shape and configuration of the base.

[0182] In some embodiments, the base may include, for example, two spinal joints and the lower limbs may include, for example, eight lower limb joints. The embodiments of the present application are not limited to the specific number of joints included in the base and the lower limbs, and are not limited to the specific joint configuration of the walking robot.

[0183] The walking robot may further include an electronic device 930 that is installed on the walking robot and can execute the method for controlling the walking robot described above and has the functions described above.

[0184] The electronics 930 includes, for example, a processing device, which may include a microprocessor, a digital signal processor (DSP), an application specific integrated circuit (ASIC), a field programmable gate array, a state machine, or other processing device used to process the electrical signals received from the sensor wires. This processing device may include programmable electronics, such as a PLC, a programmable interrupt controller (PIC), a programmable logic device (PLD), a programmable read only memory (PROM), and an electronically programmable read only memory.

[0185] The walking robot may further include a bus, a memory, a sensor assembly, a communication module, and an input / output device.

[0186] A bus may be a circuit that connects each component of the walking robot to each other and transmits communication information (eg, control messages or data) between each component.

[0187] The sensor assembly can be used to sense the physical world and includes, for example, cameras, infrared sensors, ultrasonic sensors, etc. The sensor assembly may also include devices used to measure the current motion and movement state of the walking robot, such as hall sensors, laser position sensors, or strain sensors.

[0188] The communication module may be connected to a network, for example, wired or wirelessly, thereby communicating with the physical world (e.g., a server). The communication module may be wireless and may include a wireless interface, for example, an Institute of Electrical and Electronics Engineers (IEEE) 802.11, Bluetooth, a wireless local area network (WLAN) transceiver, or a wireless interface used to access a cellular telephone network (e.g., a transceiver / antenna used to access a CDMA, GSM, UMTS, or other mobile communication network). In an embodiment of the present application, the communication module may be wired and may include an interface, for example, an Ethernet, a Universal Serial Bus (USB), or an IEEE 1394.

[0189] The input / output device can, for example, transmit commands or data input from a user or any other external device to one or more other components of the walking robot, or output commands or data received from one or more other components of the walking robot to the user or other external device.

[0190] A plurality of walking robots can cooperate to complete the task of paragraph 1 by forming a walking robot system, and the plurality of walking robots are communicatively connected to a server and receive instructions from the server to cause the walking robots to cooperate.

[0191] The following will continue to describe an exemplary structure of the device for controlling a walking robot provided by the embodiments of the present application, which is implemented as a software module. In some embodiments, as shown in FIG. 10, the software module in the device 1055 for controlling a walking robot stored in the memory 1050 of the electronic device 930 is: a planning calculation module 10551 configured to determine a first expected trajectory corresponding to the walking robot in response to the walking robot falling until it touches a flat surface, and to determine a second expected trajectory corresponding to the walking robot, the first expected trajectory indicating an expected trajectory of a center of gravity of the walking robot, and the second expected trajectory indicating an expected trajectory of a foot end of at least two of the mechanical legs; and a control module 10552 configured to control movement of each of the joints after the walking robot contacts the plane based on a dynamics model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory.

[0192] In an embodiment of the present application, the planning calculation module 10551 is further configured to determine the first expected trajectory corresponding to the walking robot based on an approximation model corresponding to the walking robot in response to the walking robot falling until the walking robot contacts the flat surface, where in the approximation model, the walking robot is a single rigid body, and in the process of the walking robot contacting the flat surface, the resultant force of at least two of the mechanical legs forms an upward thrust on the single rigid body.

[0193] In an embodiment of the present application, the first expected trajectory is used to make the combined value of the center of gravity fluctuation amount of the walking robot, the total amount of impact force received by the walking robot, the amount of crouching of the walking robot, and the sudden change amount of the impact force received by the walking robot reach an extreme value.

[0194] In an embodiment of the present application, the first expected trajectory satisfies each of the first constraint condition, the second constraint condition, and the third constraint condition, and the first constraint condition is used to indicate that an instantaneous impact force is smaller than a maximum impact force that the walking robot can withstand. The instantaneous impact force refers to an impact force received at an instant when the walking robot contacts a flat surface. The second constraint condition is used to indicate that the impact force received by the walking robot is smaller than an upper limit of the support force that the flat surface can provide and is larger than a lower limit of the support force that the flat surface can provide, and the third constraint condition is used to indicate that the height of the center of gravity of the walking robot is higher than a minimum height.

[0195] In an embodiment of the present application, the planning calculation module 10551 is further configured to: determine a contact position where the foot end of the one mechanical leg contacts the plane at an instant when the one mechanical leg contacts the plane, set each of the contact positions corresponding to each time step as an expected trajectory corresponding to the one mechanical leg, and maintain each of the contact positions unchanged in each of the time steps; determine a motion trajectory of the foot end of the remaining mechanical leg based on the first expected trajectory, and set the motion trajectory as an expected trajectory corresponding to the remaining mechanical leg, where the remaining mechanical leg refers to the mechanical leg other than the one mechanical leg of the at least two mechanical legs; and determine the expected trajectory corresponding to the one mechanical leg and the expected trajectory corresponding to the remaining mechanical leg as the second expected trajectory corresponding to the walking robot.

[0196] In an embodiment of the present application, the planning calculation module 10551 is further configured to: determine, at the instantaneous time when the one mechanical leg contacts the plane, an initial position of a corresponding foot end of the remaining mechanical leg at the said instantaneous time based on a position in the first expected trajectory corresponding to the said instantaneous time; determine, based on the first expected trajectory, a position coordinate of the corresponding foot end of the remaining mechanical leg at a stable time, wherein, at the stable time, the posture of the center of gravity of the walking robot becomes parallel to the plane, at least two of the mechanical legs contact the plane, and the leg lengths of at least two of the mechanical legs are restored to be equal; and interpolate values ​​based on the initial position of the foot end and the position coordinate of the corresponding foot end of the remaining mechanical leg at the stable time, to obtain the motion trajectory of the foot end of the remaining mechanical leg.

[0197] In an embodiment of the present application, the control module 10552 is further configured to control the movement of each joint after the walking robot contacts a plane, so that one mechanical leg of the walking robot first contacts the plane and maintains the contact position unchanged, and the remaining mechanical legs contact the plane in sequence and maintain contact with the plane after contact, until the center of gravity of the walking robot reaches a desired rest height.

[0198] In an embodiment of the present application, the first expected trajectory indicates that after the walking robot contacts the plane, the height of the center of gravity of the walking robot gradually decreases, and then gradually increases.

[0199] In an embodiment of the present application, the second expected trajectory indicates that after one mechanical leg of the walking robot contacts the plane, the length of the remaining mechanical leg changes with a change in the height of the center of gravity of the walking robot.

[0200] In an embodiment of the present application, the step of controlling the movement of each of the joints after the walking robot contacts the plane based on a dynamic model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory includes a step of determining a contact force between the plane and the walking robot at each time step based on the dynamic model corresponding to the walking robot, wherein the contact force is used to control the actual trajectory of the center of gravity of the walking robot to match the first expected trajectory, and a step of determining a motor torque provided by each joint motor at each of the time steps based on the dynamic model corresponding to the walking robot and each of the contact forces, wherein the motor torque is used to control the trajectories of the foot ends of at least two of the mechanical legs to match the second expected trajectory.

[0201] In an embodiment of the present application, the device 1055 for controlling the walking robot further includes a contact judgment module 10553 configured to: determine contact information based on current state information of the walking robot, where the contact information indicates a contact state between at least two of the mechanical legs and the plane at a current time; and determine, based on the contact information, that the walking robot will fall until it contacts the plane.

[0202] In an embodiment of the present application, the contact judgment module 10553 is further configured to: obtain a historical state value of any one of the mechanical legs at a time prior to the current time; determine a current state value of the mechanical leg based on the current state information of the walking robot; determine whether there is a sudden change in the current state value based on the current state value and the historical state value; and determine the contact information corresponding to the mechanical leg based on whether there is a sudden change in the current state value.

[0203] In an embodiment of the present application, the current state information includes at least one of the joint motor torque, current value, or voltage value of at least two of the mechanical legs, the height of the center of gravity of the walking robot, the attitude of the center of gravity, or current joint angle information corresponding to at least two of the mechanical legs, the current plantar tactile feedback value corresponding to at least two of the mechanical legs, and the current acceleration of the walking robot in the vertical direction.

[0204] As can be understood, in the embodiments of the present application, with regard to relevant data such as the movement information of a walking robot, when the embodiments of the present application are applied to a specific product or technology, user permission or consent needs to be obtained, and the collection, use and processing of the relevant data needs to comply with the relevant laws, regulations and standards of the relevant countries or regions.

[0205] The program portion of the technology may be considered as a "product" or "article of manufacture" existing in the form of executable code and / or associated data, and is involved or realized by a computer-readable medium. A tangible and permanent storage medium may include internal memory or memory used in any computer, processor, or similar device or associated module. For example, various semiconductor memories, magnetic tape drivers, magnetic disk drivers, or any similar device capable of providing storage functionality for software.

[0206] All the software, or parts thereof, may be communicated over a network, such as the Internet, or other communications network. Such communication may load the software from one computer device or processor to another. Thus, other media capable of transmitting the software elements may be used as physical connections between the partial devices, such as light waves, radio waves, and electromagnetic waves, which may be realized by propagation by cables, optical cables, or air. Physical media used to carry waves, such as cables, wireless connections, or similar devices such as optical cables, may also be considered as media carrying software. As used herein, unless limited to being tangible "storage" media, other terms referring to computer or machine "readable media" all refer to media involved in the process of a processor executing any instructions.

[0207] The present application uses certain words and phrases to describe the embodiments of the present application. For example, "an embodiment of the present application" and / or "some embodiments of the present application" means a feature, structure, or characteristic associated with at least one embodiment of the present application. Thus, it is to be emphasized and noted that "an embodiment of the present application" or "some embodiments of the present application" may be referenced twice or more times in various places in the present application, but do not necessarily refer to the same embodiment. Also, certain features, structures, or characteristics in one or more embodiments of the present application may be combined as appropriate.

[0208] Also, as will be appreciated by those skilled in the art, each aspect of the present application can be described and described in terms of several patentable classes or contexts, including any new and useful process, machine, manufacture, combination of matter, or any new and useful improvement thereon. Accordingly, each aspect of the present application may be implemented entirely in hardware, entirely in software (including firmware, resident software, microcode, etc.), or a combination of hardware and software. Any of the above hardware or software may be referred to as a "data block," "module," "engine," "unit," "assembly," or "system." Also, each aspect of the present application may be embodied as a computer product located on one or more computer-readable mediums, which may include computer-readable program code.

[0209] Unless otherwise defined, all terms (including technical and scientific terms) used herein have the same meaning as commonly understood by those skilled in the art. It should be further understood that the definitions of these terms in conventional dictionaries should be interpreted to have a meaning consistent with their meaning in the context of their relevant art, and should not be interpreted in an idealized or overly formalized sense unless expressly defined herein.

[0210] The above is an explanation of the present application and should not be considered as a limitation thereon. Although several exemplary embodiments of the present application have been described, those skilled in the art can easily understand that many modifications can be made to the exemplary embodiments without departing from the novel teachings and advantages of the present application. Accordingly, all such modifications are intended to be included within the scope of the present application, which is limited to the scope of the claims. It should be understood that the above is an explanation of the present application and should not be considered as a limitation to the specific embodiments disclosed. Also, modifications to the disclosed embodiments and other embodiments are intended to be included within the scope of the appended claims. The present application is limited by the claims and their equivalents.

Claims

1. 1. A method of controlling a walking robot, the walking robot including a base and at least two mechanical legs, each mechanical leg including at least one joint, the method comprising: determining a first expected trajectory corresponding to the walking robot in response to the walking robot falling until it contacts a flat surface, and determining a second expected trajectory corresponding to the walking robot, the first expected trajectory indicating an expected trajectory of a center of gravity of the walking robot, and the second expected trajectory indicating an expected trajectory of foot ends of at least two of the mechanical legs; and controlling the movement of each of the joints after the walking robot contacts the plane based on a dynamic model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory.

2. determining a first expected trajectory corresponding to the walking robot in response to the walking robot falling until contacting a surface, comprising:

2. The method of claim 1, comprising: determining the first expected trajectory corresponding to the walking robot based on an approximation model corresponding to the walking robot in response to the walking robot falling until it contacts the flat surface, wherein in the approximation model, the walking robot is a single rigid body, and in the process of the walking robot contacting the flat surface, a resultant force of at least two of the mechanical legs forms an upward thrust on the single rigid body.

3. The method according to claim 2, wherein the first expected trajectory is used to make a combined value of the amount of change in the center of gravity of the walking robot, the total amount of impact force received by the walking robot, the amount of crouching of the walking robot, and the sudden change in the impact force received by the walking robot reach an extreme value.

4. the first expected trajectory satisfies each of a first constraint condition, a second constraint condition, and a third constraint condition; The first constraint condition is used to instruct that an instantaneous impact force is smaller than a maximum impact force that the walking robot can withstand, and the instantaneous impact force refers to an impact force that the walking robot receives at a moment when the walking robot comes into contact with a flat surface; The second constraint condition is used to indicate that the impact force received by the walking robot is smaller than an upper limit of the support force that the plane can provide and is larger than a lower limit of the support force that the plane can provide; The method of claim 3 , wherein a third constraint is used to dictate that the height of the center of gravity of the walking robot is higher than a minimum height.

5. Determining a second expected trajectory corresponding to the walking robot includes: determining a contact position where a foot end of one of the machine legs contacts the plane at an instantaneous time when the one of the machine legs contacts the plane, setting each of the contact positions corresponding to each time step as an expected trajectory corresponding to the one of the machine legs, and maintaining each of the contact positions unchanged at each of the time steps; A step of determining a motion trajectory of a foot end of a remaining mechanical leg based on the first expected trajectory, and setting the motion trajectory as an expected trajectory corresponding to the remaining mechanical leg, wherein the remaining mechanical leg refers to a mechanical leg other than the one mechanical leg of the at least two mechanical legs; and determining an expected trajectory corresponding to the one mechanical leg and an expected trajectory corresponding to the remaining mechanical legs as the second expected trajectory corresponding to the walking robot.

6. The step of determining a motion trajectory of a foot end of a remaining mechanical leg based on the first expected trajectory includes: determining, at the time instant when the one mechanical leg contacts the plane, an initial position of a corresponding foot end of the remaining mechanical leg at the time instant based on a position on the first expected trajectory corresponding to the time instant; a step of determining position coordinates of corresponding foot ends of the remaining mechanical legs at a stable time based on the first expected trajectory, wherein at the stable time, an orientation of the center of gravity of the walking robot is restored to be parallel to the plane, at least two of the mechanical legs are in contact with the plane, and the leg lengths of the at least two of the mechanical legs are equal; and interpolating values ​​based on the initial position of the foot end and position coordinates of corresponding foot ends of the remaining mechanical legs at the stable time to obtain the motion trajectory of the foot end of the remaining mechanical leg.

7. The step of controlling the movement of each of the joints after the walking robot comes into contact with the plane includes: A method according to any one of claims 1 to 6, comprising a step of controlling the movement of each of the joints after the walking robot contacts the plane, so that one mechanical leg of the walking robot first contacts the plane and maintains a contact position unchanged, and the remaining mechanical legs contact the plane in turn and maintain contact with the plane after contact, until the center of gravity of the walking robot reaches a desired rest height.

8. 7. The method according to claim 1, wherein the first expected trajectory indicates that after the walking robot contacts the plane, the height of the center of gravity of the walking robot gradually decreases and then gradually increases.

9. 9. The method of claim 8, wherein the second expected trajectory indicates that after one mechanical leg of the walking robot contacts the plane, the length of the remaining mechanical leg changes with a change in height of the center of gravity of the walking robot.

10. controlling a movement of each of the joints after the walking robot comes into contact with the plane based on a dynamic model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory, determining a contact force between the plane and the walking robot at each time step based on the dynamics model corresponding to the walking robot, the contact force being used to control an actual trajectory of the center of gravity of the walking robot to coincide with the first expected trajectory; and determining a motor torque to be provided by each joint motor at each said time step based on the dynamics model corresponding to the walking robot and each of the contact forces, the motor torque being used to control trajectories of foot ends of at least two of the mechanical legs so as to match the second expected trajectory.

11. Prior to the step of responding to the walking robot falling until contacting a flat surface, the method further comprises: determining contact information based on current state information of the walking robot, the contact information indicating a contact state between at least two of the mechanical legs and the plane at a current time; The method of any one of claims 1 to 6, further comprising: determining, based on the contact information, that the walking robot will fall until it contacts the flat surface.

12. The step of determining contact information based on current state information of the walking robot includes: A step of acquiring a history state value of any one of the machine legs at a time before a current time; determining a current state value of the mechanical leg based on the current state information of the walking robot; determining whether there is a sudden change in the current state value based on the current state value and the historical state value; and determining the contact information corresponding to the machine leg based on whether there is a sudden change in the current state value.

13. The current status information is A joint motor torque, a current value, or a voltage value of at least two of the mechanical legs; The height of the center of gravity of the walking robot, the orientation of the center of gravity, or current joint angle information corresponding to at least two of the mechanical legs; current plantar tactile feedback values ​​corresponding to at least two of said mechanical legs; a current acceleration of the walking robot in a vertical direction.

14. An apparatus for controlling a walking robot, the walking robot including a base and at least two mechanical legs, each of the mechanical legs including at least one joint, the apparatus comprising: a planning computation module configured to determine a first expected trajectory corresponding to the walking robot in response to the walking robot falling until it contacts a flat surface, and to determine a second expected trajectory corresponding to the walking robot, the first expected trajectory indicating an expected trajectory of a center of gravity of the walking robot, and the second expected trajectory indicating an expected trajectory of foot ends of at least two of the mechanical legs; and a control module configured to control movement of each of the joints after the walking robot contacts the plane based on a dynamics model corresponding to the walking robot, the first expected trajectory, and the second expected trajectory.

15. A walking robot, With the base, a lower limb unit connected to the base, the lower limb unit including at least two mechanical legs, each of the mechanical legs including a hip joint and a knee joint, the hip joint including at least two degrees of freedom, and the knee joint including at least one degree of freedom; A walking robot comprising: an electronic device, the electronic device being installed on the walking robot, and the electronic device being used to execute a method for controlling a walking robot described in any one of claims 1 to 13.

16. An electronic device for controlling a walking robot, A processor; An electronic device for controlling a walking robot, comprising: a memory having a computer-executable program stored therein, the computer-executable program executing a method for controlling a walking robot described in any one of claims 1 to 13 when operated by the processor.

17. A computer-readable storage medium having a computer-executable program stored therein, the computer-readable storage medium causing the processor to execute a method for controlling a walking robot according to any one of claims 1 to 13, when the computer-executable program is executed by a processor.

18. A computer program product comprising a computer executable program, the computer program product realizing the method for controlling a walking robot according to any one of claims 1 to 13, when the computer executable program is executed by a processor.

Citation Information

Patent Citations

  • Jump gait planning method of multi-legged robot

    CN112650222A

  • Legged robot and control method for the same

    DE112006000313B4

  • Leg type mobile and its controlling method

    JP2001138273A

  • Legged robot and its control method

    JP2006212736A

  • Control method to reduce fall damage in humanoid robots

    JP2014508660A

Cited By

  • Multilegged walking robot and walking method

    JP2026140217A

  • Multilegged walking robot and walking method

    JP7831805B1