Robot control method and apparatus, device, and storage medium
By designing the same vertical plane as the rotation center of the hip joint in the wheeled-legged robot and using the alternating swinging control of the mechanical legs, the problem of low efficiency in climbing stairs in wheeled-legged robots is solved, and rapid movement and environmental adaptation are achieved.
Patent Information
- Application Number
- PCT/CN2023/131776
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Priority Date
- 2023-05-17
- Filing Date
- 2023-11-15
- Publication Date
- 2024-11-21
AI Technical Summary
Existing wheeled robots are inefficient when climbing stairs because they need to keep their center of gravity within the support area, resulting in slow movement speed.
By designing the rotation center of the robot's hip joint to be located in the same vertical plane, one set of mechanical legs keeps the robot standing while the other set swings alternately, allowing the center of gravity to extend beyond the support area. The alternating swinging leg sets control the robot's movement.
It improves the robot's mobility in a dynamic equilibrium state, enabling it to quickly overcome obstacles such as climbing stairs, crossing shoulders, and traversing potholes, thus enhancing its environmental adaptability.
Smart Images

Figure CN2023131776_21112024_PF_FP_ABST
Abstract
Description
Robot control method, device, equipment and storage medium
[0001] This application claims priority to Chinese patent application No. 202310563089.1 filed on May 17, 2023, entitled “Robot control method, device, equipment and storage medium”, the entire contents of which are incorporated herein by reference. Technical Field
[0002] The embodiments of the present application relate to the field of artificial intelligence technology, and in particular to a robot control method, device, equipment, and storage medium. Background Art
[0003] With the development of robot control technology, some organizations and research institutions have successively launched wheel-legged robots with wheels as feet. These wheel-legged robots can not only slide quickly on their wheels, but also climb stairs and overcome obstacles.
[0004] Taking wheel-legged robots climbing stairs as an example, related technologies use heuristic methods to control wheel-legged robots, such as planning the position of the wheel-legged robot's mechanical legs relative to the stairs, and controlling the projection of the wheel-legged robot's center of gravity to move slowly within its support area to achieve stair climbing. This type of method is static stair climbing, that is, the projection of the robot's center of gravity will not exceed the robot's support area, resulting in low efficiency in the robot's stair climbing.
[0005] Summary of the Invention
[0006] The embodiments of the present application provide a robot control method, apparatus, device, and storage medium, which can improve the robot's mobility efficiency. The technical solution is as follows:
[0007] According to one aspect of an embodiment of the present application, a method for controlling a robot is provided, the method being executed by a computer device. The robot includes a body, a first mechanical leg group and a second mechanical leg group connected to the body via hip joints, at least one of the first mechanical leg group and the second mechanical leg group includes at least two mechanical legs, and the rotation centers of the hip joints corresponding to the first mechanical leg group and the rotation centers of the hip joints corresponding to the second mechanical leg group are located in the same vertical plane. The method includes:
[0008] The robot stands on the support surface in an overlapping standing state, wherein a position error of each mechanical leg of the robot in the overlapping standing state in the first direction is zero;
[0009] The first mechanical leg group and the second mechanical leg group are controlled to swing alternately and move toward the first direction on the supporting surface.
[0010] According to one aspect of an embodiment of the present application, a control device for a robot is provided, wherein the robot includes a body, a first mechanical leg group and a second mechanical leg group connected to the body via hip joints, at least one of the first mechanical leg group and the second mechanical leg group includes at least two mechanical legs, and the rotation center of the hip joint corresponding to the first mechanical leg group and the rotation center of the hip joint corresponding to the second mechanical leg group are located in the same vertical plane; the device includes:
[0011] a standing state control module, configured to stand on a support surface in an overlapping standing state, wherein a position error of each mechanical leg of the robot in a first direction is zero;
[0012] The swing state control module is used to control the first mechanical leg group and the second mechanical leg group to swing alternately and move in the first direction on the support surface.
[0013] According to one aspect of an embodiment of the present application, a computer device is provided, wherein the robot includes a processor and a memory, wherein a computer program is stored in the memory, and the computer program is loaded and executed by the processor to implement the above-mentioned robot control method.
[0014] According to one aspect of an embodiment of the present application, a computer-readable storage medium is provided, in which a computer program is stored. The computer program is loaded and executed by a processor to implement the above-mentioned robot control method.
[0015] According to one aspect of an embodiment of the present application, a computer program product is provided, the computer program product including a computer program stored in a computer-readable storage medium. A processor of a computer device reads the computer program from the computer-readable storage medium and executes the computer program, causing the computer device to perform the above-described robot control method.
[0016] The technical solutions provided by the embodiments of the present application may have the following beneficial effects:
[0017] For a robot with a first set of mechanical legs and a second set of mechanical legs, since the rotation centers of their corresponding hip joints lie in the same vertical plane, one set of mechanical legs can be used to maintain standing while the other set of mechanical legs swings, allowing the robot to move rapidly while maintaining dynamic equilibrium (i.e., the robot's center of gravity can exceed the robot's support area), thereby improving the robot's mobility. Furthermore, controlling the robot's movement by alternating the swinging of the first and second sets of mechanical legs can further improve the robot's mobility. BRIEF DESCRIPTION OF THE DRAWINGS
[0018] FIG1 is a schematic diagram of an implementation environment of a solution provided by an embodiment of the present application;
[0019] FIG2 is a schematic diagram of a quadruped wheel-legged robot provided by one embodiment of the present application;
[0020] FIG3 is a schematic diagram of a wheel-legged robot climbing stairs provided by one embodiment of the present application;
[0021] FIG4 is a schematic diagram of a wheel-legged robot crossing a road shoulder provided by one embodiment of the present application;
[0022] FIG5 is a schematic diagram of a wheel-legged robot crossing a pit provided by one embodiment of the present application;
[0023] FIG6 is a schematic diagram of a robot control method provided by one embodiment of the present application;
[0024] FIG7 is a schematic diagram of a wheel-legged robot in an overlapping standing state provided by one embodiment of the present application;
[0025] FIG8 is a schematic diagram of a robot movement method provided by one embodiment of the present application;
[0026] FIG9 is a schematic diagram of gait information of a robot provided by one embodiment of the present application;
[0027] Figures 10-12 are schematic diagrams showing a quadruped wheel-legged robot climbing stairs;
[0028] FIG13 is a flow chart of a robot movement method provided by another embodiment of the present application;
[0029] FIG14 is a schematic diagram of a planar model of a wheel-legged robot provided in one embodiment of the present application;
[0030] FIG15 is a schematic diagram of a planar model of a wheel-legged robot climbing stairs provided by one embodiment of the present application;
[0031] FIG16 is a schematic diagram of an inverted pendulum model of a wheel-legged robot provided in one embodiment of the present application;
[0032] Figures 17-20 exemplarily illustrate schematic diagrams of the robot following various reference movement trajectories;
[0033] FIG21 is a block diagram of a control device of a robot provided by one embodiment of the present application;
[0034] FIG22 is a block diagram of a robot control device provided by another embodiment of the present application;
[0035] FIG23 is a simplified structural block diagram of a computer device provided by one embodiment of the present application. DETAILED DESCRIPTION
[0036] In order to make the objectives, technical solutions and advantages of this application clearer, the implementation methods of this application will be further described in detail below with reference to the accompanying drawings.
[0037] Artificial Intelligence (AI) refers to the theories, methods, techniques, and application systems that use digital computers or machines controlled by digital computers to simulate, extend, and expand human intelligence, to perceive the environment, acquire knowledge, and use that knowledge to achieve optimal results. In other words, AI is a comprehensive technology within computer science that seeks to understand the essence of intelligence and produce new intelligent machines that can respond in a manner similar to human intelligence. AI also studies the design principles and implementation methods of various intelligent machines, enabling them to possess the capabilities of perception, reasoning, and decision-making.
[0038] Artificial intelligence (AI) technology is a comprehensive discipline encompassing a wide range of fields, encompassing both hardware and software technologies. Foundational AI technologies generally include sensors, specialized AI chips, cloud computing, distributed storage, big data processing, operating / interaction systems, and mechatronics. AI software technologies primarily encompass computer vision, speech processing, natural language processing, and machine learning / deep learning.
[0039] The technical solution of this application mainly relates to robotics technology within artificial intelligence technology, primarily to intelligent robot control. A robot is a mechanical electronic device that utilizes a combination of mechanical transmission and modern microelectronics technology to mimic certain human skills. Robots are developed on the basis of electronic, mechanical, and information technologies. A robot does not necessarily have to look like a human; as long as it can autonomously complete tasks and commands assigned to it by humans, it belongs to the robot family. A robot is an automated machine that possesses some intelligent capabilities similar to those of humans or living things, such as perception, planning, movement, and coordination. It is a highly flexible automated machine. With the development of computer technology and artificial intelligence technology, robots have greatly improved in terms of functionality and technical level. Mobile robots and robot vision and tactile technologies are typical examples.
[0040] In the technical solution provided in the embodiments of the present application, the execution entity of each step can be a computer device, which refers to an electronic device with data calculation, processing and storage capabilities.
[0041] In some embodiments, the computer device can be a PC (Personal Computer) device such as a desktop computer or a laptop computer for controlling the robot; it can also be a server for controlling the robot. The server can be an independent physical server, a server cluster or a distributed system composed of multiple physical servers, or a cloud server that provides cloud computing services. The computer device and the robot can be connected through physical lines, networks, etc. For example, referring to Figure 1, the computer device 101 can control the movement of the robot 103 through the network 102 according to the reference movement trajectory of the robot 103 (such as the support reference movement trajectory, the center of mass reference movement trajectory, and the swing reference movement trajectory described below). For example, the computer device 101 can control the first mechanical leg group 104 and the second mechanical leg group 105 of the robot 103 to swing alternately according to the reference movement trajectory of the robot 103, so that the robot 103 moves in a first direction on the support surface.
[0042] In some embodiments, the computer device may also be a robot itself, meaning that the robot is the main body executing each step of the technical solution provided in the embodiments of this application. For example, referring to Figure 1, computer device 101 may send a reference movement trajectory of robot 103 to robot 103 via network 102, and robot 103 may move according to the reference movement trajectory. In some embodiments, robot 103 may also automatically obtain the reference movement trajectory based on the real environment to perform different tasks in the real environment, although this embodiment of the application is not limited to this.
[0043] The robot in the embodiments of the present application may refer to a wheel-leg robot, a leg-foot robot, etc. A wheel-leg robot refers to a robot with wheels as feet, and a leg-foot robot refers to a robot with feet as feet. The embodiments of the present application do not limit this.
[0044] In some embodiments, the robot may include a body, a first mechanical leg group and a second mechanical leg group connected to the body through a hip joint, at least one of the first mechanical leg group and the second mechanical leg group includes at least two mechanical legs, such as the first mechanical leg group includes at least two mechanical legs, the first mechanical leg group may also include at least two mechanical legs, there are at least two mechanical legs in the first mechanical leg group, respectively located on both sides of the central axis (i.e., the sagittal plane) of the robot, and there are at least two mechanical legs in the second mechanical leg group, respectively located on both sides of the central axis of the robot, and the first mechanical leg group and the second mechanical leg group are distributed side by side, that is, the rotation center of the hip joint corresponding to the first mechanical leg group and the rotation center of the hip joint corresponding to the second mechanical leg group are located in the same vertical plane.
[0045] Exemplarily, the robot in the embodiments of the present application is described by taking a wheel-legged robot as an example.
[0046] The wheel-legged robot in the embodiment of the present application may include a body, an outer mechanical leg group (i.e., a first mechanical leg group) and an inner mechanical leg group (i.e., a second mechanical leg group) connected to the body through a hip joint. The outer mechanical leg group may include two outer mechanical legs, and the inner mechanical leg group may include at least one inner mechanical leg. Exemplarily, the wheel-legged robot is a four-legged wheel-legged robot, i.e., the wheel-legged robot includes two outer mechanical legs and two inner mechanical legs; the wheel-legged robot is also a three-legged wheel-legged robot, i.e., the wheel-legged robot includes two outer mechanical legs and one inner mechanical leg. Wherein, the hip joint corresponding to at least one inner mechanical leg in the inner mechanical leg group is located between the hip joints corresponding to the two outer mechanical legs in the outer mechanical leg group, and the rotation center of the hip joint corresponding to the outer mechanical leg and the rotation center of the hip joint corresponding to the inner mechanical leg are located in the same vertical plane. The wheel-legged robot can stand on the support surface through the outer mechanical legs or the inner mechanical legs. The wheel-legged robot can also slide on the support surface through the wheel on the outer mechanical legs or the wheel on the inner mechanical legs. It can also move (i.e. walk) on the support surface by controlling the outer mechanical leg group and the inner mechanical leg group to swing alternately.
[0047] For example, as shown in Figure 2, which shows a schematic structural diagram of a quadruped wheel-legged robot, the quadruped wheel-legged robot 200 may include: a body, hip joints, and mechanical legs.
[0048] The quadruped wheel-legged robot 200 has four mechanical legs: two outer mechanical legs 201 (i.e., a first mechanical leg group) and two inner mechanical legs 202 (i.e., a second mechanical leg group). The two inner mechanical legs 202 are located between the two outer mechanical legs 201, and the four mechanical legs can be independently extended and retracted in the direction shown in the figure. A wheel 203 is installed at the end of each of the four mechanical legs, and each wheel 203 can be driven independently. The quadruped wheel-legged robot 200 can stand up by using the two inner mechanical legs 202 or the two outer mechanical legs 201 to be in a double-wheeled support state; the quadruped wheel-legged robot 200 can stand up by using the two inner mechanical legs 202 and the two outer mechanical legs 201 at the same time to be in a quadruped wheeled support state, which is not limited in this embodiment of the present application.
[0049] In some embodiments, the two inner mechanical legs 202 may be implemented as a whole, that is, the quadruped wheel-legged robot 200 may be implemented as a tripod wheel-legged robot having only one inner mechanical leg.
[0050] The other end of each of the four mechanical legs is connected to a hip joint 204. Each mechanical leg can rotate around its respective hip joint 204 and maintain a coordinated motion. In this embodiment of the present application, the rotation centers of the hip joints 204 corresponding to the quadruped wheeled leg robot 200 are located in the same vertical plane 205, and the rotation planes of the mechanical legs corresponding to the quadruped wheeled leg robot 200 are parallel. The hip joints 204 corresponding to the two inner mechanical legs 202 are located between the hip joints 204 corresponding to the two outer mechanical legs 201.
[0051] In some embodiments, the hip joints 204 corresponding to the quadruped wheeled legged robot 200 can be coaxial, that is, the rotation centers of the hip joints 204 are located on the same straight line. The hip joints 204 corresponding to the quadruped wheeled legged robot 200 can also be non-coaxial, for example, the hip joints 204 corresponding to the two inner mechanical legs 202 are coaxial, and the hip joints 204 corresponding to the two outer mechanical legs 201 are coaxial, but the hip joints 204 corresponding to the two inner mechanical legs 202 are not coaxial with the hip joints 204 corresponding to the two outer mechanical legs 201.
[0052] In some embodiments, the hip joints 204 corresponding to the two outer mechanical legs 201 share a drive motor to enable synchronous movement of the two outer mechanical legs 201; and the hip joints 204 corresponding to the two inner mechanical legs 202 share a drive motor to enable synchronous movement of the two inner mechanical legs 202. In one feasible example, each hip joint 204 corresponding to the quadruped wheeled leg robot 200 can also be independently driven by its own corresponding drive motor, which is not limited in this embodiment of the application.
[0053] The body of the quadruped wheeled-legged robot 200 may include a waist 206 , a trunk 207 , a head 208 and upper limbs 209 .
[0054] Each hip joint 204 of the quadruped wheeled-legged robot 200 is connected to the same end of the waist 206, and the other end of the waist 206 is connected to one end of the torso 207. The waist 206 has two rotation centers: a pitch rotation center that causes the torso 207 to pitch, and a roll rotation center that causes the torso 207 to swing. The roll rotation center is designed to be connected in series with the pitch rotation center and is located above the pitch rotation center, connecting to the torso 207.
[0055] The other end of the torso 207 is connected to the head 208 and upper limbs 209. The upper limbs 209 can have multiple degrees of freedom. In some embodiments, the upper limbs 209 are equipped with end effectors, such as robotic grippers or suction cups. The head 208 can be equipped with data acquisition devices, such as image acquisition devices and video capture devices, to perceive the real environment.
[0056] In the technical solution provided in the embodiment of the present application, the wheels, mechanical legs, hip joints and waist of the quadruped wheeled robot 200 are necessary hardware for the control algorithm, and the rest are non-essential hardware.
[0057] Compared with bipedal wheeled-legged robots, quadrupedal wheeled-legged robots have a more stable structure and are more resistant to external impact disturbances. Compared with hexapod wheeled-legged robots, they have fewer redundant joints and lower design complexity. They can bear large loads, pass through narrow spaces, and perform tasks on objects of different heights. Quadrupedal wheeled-legged robots have strong adaptability to the environment.
[0058] The robot control method provided in the embodiments of the present application is applicable to a variety of scenarios, such as climbing stairs, crossing thresholds, crossing curbs, crossing pits, and any other obstacle-crossing scenario. Robots using the technical solutions provided in the embodiments of the present application have greater environmental adaptability. The robot control method provided in the embodiments of the present application can improve the robot's mobility efficiency.
[0059] The following will take a wheel-legged robot as an example to illustrate the application scenarios of the technical solutions provided in the embodiments of this application.
[0060] In some embodiments, referring to FIG3 , when a wheeled-legged robot 301 needs to climb stairs, it can complete the stair climbing by controlling the outer mechanical leg group 302 (i.e., the first mechanical leg group) and the inner mechanical leg group 303 (i.e., the second mechanical leg group) to swing alternately. For example, the outer mechanical leg group 302 is first used as the supporting mechanical leg group and the inner mechanical leg group 303 is used as the swinging mechanical leg group, allowing the robot 301 to climb the first step. Then, the inner mechanical leg group 303 is used as the supporting mechanical leg group and the outer mechanical leg group 302 is used as the swinging mechanical leg group, allowing the robot 301 to climb the second step. The outer mechanical leg group 302 and the inner mechanical leg group 303 swing alternately in sequence to complete the stair climbing task.
[0061] In some embodiments, referring to FIG4 , when a wheeled-legged robot 401 needs to cross a road shoulder, it can accomplish this by controlling the outer mechanical leg group 402 and the inner mechanical leg group 403 to swing alternately. For example, the inner mechanical leg group 403 is first used as the supporting mechanical leg group, while the outer mechanical leg group 402 is used as the swinging mechanical leg group, allowing the outer mechanical leg group 402 of the robot 401 to climb onto the road shoulder. Then, the outer mechanical leg group 402 is used as the supporting mechanical leg group, while the inner mechanical leg group 403 is used as the swinging mechanical leg group, allowing the robot 401 to completely cross the road shoulder. The inner mechanical leg group 403 and the outer mechanical leg group 402 swing alternately in sequence to complete the road shoulder crossing task.
[0062] In some embodiments, referring to FIG5 , when a wheeled-legged robot 501 needs to cross a pit, it can control the outer mechanical leg group 502 and the inner mechanical leg group 503 to swing alternately to complete the crossing of the pit. For example, the inner mechanical leg group 503 is first used as the supporting mechanical leg group and the outer mechanical leg group 502 is used as the swinging mechanical leg group, so that the outer mechanical leg group 502 of the robot 501 crosses the pit. Then, the outer mechanical leg group 502 is used as the supporting mechanical leg group and the inner mechanical leg group 503 is used as the swinging mechanical leg group, so that the robot 501 completely crosses the pit. The inner mechanical leg group 503 and the outer mechanical leg group 502 swing alternately in sequence to complete the pit crossing task.
[0063] The following will use a method embodiment to illustrate the control method of the robot provided in the embodiment of the present application.
[0064] Please refer to Figure 6, which shows a flow chart of a robot control method provided by an embodiment of the present application. In this embodiment of the present application, the robot control method is described by taking the robot as an example of the execution subject of each step. The method may include at least one of the following steps (601-602):
[0065] Step 601: Stand on a support surface in an overlapping standing state, wherein the position error of each mechanical leg of the robot in the overlapping standing state in a first direction is zero.
[0066] In some embodiments, the overlapping standing state may refer to the initial state of the robot, which can be used to indicate the initial state of the robot when it moves on the support surface. For example, the overlapping standing state may indicate that the various mechanical legs of the robot overlap in the first direction, such as taking the contact point between the foot of the robot in the initial state and the support surface as the origin, the horizontal direction as the x-axis direction, the vertical direction as the z-axis direction, and the direction perpendicular to both the horizontal and vertical directions as the y-axis direction to construct the robot's world coordinate system. The coordinates of the various mechanical legs of the robot in the overlapping standing state in the x-axis direction are the same, that is, the position error of the various mechanical legs of the robot in the overlapping standing state in the x-axis direction is zero. When looking at the robot from the y-axis direction, only one outermost mechanical leg can be seen. Among them, the position error may refer to the error between the positions of the feet corresponding to each mechanical leg in the world coordinate system. The robot in the embodiment of the present application is the same as that described in the above embodiment and will not be repeated here.
[0067] In some embodiments, the overlapping standing state can be used to constrain the length of each mechanical leg, the positional relationship between the mechanical legs and the waist, and the positional relationship between the mechanical legs and the support surface in the initial state of the robot. For example, the robot in the overlapping standing state stands upright on the support surface.
[0068] In an embodiment of the present application, the first direction may refer to the forward direction of the robot, such as the first direction may refer to the horizontal direction parallel to the support surface, the first direction may also refer to the vertical direction perpendicular to the support surface, and the first direction may also refer to the x-axis direction corresponding to the world coordinate system of the robot. The embodiment of the present application does not limit this.
[0069] In an embodiment of the present application, the above-mentioned support surface may include only one plane, such as a flat ground, a road, etc., or it may include multiple planes of different heights, such as stairs, a road surface with shoulders, a ground with pits, etc. The embodiment of the present application is not limited to this.
[0070] In some examples, the initial state of the robot can be set and adjusted according to actual usage requirements. For example, the initial state of the robot can be a four-legged support standing state, a two-legged support standing state, etc., which is not limited in the embodiments of the present application.
[0071] For example, referring to FIG7 , a wheel-legged robot 701 is in an overlapping standing position, with the two outer mechanical legs in the outer mechanical leg group 702 (i.e., the first mechanical leg group) serving as supporting mechanical legs, standing on a supporting surface, while the two inner mechanical legs in the inner mechanical leg group 703 (i.e., the second mechanical leg group) are not in contact with the supporting surface. In some embodiments, the two inner mechanical legs in the inner mechanical leg group 703 may also be in contact with the supporting surface. The four mechanical legs of the robot 701 are in an overlapping state in a certain direction, i.e., in that direction, the position error of the four mechanical legs of the robot 701 is zero.
[0072] Step 602: Control the first robotic leg group and the second robotic leg group to swing alternately and move in a first direction on the support surface.
[0073] In the embodiments of the present application, the swinging of a robotic leg refers to the process of rotating the robotic leg with its hip joint as a fixed point, which is equivalent to rotating the robotic leg corresponding to the hip joint via the hip joint. In some embodiments, during the swinging process of the robotic leg, the length of the robotic leg can be adjusted according to actual usage requirements, and the position of the hip joint corresponding to the robotic leg in the world coordinate system can also be adjusted according to actual usage requirements, which is not limited in the embodiments of the present application.
[0074] The swinging of the first mechanical leg group refers to the swinging of the mechanical legs in the first mechanical leg group, the swinging of the second mechanical leg group refers to the swinging of the mechanical legs in the second mechanical leg group, and the alternating swinging of the first mechanical leg group and the second mechanical leg group refers to the alternating swinging of the mechanical legs in the first mechanical leg group and the mechanical legs in the second mechanical leg group.
[0075] Exemplarily, if the robot stops moving after n stride cycles, then for the i-th stride cycle and the i+1-th stride cycle that are adjacent to each other in the n stride cycles, if the first mechanical leg group swings during the i-th stride cycle, then the second mechanical leg group swings during the i+1-th stride cycle; and if the second mechanical leg group swings during the i-th stride cycle, then the first mechanical leg group swings during the i+1-th stride cycle. In some embodiments, when the first mechanical leg group swings, the second mechanical leg group serves as the supporting mechanical leg group; when the second mechanical leg group swings, the first mechanical leg group serves as the supporting mechanical leg group, where the supporting mechanical leg group refers to the mechanical leg group used to enable the robot to stand on a support surface.
[0076] Among them, the step cycle is used to indicate the time length for the first mechanical leg group or the second mechanical leg group to complete a swing, and n step cycles can be the same. The step amplitude of the first mechanical leg group or the second mechanical leg group within a step cycle is a step length. For example, the movement distance of the first mechanical leg group or the second mechanical leg group in the first direction within a step cycle can be recorded as a step length. The step length can be set and adjusted according to actual usage requirements, and the step length can also be a fixed value, which is not limited in the embodiments of the present application. n is a positive integer.
[0077] In some embodiments, since the control methods of the first and second robotic leg groups are the same in each stride cycle, the following description will be given using any one of n stride cycles as an example. Referring to FIG8 , step 602 may also include the following:
[0078] Step 602a: For each stepping cycle, determine the supporting mechanical leg group and the swinging mechanical leg group corresponding to the stepping cycle from the first mechanical leg group and the second mechanical leg group.
[0079] The swinging mechanical leg group refers to a mechanical leg group used to move the robot in a first direction. In the embodiment of the present application, the mechanical legs in the supporting mechanical leg group or the swinging mechanical leg group are of the same type, that is, the mechanical legs in the supporting mechanical leg group or the swinging mechanical leg group can all be mechanical legs in the first mechanical leg group, or all be mechanical legs in the second mechanical leg group. For example, if the first mechanical leg group is the supporting mechanical leg group, the second mechanical leg group is the swinging mechanical leg group; if the second mechanical leg group is the supporting mechanical leg group, the first mechanical leg group is the swinging mechanical leg group.
[0080] In some embodiments, a stride cycle includes a swing cycle and a support cycle. During the swing cycle, the robotic leg is in a swing state, and during the support cycle, the robotic leg is in a support state. The robotic leg in the swing state is not in contact with the support surface, and the robotic leg completes one swing during the swing cycle. The robotic leg in the support state is in contact with the support surface, and the robotic leg completes a transition between the swinging and support phases during the support cycle. The support cycle follows the swing cycle.
[0081] In some embodiments, within the same step cycle, the swing period of the supporting mechanical leg group is zero, that is, the supporting mechanical leg group is all in the supporting state, while the swinging mechanical leg group is first in the swinging state and then in the supporting state.
[0082] For example, in the same step cycle, the process of determining the supporting mechanical leg group and the swinging mechanical leg group may be as follows:
[0083] 1. Obtain the robot's gait information based on the ratio of n step cycles to the robot's stance period.
[0084] The support period ratio is used to indicate the proportion of time that the swinging mechanical leg of the robot is in the support state during each stride cycle. In some embodiments, during each stride cycle, the supporting mechanical leg is in the support state.
[0085] For example, let the step cycle be T, the support period ratio be: α∈[0,1), then the swing period of the swinging mechanical leg in one step cycle is: T swing =(1-α)T, the support period is: T stance =αT. In some embodiments, the ratio of the stepping period to the stance period may be a parameter pre-set in the robot, or may be a parameter automatically adjusted by the robot according to the real environment, which is not limited in the embodiments of the present application.
[0086] The gait information is used to indicate whether the robot's mechanical legs are swinging during each stride cycle, and can be used to instruct the robot's first and second mechanical leg groups to alternately swing. In some embodiments, for each stride cycle, if the swing period of a mechanical leg is non-zero, the mechanical leg can be determined to be a swinging mechanical leg; if the swing period of a mechanical leg is zero, the mechanical leg can be determined to be a supporting mechanical leg.
[0087] The gait information of each robotic leg can be expressed as a time series of support state and swing state. For example, let the support state be 1 and the swing state be 0. The first robotic leg group includes robotic legs c1 and c2, and the second robotic leg group includes robotic legs c3 and c4. If the robot first steps with the second robotic leg group, the gait of each robotic leg at time t can be expressed as follows:
[0088] Wherein, n=floor(t / T) represents the current number of steps (ie, the current step cycle).
[0089] If the robot takes the first step with the first set of mechanical legs, the gait of each mechanical leg at time t can be expressed as follows:
[0090] For example, referring to FIG9, taking the second mechanical leg group as an example, the gait information of the robot can be represented by the line graph shown in FIG9. For the first step cycle 901, in the swing cycle T swing =(1-α)T, the second mechanical leg group is in the swing state, and the first mechanical leg group is in the support state; during the support period T swing =(1-α)T, the second robotic leg group is in the support state, and the first robotic leg group is also in the support state. For the second step cycle 902, during the swing cycle, the first robotic leg group is in the swing state, and the second robotic leg group is in the support state; during the support cycle, the first robotic leg group is in the support state, and the second robotic leg group is also in the support state, and so on.
[0091] 2. According to the gait information, determine the supporting mechanical leg group and the swinging mechanical leg group corresponding to the step cycle from the first mechanical leg group and the second mechanical leg group.
[0092] In the embodiment of the present application, when determining the supporting mechanical leg group and the swinging mechanical leg group corresponding to the stride cycle, the robot's gait information is first obtained based on the ratio of the stride cycle to the robot's support period, and then the determination is made based on the gait information. Therefore, the method of further determining the supporting mechanical leg group and the swinging mechanical leg group based on the gait information makes the determination of the supporting mechanical leg group and the swinging mechanical leg group more reasonable and consistent with the actual working conditions of the robot.
[0093] In some embodiments, the sequence number of the stride cycle can be determined to be odd or even, and then combined with the robot's gait information to determine the supporting mechanical leg group and the swinging mechanical leg group corresponding to the stride cycle. For example, referring to Figure 9, if a stride cycle is the third stride cycle out of n stride cycles, it can be determined that within this stride cycle, the first mechanical leg group is the supporting mechanical leg group and the second mechanical leg group is the swinging mechanical leg group.
[0094] Step 602b: Using the supporting mechanical leg group as support, swing the mechanical leg group in a first direction.
[0095] The robot stands on a support surface by relying on the supporting mechanical leg group and swings the swinging mechanical leg group in the first direction by rotating the hip joint corresponding to the swinging mechanical leg group in the first direction. This process occurs during the swing period of the step cycle.
[0096] For example, referring to Figure 3, the robot 301 stands on the supporting surface by relying on the supporting mechanical leg group (i.e., the first mechanical leg group 302), and rotates the hip joint corresponding to the swinging mechanical leg group (i.e., the second mechanical leg group 303) in the first direction, so that the swinging mechanical leg group swings in the first direction to climb the first step of the stairs.
[0097] In some embodiments, the mechanical legs in the first mechanical leg group move synchronously, and the mechanical legs in the second mechanical leg group move synchronously. That is, during the support process of the supporting mechanical leg group, each supporting mechanical leg moves synchronously; during the swinging process of the swinging mechanical leg group, each swinging mechanical leg moves synchronously.
[0098] In some embodiments, the body of the robot remains vertical during the movement of the robot. As shown in Figure 3, the body of the robot 301 always remains vertical during the process of climbing stairs, that is, only the rotation of each hip joint needs to be adjusted, and the pitch joint, roll rotation joint, etc. do not need to be rotated to adjust the posture of the robot's body, thereby further reducing the control workload of the robot, which is beneficial to improving the control efficiency of the robot.
[0099] In some embodiments, during the swing period of a step cycle, while the swinging mechanical leg group swings in the first direction, the leg length of each supporting mechanical leg in the supporting mechanical leg group is increased.
[0100] By increasing the length of each supporting leg in the robot's leg assembly, the robot's center of mass can be changed in the second direction, allowing the robot to completely step over an obstacle, such as climbing all the steps of a staircase. The second direction is perpendicular to the first direction. For example, if the first direction is horizontal to the right, the second direction can be vertically upward.
[0101] During the swinging process of the swinging mechanical leg group, the leg length of each swinging mechanical leg can be adjusted according to the actual environment, such as being able to reach the desired position without colliding with the contact surface. The adjustment process will be described in detail below and will not be repeated here.
[0102] Step 602c: When the swinging mechanical leg group reaches the desired position corresponding to the stepping cycle on the support surface, stop swinging the swinging mechanical leg group.
[0103] In the embodiments of the present application, each stride cycle corresponds to an initial position and a desired position. The initial position may be the position where the swinging mechanical leg begins to swing, and the desired position may be the position where the swinging mechanical leg ends to swing. The desired position corresponding to each stride cycle can be determined based on the robot's stride length and the size of the support surface.
[0104] In some embodiments, for the adjacent i-th stride cycle and i+1-th stride cycle in n stride cycles, the expected position of the i-th stride cycle can be used as the initial position of the i+1-th stride cycle, that is, the initial position of the i+1-th stride cycle is the same as the expected position of the i+1-th stride cycle.
[0105] The expected position may refer to the expected position where the foot on the swinging machine leg contacts the support surface. For example, when the robot uses wheels as feet, the expected position may refer to the expected position where the wheel on the swinging machine leg contacts the support surface; when the robot uses feet as feet, the expected position may refer to the expected position where the foot on the swinging machine leg contacts the support surface.
[0106] After the swinging mechanical leg group stops swinging, the robot enters the support period. When the support period is a non-zero value, the robot is in a four-legged support standing state; when the support period is zero, the robot immediately alternates between the swinging mechanical leg group and the support mechanical leg group, that is, during the robot's movement, the robot is always in a two-legged support standing state, which can further improve the robot's movement efficiency.
[0107] After the current step cycle ends, the robot enters the next step cycle. The robot stops moving after n step cycles. For example, after n step cycles, the robot can stop moving if it climbs stairs, crosses a curb, or crosses a pothole. In some embodiments, after stopping moving, the robot can return to the above-mentioned overlapping standing state.
[0108] In summary, the technical solution provided by the embodiments of the present application allows a robot having a first set of mechanical legs and a second set of mechanical legs to maintain a standing position by using one set of mechanical legs while swinging the other set of mechanical legs, thereby enabling the robot to move rapidly in a state of dynamic equilibrium (i.e., the robot's center of gravity can exceed the robot's support area), thereby improving the robot's mobility. Furthermore, controlling the robot's movement by alternating the swinging of the first and second sets of mechanical legs can further improve the robot's mobility.
[0109] The robot's center of gravity refers to the point where the robot's gravity is concentrated, and the robot's center of mass is the weighted average of the mass position with respect to its mass. If the gravity is uniform, the center of mass and center of gravity can coincide. The robot's support area refers to the area enclosed by the contact points between the feet of each of the robot's mechanical legs and the support surface. Related technologies require that the projection of the center of gravity always be controlled within the support area, resulting in a very low center of mass speed and slow overall movement. However, the robot in the embodiment of the present application can have its center of gravity exceed the robot's support area, making the overall movement very fast, thereby improving the robot's mobility.
[0110] In addition, by setting the support period in each step cycle of the robot to zero, the robot can control the first mechanical leg group and the second mechanical leg group to swing continuously and alternately without stopping, thereby further improving the movement efficiency of the robot.
[0111] In addition, setting the robot's hip joints to be coaxial, and controlling the synchronous movement of the mechanical legs in the first mechanical leg group and the synchronous movement of the mechanical legs in the second mechanical leg group can reduce the control difficulty of the robot, thereby improving the control efficiency of the robot.
[0112] In some embodiments, referring to Figures 10-12, the technical solutions provided by the embodiments of the present application are described by taking a quadruped wheel-legged robot climbing stairs as an example, which may include the following contents:
[0113] The initial state of the quadruped wheeled-legged robot 1000 when climbing stairs is an overlapping standing state, that is, the four mechanical legs of the quadruped wheeled-legged robot 1000 in the initial state are synchronously close together in the forward direction (such as horizontally to the right).
[0114] During the first step cycle (i.e., FIG10 ), the quadruped wheeled leg robot 1000 uses the outer mechanical leg group 1001 (i.e., the first mechanical leg group) as support and swings the inner mechanical leg group 1002 (i.e., the second mechanical leg group) in the forward direction, so that the quadruped wheeled leg robot 1000 climbs the first step of the stairs.
[0115] Among them, for the two inner mechanical legs in the inner mechanical leg group 1002, while controlling the two inner mechanical legs to swing synchronously in the forward direction through their corresponding hip joints, the leg lengths of the two inner mechanical legs are simultaneously shortened so that both inner mechanical legs are higher than the first step and do not touch the first step. Then, while controlling the two inner mechanical legs to continue to swing synchronously in the forward direction through their corresponding hip joints, the leg lengths of the two inner mechanical legs are simultaneously extended so that the inner mechanical leg group 1002 reaches the desired position of the first step. During this process, the two outer mechanical legs in the outer mechanical leg group 1001 are adaptively and synchronously extended, and the body of the quadruped wheeled leg robot 1000 remains vertical.
[0116] In the second step cycle (ie, FIG. 11 ), the quadruped wheel-legged robot 1000 uses the inner mechanical leg group 1002 as support and swings the outer mechanical leg group 1001 in the forward direction, so that the quadruped wheel-legged robot 1000 climbs the second step of the stairs.
[0117] Among them, for the two outer mechanical legs in the outer mechanical leg group 1001, while the two outer mechanical legs are controlled by their corresponding hip joints to swing synchronously in the forward direction, the leg lengths of the two outer mechanical legs are shortened synchronously so that the two outer mechanical legs are higher than the first step and do not touch the first step, and then continue to control the two outer mechanical legs by their corresponding hip joints to continue to swing synchronously in the forward direction while shortening the leg lengths of the two outer mechanical legs so that the two outer mechanical legs are higher than the second step and do not touch the second step, and finally continue to control the two outer mechanical legs by their corresponding hip joints to continue to swing synchronously in the forward direction while extending the leg lengths of the two outer mechanical legs so that the outer mechanical leg group 1001 reaches the desired position of the second step. In this process, the two inner mechanical legs in the inner mechanical leg group 1002 are adaptively extended synchronously, and the body of the quadruped wheeled leg type robot 1000 remains vertical and follows the extension of the two inner mechanical legs, while moving in the vertical and forward directions to achieve the center of mass adjustment of the quadruped wheeled leg type robot 1000.
[0118] In the third step cycle (ie, FIG. 12 ), the quadruped wheel-legged robot 1000 uses the outer mechanical leg group 1001 as support and swings the inner mechanical leg group 1002 in the forward direction, so that the quadruped wheel-legged robot 1000 climbs the third step of the stairs.
[0119] Among them, for the two inner mechanical legs in the inner mechanical leg group 1002, while the two inner mechanical legs are controlled by their corresponding hip joints to swing synchronously in the forward direction, the leg lengths of the two inner mechanical legs are shortened synchronously so that both inner mechanical legs are higher than the second step and do not touch the second step, and then continue to control the two inner mechanical legs by their corresponding hip joints to continue to swing synchronously in the forward direction while shortening the leg lengths of the two inner mechanical legs so that both outer mechanical legs are higher than the third step and do not touch the third step, and finally continue to control the two inner mechanical legs by their corresponding hip joints to continue to swing synchronously in the forward direction while extending the leg lengths of the two inner mechanical legs so that the inner mechanical leg group 1002 reaches the desired position of the third step. In this process, the two outer mechanical legs in the outer mechanical leg group 1001 are adaptively extended synchronously, the fuselage of the quadruped wheeled leg type robot 1000 remains vertical, and follows the extension of the two outer mechanical legs, while moving in the vertical and forward directions to achieve the center of mass adjustment of the quadruped wheeled leg type robot 1000.
[0120] In the subsequent stepping cycle, the inner mechanical leg group 1002 and the outer mechanical leg group 1001 swing alternately, so that the quadruped wheeled-legged robot 1000 climbs the stairs.
[0121] In summary, the technical solution provided by the embodiments of the present application allows a quadruped wheeled-legged robot with an inner and outer mechanical leg groups to maintain a standing position by using one set of mechanical legs while swinging the other set of mechanical legs, thereby improving the robot's mobility. Furthermore, controlling the robot's stair climbing by alternating the swinging of the inner and outer mechanical leg groups can further improve the robot's stair climbing efficiency.
[0122] In some embodiments, referring to FIG. 13 , the above step 602b of “swinging the mechanical leg group in the first direction with the support mechanical leg group as support” may further include the following:
[0123] Step S101 : determining a support reference movement trajectory of the supporting mechanical leg group based on the size information of the area corresponding to the step cycle on the support surface and the step length of the robot in the step cycle.
[0124] In some embodiments, because the robot moves in a stride (i.e., swinging) manner, the support surface can be divided into different regions based on the landing point of each step of the robot. In some embodiments, when the support surface has multiple regions, the desired position corresponding to each stride cycle (i.e., stride length) can also be determined based on the dimensions of the multiple regions.
[0125] For example, if the support surface is a staircase having multiple steps, each step corresponds to an area, and each stride cycle is used to climb one step, then the above-mentioned dimension information may refer to the dimension information of each step, such as the length, width, and height of the step. In some embodiments, the dimension information may also include the total number of steps in the staircase.
[0126] The aforementioned support reference movement trajectory may refer to the expected movement trajectory of the supporting robotic leg. The support reference movement trajectory may be a position sequence consisting of expected positions corresponding to each stride cycle, which is used to guide the movement of the supporting robotic leg group of the robot. For example, n stride cycles correspond to n expected positions, and then the n expected positions and the initial position of the robot are sorted in chronological order to obtain the support reference movement trajectory. Specifically, for each control moment t within the swing period of the same stride cycle, the expected position corresponding to each control moment t is the same. In some embodiments, the aforementioned support reference movement trajectory may be represented by the expected movement trajectory of the foot corresponding to the supporting robotic leg.
[0127] In some embodiments, since the robot always moves in the first direction (such as no displacement in the y-axis direction of the above-mentioned world coordinate system), and the mechanical legs in the supporting mechanical leg group move synchronously, the mechanical legs in the swinging mechanical leg group move synchronously, and the hip joints of the robot are coaxial, the robot can be simplified into a plane model under the sagittal plane (such as the sagittal plane in Figure 2).
[0128] For example, referring to Figure 14, it exemplarily shows a plane model 1400 of a wheel-legged robot in the sagittal plane. The plane model 1400 includes a body 1401, which is connected to the waist 1403 through a waist joint 1402 (corresponding to the above-mentioned roll rotation center and pitch rotation center). The waist 1403 is connected to the outer mechanical leg 1406 and the inner mechanical leg 1407 through the hip 1404. The hip joint 1405 of the hip 1404 is used to rotate the outer mechanical leg 1406 and the inner mechanical leg 1407. The feet of the outer mechanical leg 1406 and the inner mechanical leg 1407 are wheels 1408, and the wheel 1408 has a wheel joint 1409.
[0129] For example, referring to FIG15 , taking a quadruped wheeled-legged robot climbing stairs as an example, the process of obtaining the support reference movement trajectory of the supporting mechanical leg group can be as follows:
[0130] Based on the plane model 1500 and the stairs 1503 of the quadruped wheeled leg robot, a world coordinate system W-xyz corresponding to the quadruped wheeled leg robot is constructed. The world coordinate system is constructed with the initial contact point 1502 between the plane model 1500 and the stairs 1503 as the origin, the first direction (i.e., the forward direction) as the x-axis direction, and the second direction perpendicular to the first direction (i.e., the vertical direction) as the z-axis direction.
[0131] The initial contact point 1502 may also be the projection of the center of gravity of the quadruped wheel-legged robot on the ground in the initial state.
[0132] The floating base coordinate system B-xyz of the quadruped wheeled leg robot is then constructed with the hip joint 1501 of the plane model 1500 as the origin. The floating base coordinate system is fixedly connected to the hip joint 1501, that is, it moves with the movement of the hip joint 1501. The initial directions of the coordinate axes of the floating base coordinate system are the same as those of the world coordinate system. In some embodiments, the floating base coordinate system can also be fixedly connected to the torso of the quadruped wheeled leg robot, which is not limited in the embodiments of the present application. In some embodiments, the following calculations all occur in the world coordinate system and the floating base coordinate system.
[0133] In the world coordinate system, the initial position of the supporting leg can be expressed as (0, 0, 0), which is the first reference point in the supporting reference movement trajectory. Assume that the length of each step on the stairs 1503 is Ls and the height is Hs. The distance between the initial position of the supporting leg and the first step is l. The stride length of the quadruped wheeled leg robot in each step cycle is the length of the step corresponding to the step cycle. Then the supporting reference movement trajectory can be expressed as follows:
[0134] Where n = floor (t / T) represents the current number of steps (i.e., the current step cycle), t is the control time, r is the radius of the wheel, L s,j is the step length corresponding to the j-th step cycle (i.e., the length of the j-th step), H s,j is the height of the j-th step. Since the quadruped wheeled leg robot climbs stairs only in the sagittal plane, it does not need to pay attention to the movement in the y-axis direction, so the position value in the y-axis direction is set to 0. In some embodiments, L s,j Greater than l.
[0135] Step S102 : determining a reference movement trajectory of the center of mass of the robot according to the support reference movement trajectory of the supporting mechanical leg group, where the reference movement trajectory of the center of mass refers to a reference movement trajectory of the center of mass of the robot.
[0136] In the embodiment of the present application, the height between the center of mass of the robot and the foot of the supporting mechanical leg of the robot is set to a constant value, that is, the constant height below. The constant height can refer to the distance between the center of mass of the robot and the center of the foot corresponding to the supporting mechanical leg (such as the wheel center) in the z-axis direction, which is recorded as H com .
[0137] In some embodiments, the reference moving trajectory of the center of mass of the robot can be planned in a first direction and a second direction, where the second direction is perpendicular to the first direction. The process of obtaining the reference moving trajectory of the center of mass may include the following:
[0138] 1. Determine the reference movement trajectory of the robot's center of mass in the second direction based on the support reference movement trajectory, the support period ratio, and the constant height of the robot's center of mass relative to the foot of the supporting mechanical leg group.
[0139] The center of mass reference trajectory is used to guide the movement of the robot's center of mass. The support period ratio indicates the proportion of time the robot's swinging mechanical leg is in the support state during each step cycle.
[0140] In some embodiments, during the swing period, the center of mass reference movement trajectory in the second direction is obtained by the initial position and the end position in the support reference movement trajectory combined with the constant height interpolation; during the support period, the center of mass reference movement trajectory in the second direction is determined by the end position and the constant height in the support reference movement trajectory.
[0141] The initial position and ending position in the support reference motion trajectory corresponding to the current stride cycle are, respectively, the reference position of the supporting mechanical leg for the current stride cycle and the reference position of the supporting mechanical leg for the stride cycle following the current stride cycle. For the second direction, the initial position is the position component of the reference position of the supporting mechanical leg for the current stride cycle in the second direction (i.e., the z-axis direction), and the ending position is the position component of the reference position of the supporting mechanical leg for the stride cycle following the current stride cycle in the second direction (i.e., the z-axis direction).
[0142] For example, during the swing period of the n-th stride cycle, the reference movement trajectory of the center of mass in the second direction is interpolated from the reference position of the supporting mechanical leg in the n-th stride cycle to the reference position of the supporting mechanical leg in the (n+1)-th stride cycle; during the support period of the n-th stride cycle, the reference position of the center of mass in the second direction remains unchanged. Then, the reference movement trajectory of the center of mass in the second direction of the robot can be expressed as follows:
[0143] Among them, P com,z (t) represents the reference position of the robot’s center of mass in the second direction at the control time t, P stance,z (nT)+H com is the initial position of the center of mass in the nth step cycle (i.e., the sum of the position component of the reference position of the supporting mechanical leg in the nth step cycle in the z-axis direction and the constant height), P stance,z ((n+1)T)+H com is the ending position of the center of mass during the nth stride cycle (i.e., the sum of the z-axis component of the reference position of the supporting leg during the n+1th stride cycle and the constant height). Spline() is a spline interpolation method, such as cubic spline interpolation, or any other interpolation method that ensures that the velocity and acceleration at the start and contact moments of the reference trajectory are zero, and that the starting and ending positions meet the constraints. Spline() is used to interpolate the ending position of the center of mass during the nth stride cycle and the ending position of the center of mass during the swing cycle.
[0144] Each control moment in the swing period of the nth step cycle can be recorded as: nT≤t≤(n+1)T-αT, and each control moment in the support period of the nth step cycle can be recorded as: (n+1)T-αT≤t≤(n+1)T.
[0145] 2. Determine the robot's zero torque point ZMP reference trajectory based on the support reference movement trajectory and support period ratio.
[0146] In an embodiment of the present application, the ZMP (Zero Moment Point) corresponding to a step cycle is the contact point between the foot of the supporting robotic leg and the supporting surface corresponding to the step cycle (hereinafter referred to as the supporting contact point), and the ZMP reference trajectory is a plurality of ZMPs arranged in chronological order during the movement of the robot.
[0147] In some embodiments, since the ZMP and the support contact point are identical, the ZMP reference trajectory remains the same as the support contact point reference trajectory within the swing cycle. During the support cycle, if the support contact point needs to transition from the support contact point of the current stride cycle to the support contact point of the next stride cycle, an interpolation method can be used to obtain the ZMP reference trajectory within the support cycle.
[0148] For example, during the swing period, the ZMP reference trajectory is the same as the reference trajectory of the contact point between the supporting leg group and the supporting surface. During the support period, the ZMP reference trajectory is obtained by interpolating the initial position and the end position in the support reference movement trajectory. The zero-moment point ZMP reference trajectory can be expressed as follows:
[0149] Among them, P zmp (t) represents the reference position of the robot’s ZMP at the control time t, P stance (nT) is the reference position of the supporting mechanical leg in the nth step cycle, P stance ((n+1)T) is the reference position of the supporting leg at the n+1th stride cycle. Spline() is a spline interpolation method, such as cubic spline interpolation, or any other interpolation method that ensures that the velocity and acceleration at the start and contact moments of the reference trajectory are zero, and that the start and end positions meet the constraints. Spline() is used to interpolate the reference positions of the supporting leg at the nth stride cycle and the n+1th stride cycle within the support cycle.
[0150] 3. Based on the ZMP reference trajectory, determine the reference movement trajectory of the robot's center of mass in the first direction.
[0151] In some embodiments, the center of mass reference movement trajectory in the first direction is used to guide the center of mass of the robot to move in the first direction. The center of mass reference movement trajectory in the first direction can be a sequence of position components of the center of mass in the first direction sorted in chronological order during the movement of the robot.
[0152] In some embodiments, the movement of the center of mass of the robot in the first direction can be simplified as an inverted pendulum model. For example, referring to FIG16 , a quadruped wheeled robot can be simplified as an inverted pendulum model 1600 , where m is the total mass of the robot, P is the com,x is the position of the center of mass in the first direction (i.e., the x-axis direction) in the world coordinate system, P zmp,x is the position of ZMP in the first direction in the world coordinate system, P com,z is the position of the center of mass in the second direction (i.e., the z-axis direction) in the world coordinate system.
[0153] The reference moving trajectory of the robot's center of mass in the first direction can be P at each control moment. com,x The sequence of components.
[0154] For example, P at each control moment can be calculated based on SLQR (Singular Quadratic Regulator) control. com,x . Among them, SLQR control is a variation of LQR (Linear Quadratic Regulator) control. The objective function of SLQR is still a quadratic functional, but the quadratic weight of its control variable is always 0. The rest is similar to LQR control. The advantage of using SLQR control is that it avoids the use of the Riccati equation to calculate the feedback coefficient in LQR control. The feedback coefficient can be calculated directly through numerical iteration, which greatly reduces the amount of calculation and improves the calculation efficiency. The process can specifically include the following:
[0155] 1) Construct the state variables of the discrete-time state equation of the robot using the position of the ZMP, the position of the center of mass of the robot in the first direction, and the speed of the center of mass of the robot in the first direction.
[0156] For each control moment, the state variables at that control moment are constructed based on the ZMP position, the center of mass position in the first direction, and the center of mass speed in the first direction at that control moment. For example, the state variables at each control moment can be expressed as follows:
[0157] The discrete-time state equation of the robot can be expressed as follows: x(k+1)=Ax(k)+Bu(k); y(k)=Cx(k);
[0158] Among them, x(k+1) is the state variable at time k+1 in discrete time, t c Indicates the control cycle (i.e. the time it takes to run the regulator once), is a constant, y(k) is P at time k zmp,x , which is an unnecessary calculation.
[0159] 2) Using the SLQR control method, the objective function is constructed according to the reference position of the ZMP in the ZMP reference trajectory.
[0160] For example, the objective function can be expressed as follows:
[0161] in, represents the reference position of ZMP in the first direction at time j, P zmp,x represents the actual position of ZMP in the first direction at time j, and u(j) represents the actual position of ZMP in the first direction at time j.
[0162] 3) Determine the feedback gain matrix based on the objective function.
[0163] In some embodiments, the input weight R of the objective function is directly set to 0, and the feedback gain matrix can be obtained:
[0164] 4) Construct the control variables of the discrete-time state equation based on the feedback gain matrix, the center of mass position of the robot in the first direction, and the reference position of the ZMP in the ZMP reference trajectory.
[0165] In some embodiments, the control variable of the discrete-time state equation is the output of the SLQR controller, and the control variable can be expressed as:
[0166] Among them, u(k) is the control variable at time k, δ j is an impulse function, which takes 1 only at the initial moment and 0 at other moments. p is the prediction time under the unit control cycle, is the reference position of ZMP in the ZMP reference trajectory at time k+j.
[0167] 5) Substitute the state variables and control variables into the discrete-time state equation and iterate to obtain the reference movement trajectory of the robot's center of mass in the first direction.
[0168] In some embodiments, for each control moment, the state variables and control variables are brought into the discrete time state equation, and x(k) at each control moment is obtained by iteration, and then y(k) at each control moment is obtained, that is, P at each control moment. com,x , and then arrange them in chronological order to obtain the reference movement trajectory of the robot's center of mass in the first direction.
[0169] In some embodiments, the present invention can also use LQR control to calculate P at each control moment.com,x If the robot is described as a linear quadratic LQ problem, the output of the linear system is obtained through iterative calculation of the equation, which is used as the control quantity of the robot to make the robot reach a stable state, thereby calculating P at each control moment. com,x , the embodiments of this application do not limit this.
[0170] When determining the center-of-mass reference trajectory of a robot in a first direction, the embodiment of the present application first constructs the state variables of the robot's discrete-time state equation, then constructs the objective function, further determines the feedback gain matrix, and finally constructs the control variables of the discrete-time state equation. Finally, the state variables and control variables are substituted into the state equation to obtain the center-of-mass reference trajectory in the first direction. The method for determining the center-of-mass reference trajectory provided by the embodiment of the present application constructs relatively detailed control variables and state variables, thereby improving the accuracy of the obtained center-of-mass reference trajectory.
[0171] 4. Determine the reference movement trajectory of the center of mass of the robot based on the reference movement trajectory of the center of mass of the robot in the second direction and the reference movement trajectory of the center of mass of the robot in the first direction.
[0172] In an embodiment of the present application, when determining the center of mass reference movement trajectory of the robot, it is divided into two parts: the center of mass reference movement trajectory of the first robot in the first direction and the center of mass reference movement trajectory of the robot in the second direction. The center of mass reference movement trajectory of the robot is determined by considering these two parts comprehensively, which improves the accuracy of the determined center of mass reference movement trajectory and is conducive to improving the subsequent precise control of the robot.
[0173] In some embodiments, the center-of-mass reference movement trajectory is a combination of the center-of-mass reference movement trajectory of the robot in the second direction and the center-of-mass reference movement trajectory of the robot in the first direction.
[0174] Step S103 : interpolating a swing reference movement trajectory of the swing mechanical leg group according to the initial position and the expected position corresponding to the swing mechanical leg group in the step cycle.
[0175] The aforementioned swing reference trajectory may refer to the expected trajectory of the swinging robotic leg. The robot's swing reference trajectory may be composed of the expected trajectory corresponding to each stride cycle, which may be used to guide the swinging of the robot's swinging robotic leg group. In some embodiments, the swing reference trajectory corresponding to a stride cycle may be represented by the trajectory of the foot of the swinging robotic leg corresponding to the stride cycle.
[0176] The initial position and expected position corresponding to the swinging mechanical leg group within the step cycle may respectively refer to: the initial position (i.e., the reference position of the supporting mechanical leg in the current step cycle) and the end position (i.e., the reference position of the supporting mechanical leg in the next step cycle of the current step cycle) of the corresponding supporting mechanical leg in the step cycle.
[0177] In some embodiments, the reference motion trajectory of the robot's swinging mechanical leg can be planned in a first direction (i.e., the x-axis direction) and a second direction (i.e., the z-axis direction), where the second direction is perpendicular to the first direction. The process of obtaining the swing reference motion trajectory may include the following:
[0178] 1. Construct a world coordinate system corresponding to the robot. The world coordinate system is constructed with the initial contact point between the robot and the support surface as the origin, the first direction as the x-axis direction, and the second direction perpendicular to the first direction as the z-axis direction.
[0179] The method of constructing the world coordinate system is the same as above and will not be repeated here.
[0180] 2. Use the spline curve interpolation method to interpolate the position component of the initial position in the first direction and the position component of the expected position in the first direction to obtain the swing reference movement trajectory of the swinging mechanical leg group in the first direction.
[0181] For example, the interpolation is performed using a cubic spline curve interpolation method, and the swing reference movement trajectory in the first direction can be expressed as follows: swing,x (t n )=a0+a1t n +a2t n 2 +a3t n 3 ;
[0182] Among them, t n ∈[0,(1-α)T], and t n =t-nT, which represents the control time normalized by the step cycle T in the nth step cycle, P swing,x (t n ) represents the control time t, the reference position of the swinging robot leg in the first direction, a0...a3 represent coefficients, which can be calculated according to the following constraints: P swing,x (0) = a0 = P stance,x (nT); P swing,x (T) = a0 + a1T + a2T 2 +a3T 3 =P stance,x ((n+1)T);
[0183] In some embodiments, when using the cubic spline curve interpolation method to obtain the swing reference movement trajectory in the first direction, the parameters corresponding to the cubic spline curve interpolation method can be set to prevent the swinging mechanical leg from colliding with the support surface in the first direction.
[0184] 3. Use the spline curve interpolation method to interpolate the position component of the initial position in the second direction and the position component of the expected position in the second direction to obtain the swing reference movement trajectory of the swinging mechanical leg group in the second direction.
[0185] The process of acquiring the swing reference movement trajectory in the second direction is similar to the process of acquiring the swing reference movement trajectory in the first direction. However, when the support surface includes multiple areas with different heights, in order to avoid the robot's foot from colliding with the support surface, the swing reference movement trajectory in the second direction can be divided into the same number of segments as the number of areas that need to be crossed according to the number of areas that the robot needs to cross during the step cycle, for planning to avoid the robot from colliding with the areas that need to be crossed.
[0186] For example, if the support surface is a staircase with m steps, where m is a positive integer, a sub-desired position of the swinging mechanical leg group at each step is obtained. The foot of the swinging mechanical leg at the sub-desired position is higher than the step in the second direction and not in contact with the step in the first direction. Interpolation is performed sequentially in chronological order between the initial position, the sub-desired positions corresponding to the m steps, and the desired position to obtain a swing reference movement trajectory of the swinging mechanical leg group. Here, m is a positive integer.
[0187] For example, when the robot climbs the first step, the swinging mechanical leg only needs to step onto the first step, so the swinging reference movement trajectory in the second direction can be divided into two sections for planning; when the robot climbs the second step, the swinging mechanical leg needs to pass the first step and step onto the second step, so the swinging reference movement trajectory in the second direction can be divided into three sections for planning.
[0188] When determining the swing reference trajectory of the swinging mechanical leg group, the embodiment of the present application interpolates between the initial position, the sub-expected position corresponding to each step, and the expected position in chronological order, so that the swinging process of the robot when climbing stairs is more reasonable and the possibility of error is reduced.
[0189] Taking the example of dividing the swing reference movement trajectory in the second direction into two segments for planning, assuming that the time corresponding to the desired position is 1 / 2 of the swing period (which can be set and adjusted according to actual use requirements), the cubic spline curve interpolation method is used for interpolation. The swing reference movement trajectory in the second direction in the first stage can be expressed as follows: Pswing,z (t n )=a0+a1t n +a2t n 2 +a3t n 3 ;
[0190] Among them, t n ∈[0, (1-α)T / 2], and t n =t-nT, which represents the control time normalized by the step cycle T in the nth step cycle, P swing,z (t n ) represents the control time t, the reference position of the swinging mechanical leg in the second direction, a0...a3 represent coefficients, which can be calculated according to the following constraints: P swing,z (0) = a0 = P stance,z (nT); P swing,z ((1-α)T / 2)=a0+a1T+a2T 2 +a3T 3 =P stance,z (nT)+βH s ;
[0191] Where β∈[1, 1.5] is the height coefficient, which indicates the proportion of the foot of the swinging robotic leg exceeding the step height during the nth step cycle.
[0192] Using the cubic spline interpolation method, the swing reference movement trajectory in the second direction in the second stage can be expressed as follows: swing,z (t n )=a0+a1t n +a2t n 2 +a3t n 3 ;
[0193] Among them, t n ∈[(1-α)T / 2, (1-α)T], and t n =t-nT, which represents the control time of the nth step cycle normalized by the step cycle T, P swing,z (t n ) represents the reference position of the swinging mechanical leg in the second direction at the control moment, a0...a3 represents the coefficient, which can be calculated according to the following constraints: P swing,z ((1-α)T / 2)=a0=P stance,z (nT)+βH s ; P swing,z((1-α)T)=a0+a1T+a2T 2 +a3T 3 =P stance,z ((n+1)T);
[0194] The swing reference movement trajectory in the second direction in the first stage is spliced with the swing reference movement trajectory in the second direction in the second stage to obtain the swing reference movement trajectory in the second direction.
[0195] 4. Obtain a swing reference movement trajectory of the swing mechanical leg group according to the swing reference movement trajectory of the swing mechanical leg group in the first direction and the swing reference movement trajectory of the swing mechanical leg group in the second direction.
[0196] When determining the swing reference movement trajectory of the swinging mechanical leg group, the embodiment of the present application comprehensively considers the swing reference movement trajectory of the swinging mechanical leg group in the first direction and the swing reference movement trajectory in the second direction, thereby improving the accuracy of the determined swing reference movement trajectory, which is conducive to the subsequent precise control of the robot.
[0197] In some embodiments, the swing reference movement trajectory is a combination of the swing reference movement trajectory of the swing robotic leg group in the first direction and the swing reference movement trajectory of the swing robotic leg group in the second direction.
[0198] Step S104 , controlling the robot to swing the swinging mechanical leg group in a first direction with the supporting mechanical leg group as support according to the center of mass reference movement trajectory and the swinging reference movement trajectory.
[0199] In some embodiments, the robot determines the reference position of the center of mass of the robot, the reference position of the swinging mechanical legs and the reference position of the supporting mechanical legs at each control moment based on the center of mass reference movement trajectory, the swing reference movement trajectory and the support reference movement trajectory. The robot controls each mechanical leg, body and waist to follow each reference position at each control moment in chronological order, so as to realize the swinging mechanical leg group in the first direction with the support of the supporting mechanical leg group, and then complete the movement task on the supporting surface.
[0200] For example, in the robot climbing stairs scenario, the robot follows the center of mass reference moving trajectory, the swing reference moving trajectory and the support reference moving trajectory, and the stair climbing task can be completed after n step cycles (n can be the number of steps at this time); in the robot crossing the shoulder scenario, the robot follows the center of mass reference moving trajectory, the swing reference moving trajectory and the support reference moving trajectory, and the shoulder crossing task can be completed after n step cycles (n can be 2 at this time, that is, two swing processes); in the robot crossing the shoulder scenario, the robot follows the center of mass reference moving trajectory, the swing reference moving trajectory and the support reference moving trajectory, and the pit crossing task can be completed after n step cycles (n can be 2 at this time, that is, two swing processes).
[0201] In some embodiments, referring to FIG. 17-20 , there are shown exemplary diagrams of the following process of various reference movement trajectories.
[0202] In Figure 17, curve 1701 represents the support reference trajectory of the supporting leg assembly in the first direction (i.e., the forward direction), and curve 1702 represents the actual trajectory of the supporting leg assembly in the first direction (i.e., the forward direction). Curve 1703 represents the support reference trajectory of the supporting leg assembly in the second direction (i.e., the vertical direction), and curve 1704 represents the actual trajectory of the supporting leg assembly in the second direction (i.e., the vertical direction). This shows that the robot can effectively follow the support reference trajectory, thereby achieving the support function of the supporting leg assembly.
[0203] In Figure 18, curve 1801 shows the reference trajectory of the swinging leg group in the first direction (i.e., the forward direction), while curve 1802 shows the actual trajectory of the swinging leg group in the first direction (i.e., the forward direction). Curve 1803 shows the reference trajectory of the swinging leg group in the second direction (i.e., the vertical direction), while curve 1804 shows the actual trajectory of the swinging leg group in the second direction (i.e., the vertical direction). Clearly, the robot can effectively follow the reference trajectory, achieving the swinging action of the swinging leg group.
[0204] In Figures 19 and 20, curve 1901 represents the ZMP reference trajectory in the first direction (i.e., the forward direction) corresponding to the ZMP, and curve 1902 represents the center of mass reference trajectory in the first direction corresponding to the center of mass. Curve 1903 represents the actual trajectory of the center of mass in the first direction corresponding to the center of mass. As can be seen, the robot can effectively follow the center of mass reference trajectory in the first direction to adjust the robot's center of mass.
[0205] In summary, the technical solution provided by the embodiments of the present application allows a robot having a first set of mechanical legs and a second set of mechanical legs to maintain a standing position by using one set of mechanical legs while swinging the other set of mechanical legs, thereby enabling the robot to move rapidly in a state of dynamic equilibrium (i.e., the robot's center of gravity can exceed the robot's support area), thereby improving the robot's mobility. Furthermore, controlling the robot's movement by alternating the swinging of the first and second sets of mechanical legs can further improve the robot's mobility.
[0206] In addition, the technical solution provided in the embodiments of the present application can enable the robot to have the ability to overcome obstacles, such as climbing stairs, crossing shoulders, crossing pits, etc., thereby improving the robot's ability to adapt to real environments.
[0207] The following are device embodiments of the present application, which can be used to implement the method embodiments of the present application. For details not disclosed in the device embodiments of the present application, please refer to the method embodiments of the present application.
[0208] Referring to Figure 21 , a block diagram of a robot control device provided by one embodiment of the present application is shown. The device has the function of implementing the above-described robot control method, which can be implemented by hardware or by hardware executing corresponding software. The device can be a computer device (such as a wheel-legged robot) as described above, or it can be housed in a computer device. As shown in Figure 21 , the device 2100 includes a standing state control module 2101 and a swinging state control module 2102.
[0209] The standing state control module 2101 is configured to stand on a support surface in an overlapping standing state, wherein the position error of each mechanical leg of the robot in the overlapping standing state in the first direction is zero.
[0210] The swing state control module 2102 is used to control the first mechanical leg group and the second mechanical leg group to swing alternately and move in the first direction on the support surface.
[0211] In some embodiments, the robot stops moving after n step cycles, where the step cycle indicates the time it takes for the first mechanical leg group or the second mechanical leg group to complete a swing, and n is a positive integer;
[0212] As shown in FIG. 22 , the swing state control module 2102 includes a mechanical leg allocation submodule 2102 a and a swing state control submodule 2102 b .
[0213] The mechanical leg allocation submodule 2102a is configured to determine, for each step cycle, from the first mechanical leg group and the second mechanical leg group, a supporting mechanical leg group and a swinging mechanical leg group corresponding to the step cycle.
[0214] The swing state control submodule 2102b is configured to swing the swinging mechanical leg group toward the first direction using the supporting mechanical leg group as support.
[0215] The swing state control submodule 2102b is further configured to stop swinging the swing mechanical leg group when the swing mechanical leg group reaches a desired position corresponding to the step cycle on the support surface.
[0216] In some embodiments, as shown in FIG22 , the swing state control submodule 2102 b includes: a support trajectory determination unit 2102 b 1 , a center of mass trajectory determination unit 2102 b 2 , a swing trajectory determination unit 2102 b 3 and a swing state control unit 2102 b 4 .
[0217] The support trajectory determination unit 2102b1 is used to determine the support reference movement trajectory of the supporting mechanical leg group based on the size information of the area corresponding to the step cycle on the support surface and the step length of the robot in the step cycle.
[0218] The center of mass trajectory determination unit 2102b2 is used to determine the center of mass reference movement trajectory of the robot based on the support reference movement trajectory of the supporting mechanical leg group, where the center of mass reference movement trajectory refers to the reference movement trajectory of the center of mass of the robot.
[0219] The swing trajectory determining unit 2102b3 is used to interpolate the swing reference movement trajectory of the swing mechanical leg group according to the initial position and the expected position corresponding to the swing mechanical leg group in the step cycle.
[0220] The swing state control unit 2102b4 is used to control the robot to swing the swing mechanical leg group in the first direction with the support of the supporting mechanical leg group according to the center of mass reference movement trajectory and the swing reference movement trajectory.
[0221] In some embodiments, the step cycle includes a swing cycle and a support cycle, the mechanical leg is in a swing state during the swing cycle, and the mechanical leg is in a support state during the support cycle; the center of mass trajectory determination unit 2102b2 is used to:
[0222] Determine a center of mass reference movement trajectory of the robot in a second direction based on the support reference movement trajectory, the support period ratio, and the constant height of the center of mass of the robot relative to the foot of the supporting mechanical leg group; wherein the support period ratio is used to indicate the proportion of time that the swinging mechanical leg of the robot is in the support state during each step cycle; during the swinging cycle, the center of mass reference movement trajectory in the second direction is obtained by interpolating the initial position and the end position in the support reference movement trajectory in combination with the constant height; during the support cycle, the center of mass reference movement trajectory in the second direction is determined by the end position in the support reference movement trajectory and the constant height, and the second direction is perpendicular to the first direction;
[0223] Determining a zero-moment point (ZMP) reference trajectory of the robot according to the support reference movement trajectory and the support period ratio; wherein, during the swing period, the ZMP reference trajectory is the same as a reference trajectory of a contact point between the support leg group and the support surface, and during the support period, the ZMP reference trajectory is obtained by interpolating an initial position and an end position in the support reference movement trajectory;
[0224] Determining a reference movement trajectory of the center of mass of the robot in the first direction according to the ZMP reference trajectory;
[0225] The reference movement trajectory of the center of mass of the robot is determined according to the reference movement trajectory of the center of mass of the robot in the second direction and the reference movement trajectory of the center of mass of the robot in the first direction.
[0226] In some embodiments, the center of mass trajectory determining unit 2102b2 is further configured to:
[0227] Constructing state variables of a discrete-time state equation of the robot based on the position of the ZMP, the position of the center of mass of the robot in the first direction, and the speed of the center of mass of the robot in the first direction;
[0228] constructing an objective function according to a reference position of the ZMP in the ZMP reference trajectory using a singular linear quadratic machine (SLQR) control method;
[0229] Determining a feedback gain matrix according to the objective function;
[0230] constructing control variables of the discrete-time state equation based on the feedback gain matrix, the center of mass position of the robot in the first direction, and the reference position of the ZMP in the ZMP reference trajectory;
[0231] The state variables and the control variables are brought into the discrete-time state equation, and a center-of-mass reference movement trajectory of the robot in the first direction is obtained through iteration.
[0232] In some embodiments, the swing trajectory determination unit 2102b3 is configured to:
[0233] Constructing a world coordinate system corresponding to the robot, wherein the world coordinate system is constructed with the initial contact point between the robot and the support surface as the origin, the first direction as the x-axis direction, and a second direction perpendicular to the first direction as the z-axis direction;
[0234] Using a spline curve interpolation method, interpolate the position component of the initial position in the first direction and the position component of the desired position in the first direction to obtain a swing reference movement trajectory of the swinging mechanical leg group in the first direction;
[0235] Using a spline curve interpolation method, interpolate the position component of the initial position in the second direction and the position component of the desired position in the second direction to obtain a swing reference movement trajectory of the swinging mechanical leg group in the second direction;
[0236] The swing reference movement trajectory of the swing mechanical leg group is obtained according to the swing reference movement trajectory of the swing mechanical leg group in the first direction and the swing reference movement trajectory of the swing mechanical leg group in the second direction.
[0237] In some embodiments, the support surface is a staircase comprising m steps, where m is a positive integer; the swing trajectory determining unit 2102b3 is further configured to:
[0238] For each of the steps, obtaining a sub-desired position of the swinging mechanical leg group at the step, wherein the foot of the swinging mechanical leg located at the sub-desired position is higher than the step in the second direction and does not contact the step in the first direction;
[0239] Interpolation is performed one by one in chronological order between the initial position, the sub-expected positions corresponding to the m steps, and the expected position to obtain a swing reference movement trajectory of the swing mechanical leg group.
[0240] In some embodiments, the step cycle includes a swing cycle and a support cycle, wherein the mechanical leg is in a swing state during the swing cycle and in a support state during the support cycle; the mechanical leg allocation submodule 2102a is configured to:
[0241] Acquire gait information of the robot based on the n stride cycles and the support period ratio of the robot, wherein the support period ratio is used to indicate the proportion of time that the swinging mechanical leg of the robot is in the support state in each stride cycle, and the gait information is used to indicate whether the mechanical leg of the robot is a swinging mechanical leg in each stride cycle;
[0242] According to the gait information, a supporting mechanical leg group and a swinging mechanical leg group corresponding to the step cycle are determined from the first mechanical leg group and the second mechanical leg group.
[0243] In some embodiments, the swing state control module 2102 is configured to increase the leg length of each supporting mechanical leg in the supporting mechanical leg group during the swing period of the step cycle while the swinging mechanical leg group is swinging in the first direction.
[0244] In some embodiments, the hip joints of the robot are coaxial.
[0245] In some embodiments, the robotic legs in the first robotic leg group move synchronously, the robotic legs in the second robotic leg group move synchronously, and the body of the robot remains vertical during the movement of the robot.
[0246] In summary, the technical solution provided by the embodiments of the present application allows a robot having a first set of mechanical legs and a second set of mechanical legs to maintain a standing position by using one set of mechanical legs while swinging the other set of mechanical legs, thereby enabling the robot to move rapidly in a state of dynamic equilibrium (i.e., the robot's center of gravity can exceed the robot's support area), thereby improving the robot's mobility. Furthermore, controlling the robot's movement by alternating the swinging of the first and second sets of mechanical legs can further improve the robot's mobility.
[0247] It should be noted that the apparatus provided in the above embodiments, when implementing its functions, is only illustrated by the division of the above functional modules. In actual applications, the above functions can be assigned to different functional modules as needed, that is, the internal structure of the device can be divided into different functional modules to complete all or part of the functions described above. In addition, the apparatus and method embodiments provided in the above embodiments are based on the same concept. The specific implementation process is detailed in the method embodiment and will not be repeated here.
[0248] Please refer to Figure 23, which shows a simplified block diagram of a computer device provided in one embodiment of the present application. The computer device may refer to any electronic device with data computing, processing, and storage capabilities.
[0249] In some embodiments, as shown in FIG23 , the computer device includes a processor 2301 and a memory 2302. The processor 2301 includes, but is not limited to, any one of the following: a CPU (Central Processing Unit), a GPU (Graphics Processing Unit), and an FPGA (Field Programmable Gate Array). The memory 2302 may include storage devices such as RAM (Random-Access Memory) and ROM (Read-Only Memory). The processor 2301 and the memory 2302 may be connected via a system bus.
[0250] In some embodiments, a computer program is stored in the memory 2302 , and the computer program is loaded and executed by the processor 2301 to implement the above-mentioned robot control method.
[0251] In some embodiments, a computer-readable storage medium is further provided, wherein the storage medium stores a computer program, and the computer program implements the above-mentioned robot control method when executed by a processor of a computer device.
[0252] In some embodiments, the computer-readable storage medium may include: ROM, RAM, SSD (Solid State Drives) or optical disks, etc. Among them, random access memory may include ReRAM (Resistance Random Access Memory) and DRAM (Dynamic Random Access Memory).
[0253] In some embodiments, a computer program product is further provided, comprising a computer program stored in a computer-readable storage medium. A processor of a computer device reads the computer program from the computer-readable storage medium and executes the computer program, causing the computer device to perform the above-described robot control method.
[0254] It should be noted that, in the embodiment of the present application, before collecting the relevant data of the user and during the process of collecting the relevant data of the user, a prompt interface, pop-up window or voice prompt information can be displayed. The prompt interface, pop-up window or voice prompt information is used to remind the user that its relevant data is currently being collected, so that the present application only starts to execute the relevant steps of obtaining the relevant data of the user after obtaining the confirmation operation issued by the user on the prompt interface or pop-up window. Otherwise (that is, when the confirmation operation issued by the user on the prompt interface or pop-up window is not obtained), the relevant steps of obtaining the relevant data of the user are terminated, that is, the relevant data of the user is not obtained. In other words, all user data collected by this application are processed strictly in accordance with the requirements of relevant national laws and regulations. The informed consent or separate consent of the personal information subject is obtained only with the consent and authorization of the user. Subsequent data use and processing behavior is carried out within the scope of authorization of laws and regulations and personal information subjects, and the collection, use and processing of relevant user data need to comply with the relevant laws, regulations and standards of relevant countries and regions. For example, the real environment, support surface, etc. involved in this application are all obtained with full authorization.
[0255] It should be understood that the "multiple" mentioned in this article refers to two or more. "And / or" describes the association relationship of associated objects, indicating that three relationships may exist. For example, A and / or B can represent three situations: A exists alone, A and B exist at the same time, and B exists alone. The character " / " generally indicates that the previous and subsequent associated objects are in an "or" relationship. In addition, the step numbers described in this article only illustrate a possible execution sequence between the steps. In some other embodiments, the above steps may not be executed in the order of the numbers, such as two steps with different numbers are executed at the same time, or two steps with different numbers are executed in the opposite order to the diagram. The embodiments of the present application do not limit this.
[0256] The above description is merely an exemplary embodiment of the present application and is not intended to limit the present application. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present application shall be included in the scope of protection of the present application.
Claims
1. A control method for a robot, the method being executed by a computer device, wherein the robot comprises a body, a first mechanical leg group and a second mechanical leg group connected to the body via a hip joint, at least one of the first mechanical leg group and the second mechanical leg group comprises at least two mechanical legs, and a rotation center of a hip joint corresponding to the first mechanical leg group and a rotation center of a hip joint corresponding to the second mechanical leg group are located in the same vertical plane; the method comprises: Standing on the support surface in an overlapping standing state, wherein the position error of each mechanical leg of the robot in the overlapping standing state in the first direction is zero; The first mechanical leg group and the second mechanical leg group are controlled to swing alternately and move toward the first direction on the supporting surface.
2. The method according to claim 1, wherein: The robot stops moving after n stepping cycles, where the stepping cycle is used to indicate the time length for the first mechanical leg group or the second mechanical leg group to complete a swing, and n is a positive integer; The controlling the first mechanical leg group and the second mechanical leg group to swing alternately and move in the first direction on the supporting surface includes: For each of the stepping cycles, determining a supporting mechanical leg group and a swinging mechanical leg group corresponding to the stepping cycle from the first mechanical leg group and the second mechanical leg group; Using the supporting mechanical leg group as support, swinging the swinging mechanical leg group toward the first direction; When the swinging mechanical leg group reaches the desired position corresponding to the stepping cycle on the support surface, the swinging mechanical leg group is stopped.
3. The method according to claim 2, wherein: The step of swinging the swinging mechanical leg group in the first direction with the support of the supporting mechanical leg group comprises: Determine the support reference movement trajectory of the supporting mechanical leg group according to the size information of the area corresponding to the step cycle on the supporting surface and the step length of the robot in the step cycle; Determine the reference movement trajectory of the center of mass of the robot according to the support reference movement trajectory of the support mechanical leg group, wherein the reference movement trajectory of the center of mass refers to the reference movement trajectory of the center of mass of the robot; interpolating a swing reference movement trajectory of the swing mechanical leg group according to the initial position and the expected position corresponding to the swing mechanical leg group in the step cycle; According to the mass center reference movement trajectory and the swing reference movement trajectory, the robot is controlled to swing the swing mechanical leg group toward the first direction with the support of the support mechanical leg group.
4. The method according to claim 3, wherein: The stepping cycle includes a swinging cycle and a supporting cycle, the mechanical leg in the swinging cycle is in a swinging state, and the mechanical leg in the supporting cycle is in a supporting state; The step of determining the center of mass reference movement trajectory of the robot according to the support reference movement trajectory of the support mechanical leg group comprises: According to the support reference movement trajectory, the support period ratio, and the constant height of the center of mass of the robot relative to the foot of the supporting mechanical leg group, determine the center of mass reference movement trajectory of the robot in the second direction; wherein the support period ratio is used to indicate the proportion of time that the swinging mechanical leg of the robot is in the support state in each step cycle, and within the swinging cycle, the center of mass reference movement trajectory in the second direction is obtained by combining the initial position and the end position in the support reference movement trajectory with the constant height interpolation, and within the support cycle, the center of mass reference movement trajectory in the second direction is determined by the end position in the support reference movement trajectory and the constant height, and the second direction is perpendicular to the first direction; According to the support reference movement trajectory and the support period ratio, the zero moment point ZMP reference trajectory of the robot is determined; wherein, within the swing period, the ZMP reference trajectory is the distance between the support mechanical leg group and the support surface. The reference trajectory of the contact point is the same, and during the support period, the ZMP reference trajectory is obtained by interpolating the initial position and the end position in the support reference movement trajectory; Determining a reference movement trajectory of the center of mass of the robot in the first direction according to the ZMP reference trajectory; The reference movement trajectory of the center of mass of the robot is determined according to the reference movement trajectory of the center of mass of the robot in the second direction and the reference movement trajectory of the center of mass of the robot in the first direction.
5. The method according to claim 4, wherein: Determining the reference movement trajectory of the center of mass of the robot in the first direction according to the ZMP reference trajectory includes: Constructing state variables of a discrete-time state equation of the robot based on the position of the ZMP, the center-of-mass position of the robot in the first direction, and the center-of-mass velocity of the robot in the first direction; Using a singular linear quadratic machine SLQR control method, constructing an objective function according to a reference position of the ZMP in the ZMP reference trajectory; According to the objective function, determining a feedback gain matrix; constructing control variables of the discrete-time state equation according to the feedback gain matrix, the center of mass position of the robot in the first direction, and the reference position of the ZMP in the ZMP reference trajectory; The state variable and the control variable are introduced into the discrete time state equation, and a reference movement trajectory of the center of mass of the robot in the first direction is obtained by iteration.
6. The method according to any one of claims 3 to 5, wherein: The step of interpolating a swing reference movement trajectory of the swing mechanical leg group according to the initial position and the expected position corresponding to the swing mechanical leg group in the step cycle includes: Constructing a world coordinate system corresponding to the robot, wherein the world coordinate system is constructed with the initial contact point between the robot and the support surface as the origin, the first direction as the x-axis direction, and a second direction perpendicular to the first direction as the z-axis direction; Using a spline curve interpolation method, interpolate the position component of the initial position in the first direction and the position component of the expected position in the first direction to obtain a swing reference movement trajectory of the swing mechanical leg group in the first direction; Using a spline curve interpolation method, interpolate the position component of the initial position in the second direction and the position component of the expected position in the second direction to obtain a swing reference movement trajectory of the swing mechanical leg group in the second direction; The swing reference movement trajectory of the swing mechanical leg group is obtained according to the swing reference movement trajectory of the swing mechanical leg group in the first direction and the swing reference movement trajectory of the swing mechanical leg group in the second direction.
7. The method according to any one of claims 3 to 6, wherein: The support surface is a staircase comprising m steps, where m is a positive integer; The step of interpolating a swing reference movement trajectory of the swing mechanical leg group according to the initial position and the expected position corresponding to the swing mechanical leg group in the step cycle includes: For each of the steps, obtaining a sub-expected position of the swing mechanical leg group at the step, wherein the foot of the swing mechanical leg located at the sub-expected position is higher than the step in the second direction and does not contact the step in the first direction; Interpolation is performed one by one in chronological order between the initial position, the sub-expected positions corresponding to the m steps respectively, and the expected position to obtain a swing reference movement trajectory of the swing mechanical leg group.
8. The method according to any one of claims 2 to 7, wherein: The stepping cycle includes a swinging cycle and a supporting cycle, the mechanical leg in the swinging cycle is in a swinging state, and the mechanical leg in the supporting cycle is in a supporting state; Determining the supporting mechanical leg corresponding to the step cycle from the first mechanical leg group and the second mechanical leg group Group and swinging mechanical leg group, including: According to the n step cycles and the support period ratio of the robot, the gait information of the robot is obtained, wherein the support period ratio is used to indicate the proportion of time that the swinging mechanical leg of the robot is in the support state in each step cycle, and the gait information is used to indicate whether the mechanical leg of the robot is a swinging mechanical leg in each step cycle; According to the gait information, a supporting mechanical leg group and a swinging mechanical leg group corresponding to the step cycle are determined from the first mechanical leg group and the second mechanical leg group.
9. The method according to any one of claims 2 to 8, wherein: The step of swinging the swinging mechanical leg group in the first direction with the support of the supporting mechanical leg group comprises: In the swinging cycle of the stepping cycle, when the swinging mechanical leg group swings toward the first direction, the leg length of each supporting mechanical leg in the supporting mechanical leg group is increased.
10. The method according to any one of claims 1 to 9, wherein: The hip joints of the robot are coaxial.
11. The method according to any one of claims 1 to 10, wherein: The mechanical legs in the first mechanical leg group move synchronously, the mechanical legs in the second mechanical leg group move synchronously, and the body of the robot remains vertical during the movement of the robot.
12. A control device for a robot, the robot comprising a body, a first mechanical leg group and a second mechanical leg group connected to the body via hip joints, at least one of the first mechanical leg group and the second mechanical leg group comprises at least two mechanical legs, and the rotation center of the hip joint corresponding to the first mechanical leg group and the rotation center of the hip joint corresponding to the second mechanical leg group are located in the same vertical plane; the device comprises: A standing state control module, used for standing on a support surface in an overlapping standing state, wherein a position error of each mechanical leg of the robot in the overlapping standing state in a first direction is zero; The swing state control module is used to control the first mechanical leg group and the second mechanical leg group to swing alternately and move in the first direction on the support surface.
13. A computer device, comprising a processor and a memory, wherein a computer program is stored in the memory, and the computer program is loaded and executed by the processor to implement the robot control method according to any one of claims 1 to 11.
14. A computer-readable storage medium, wherein a computer program is stored in the computer-readable storage medium, wherein the computer program is loaded and executed by a processor to implement the robot control method according to any one of claims 1 to 11.
15. A computer program product, comprising a computer program, wherein the computer program is stored in a computer-readable storage medium, and a processor reads and executes the computer program from the computer-readable storage medium to implement the robot control method according to any one of claims 1 to 11.
Citation Information
Patent Citations
Biped robot climbing stair gait planning method and device and robot
CN109202901A
Trajectory planning system and method for robot
CN112720462A
Robot and gait control method and device thereof
CN113134833A
Dynamic step climbing control method for biped robot
CN113721647A
Four-leg mobile robot
JP2005046950A
Cited By
Fixed-time robust encircling control method for multi-robot system under switching topology
CN119596708A
