Legged robot movement method, device, storage medium and electronic equipment
By acquiring and adjusting the torque value deviation during the movement of the foot robot and adjusting the movement curve in real time, the problem of relying on high-cost distance measuring sensors is solved, accurate movement under sensorless conditions is achieved, and cost and calculation amount is reduced.
Patent Information
- Application Number
- CN202111203941.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-10-15
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2041-10-15
AI Technical Summary
The existing foot-type robot mobile technology relies on high-cost fusion ranging sensors, and the sensor parameters are easily affected by the environment, making it difficult to ensure the accuracy of ranging data and difficult to adapt to the mobile needs of complex scenarios.
By obtaining and comparing the theoretical torque value and actual torque value of the foot-type robot during the movement process, adjusting the target movement curve in real time until the deviation is less than the preset threshold, the movement of the range-free sensor is realized, reducing costs and calculation amounts.
It realizes that foot-type robots can accurately reach their destination without relying on distance measuring sensors, reducing costs and computing volume, and improving the ability to adapt to complex environments.
Smart Images

Figure CN114237212B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of intelligent robots, and in particular to a method, device, storage medium and electronic device for moving a legged robot. Background Art
[0002] As more and more legged robots appear on the market, the requirements for legged robots to adapt to various scenarios are becoming more and more complex. In the technical solution to realize the mobile function of legged robots, multiple ranging sensors are usually used to assist the legged robots to complete the observation of the environment, and a moving curve that can avoid obstacles is set according to the observation results, and the legged robots are instructed to move based on the trajectory corresponding to the moving curve to reach the destination. For example, a fusion ranging sensor that integrates sensors such as multi-line laser radar, millimeter wave radar and binocular camera is used.
[0003] However, the solution of using fused ranging sensors will cause high costs. The parameters of the sensor will also have data deviations depending on the working environment and working time. For example, the coordinate distance data between the preset sensor and the center of mass of the legged robot deviates from the actual coordinate distance data caused by vibration. In addition, since the fused ranging sensor is greatly affected by the external environment, the accuracy of the ranging data is difficult to guarantee. For example, too high an intensity value of ambient light will affect the operation of the laser radar, while too low an intensity value of ambient light will affect the operation of the binocular camera, and too high an ambient temperature will also affect the operation of the millimeter wave radar. Summary of the invention
[0004] The embodiments of the present application provide a method, device, storage medium and electronic device for moving a legged robot, which can instruct the legged robot to move to a preset destination corresponding to a target moving curve without relying on a ranging sensor, effectively reducing costs and computational complexity. The technical solution is as follows:
[0005] In a first aspect, an embodiment of the present application provides a method for moving a legged robot, the method comprising:
[0006] Obtaining theoretical torque values and actual torque values of the legged robot during movement according to the target movement curve;
[0007] When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, the target movement curve is updated, and the steps of obtaining the theoretical torque value and the actual torque value of the footed robot during the movement according to the target movement curve are executed until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold.
[0008] In a second aspect, an embodiment of the present application provides a legged robot mobile device, characterized in that the device comprises:
[0009] An acquisition module is used to obtain a theoretical torque value and an actual torque value of the legged robot during the movement according to the target movement curve;
[0010] An updating module is used to update the target movement curve when the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, and execute the step of obtaining the theoretical torque value and the actual torque value of the footed robot during the movement according to the target movement curve until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold.
[0011] In a third aspect, an embodiment of the present application provides a computer storage medium, wherein the computer storage medium stores a plurality of instructions, wherein the instructions are suitable for being loaded by a processor and executing the above-mentioned method steps.
[0012] In a fourth aspect, an embodiment of the present application provides a legged robot, which may include: a processor and a memory; wherein the memory stores a computer program, and the computer program is suitable for being loaded by the processor and executing the above-mentioned method steps.
[0013] The beneficial effects brought about by the technical solutions provided by some embodiments of the present application include at least:
[0014] The present application obtains the deviation between the theoretical torque value and the actual torque value of the legged robot when it moves according to the target movement curve, further compares the deviation with a preset threshold, updates the target movement curve according to the comparison result, and adjusts it in real time until the legged robot reaches the preset destination. Therefore, there is no need to rely on ranging sensors to obtain ranging data, which greatly reduces the cost of the legged robot and reduces the amount of calculation of the legged robot. BRIEF DESCRIPTION OF THE DRAWINGS
[0015] In order to more clearly illustrate the implementation regulations of this application or the technical solutions in the prior art, the drawings required for use in the implementation regulations or the prior art description will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.
[0016] Figure 1 is a schematic diagram of a scene of movement of a legged robot provided in an embodiment of the present application;
[0017] Figure 2 It is a flow chart of a legged robot movement method provided in an embodiment of the present application;
[0018] Figure 3 is a schematic diagram of a method for adjusting the posture of a legged robot provided in an embodiment of the present application;
[0019] Figure 4 It is a flow chart of a legged robot movement method provided in an embodiment of the present application;
[0020] Figure 5 is a structural schematic diagram of a target movement curve provided in an embodiment of the present application;
[0021] Figure 6 It is a flow chart of a legged robot movement method provided in an embodiment of the present application;
[0022] Figure 7 It is a flow chart of a legged robot movement method provided in an embodiment of the present application;
[0023] Figure 8 is a movement schematic diagram of a legged robot provided in an embodiment of the present application moving according to a target movement curve;
[0024] Fig. 9 It is a flow chart of a legged robot movement method provided in an embodiment of the present application;
[0025] Fig. 10A is a schematic diagram of movement of a target point acquired after compensation provided by an embodiment of the present application;
[0026] Fig. 10B is another schematic diagram of movement of obtaining a target point after compensation provided in an embodiment of the present application;
[0027] Fig.11 This is a structural schematic diagram of another legged robot movement method provided in an embodiment of the present application.
[0028] Fig.12 is a structural schematic diagram of a legged robot mobile device provided in an embodiment of the present application;
[0029] Fig.13 It is a structural schematic diagram of a legged robot provided in an embodiment of the present application. DETAILED DESCRIPTION
[0030] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the implementation regulations described are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.
[0031] In the description of the present application, it should be understood that the terms "first", "second", etc. are only used for descriptive purposes and cannot be understood as indicating or implying relative importance. In the description of the present application, it should be noted that, unless otherwise clearly specified and limited, "including" and "having" and any of their variations are intended to cover non-exclusive inclusions. For example, a process, method, system, product or device that includes a series of steps or units is not limited to the listed steps or units, but optionally also includes steps or units that are not listed, or optionally also includes other steps or units inherent to these processes, methods, products or devices. For those of ordinary skill in the art, the specific meanings of the above terms in the present application can be understood in specific circumstances. In addition, in the description of the present application, unless otherwise specified, "multiple" refers to two or more. "And / or" describes the association relationship of associated objects, indicating that there can be three relationships, for example, A and / or B, which can represent: A exists alone, A and B exist at the same time, and B exists alone. The character " / " generally indicates that the associated objects before and after are an "or" relationship.
[0032] The present application is described in detail below with reference to specific embodiments.
[0033] like Figure 1 As shown, it is a schematic diagram of a scene of a legged robot movement provided by an embodiment of the present application. In this scene schematic diagram, as shown in the figure above, the legged robot 101 is a robot puppy, with four walking legs and other complicated mechanical structures, and has multiple parameters such as body height, body length, leg length, center of mass coordinates, etc., with built-in components such as servos, force sensors, motor encoders, etc., and can complete behaviors such as movement, jumping, and single leg lifting in multiple scenes. In this scene schematic diagram, as shown in the figure below, it is a schematic diagram of the legged robot 101 moving from the starting point 1022 corresponding to the target movement curve 102 to the preset destination 1021 based on the target movement curve 102, that is, on a multi-step staircase with a length of l and a height of h, the legged robot 101 climbs from the first step to the second step.
[0034] Understandably, Figure 1 The legged robots and legged robot movement scenarios shown are for illustration only. The present application also includes other types of legged robots, such as bipedal robots, tripod robots, etc., as well as other scenarios that require legged robots to move.
[0035] In the related art, a method is usually used to obtain a target moving curve 102 that avoids obstacles by fusing a ranging sensor to collect point cloud data of a scene, so that the legged robot 101 moves to a preset destination 1021 based on the target moving curve 102. However, the solution of using a fused ranging sensor will cause high costs, and the parameters of the sensor will also have data deviations depending on the working environment and working time. In addition, since the fused ranging sensor is greatly affected by the external environment, the accuracy of the ranging data is difficult to guarantee. Therefore, the present application proposes a legged robot movement method, which enables the legged robot to move to a preset destination 1021 without relying on a fused ranging sensor.
[0036] In one embodiment, Figure 2 The figure is a flow chart of a legged robot movement method provided by an embodiment of the present application, which can be implemented by a computer program and can be run on a legged robot movement device based on the von Neumann system. The computer program can be integrated into an application or run as an independent tool application.
[0037] Specifically, the legged robot moving method includes:
[0038] S201. Obtain theoretical torque values and actual torque values of the legged robot in a process of following a target movement curve.
[0039] The theoretical torque value can be understood as the theoretical torque value required by the processor of the legged robot to calculate the movement of the legged robot based on the target movement curve. In one embodiment, the calculation method can be a kinematic model constructed based on the structural information and motion information of the legged robot, and the theoretical torque value required for the target movement curve is calculated through the kinematic model.
[0040] The actual torque value can be understood as the actual torque value required to drive the legged robot to move when the legged robot moves according to the target movement curve. In one embodiment, the method for obtaining the actual torque value can be to collect the actual torque value through a drive motor set on the legged robot's moving foot or body, and the drive motor is used to drive the corresponding moving foot or body to move the legged robot.
[0041] In one embodiment, before obtaining the theoretical torque value and the actual torque value of the legged robot in the process of following the target movement curve, the posture of the legged robot needs to be adjusted.
[0042] Specifically, the legged robot includes at least one walking foot, and each walking foot corresponds to a foot end; the coordinate data corresponding to at least one foot end of the legged robot in the world coordinate system is obtained, and the angle between the contact plane formed by at least one foot end and the reference plane corresponding to the world coordinate system is calculated; the posture of the legged robot is adjusted until the value of the angle is zero.
[0043] like Figure 3 As shown, it is a schematic diagram of a method for adjusting the posture of a legged robot provided in an embodiment of the present application. In this schematic diagram, the upper figure is the legged robot before adjustment, and the lower figure is the legged robot after adjustment.
[0044] For example, according to the foot odometer information obtained by the fusion navigation system of the legged robot, that is, the information obtained from the forward kinematic model and gait planning module of the legged robot, the coordinate data corresponding to each walking foot in the world coordinate system are obtained, for example, the foot-end coordinate data of the first walking foot is (x1, y1, z1), the foot-end coordinate data of the second walking foot is (x2, y2, z2), the foot-end coordinate data of the third walking foot is (x3, y3, z3), and the foot-end coordinate data of the fourth walking foot is (x4, y4, z4); based on the least squares optimization algorithm, the contact planes 301 corresponding to the four foot ends are obtained; the angle α between the reference planes of the contact planes 301 in the world coordinate system is calculated; by adjusting the walking feet of the legged robot, the posture of the legged robot is further adjusted until the value of the angle is zero.
[0045] In this embodiment, by adjusting the posture of the legged robot to reduce the initial torque value of the legged robot before moving, it is beneficial to the reasonable planning of the target moving curve and improve the efficiency of the legged robot moving according to the target moving curve. For example, the actual torque value threshold of the legged robot is 30N·m, the actual torque value of the legged robot before adjusting the posture is 10N·m, and the actual torque value of the legged robot after adjusting the posture is only 2N·m.
[0046] Based on the legged robot after adjusting its posture, the theoretical torque value and the actual torque value of the legged robot in the process of following the target movement curve are obtained.
[0047] S202. When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, the target movement curve is updated, and the steps of obtaining the theoretical torque value and the actual torque value of the legged robot during the movement according to the target movement curve are executed until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold.
[0048] like Figure 1As shown, the theoretical torque value E1 corresponding to the target moving curve 102 is obtained by calculation, and the actual torque value E2 of the legged robot 101 during the movement according to the target moving curve 102 is obtained; the deviation E between the actual torque value E2 and the theoretical torque value E1 is obtained, that is, E=E2-E1; the deviation E is compared with the preset threshold value E0, when the deviation E is greater than the preset threshold value E0, it means that the legged robot 101 touches an obstacle during the movement, for example, the moving foot of the legged robot 101 touches a step.
[0049] In the embodiment of the present application, the deviation is the actual torque value minus the theoretical torque value.
[0050] It is understandable that according to Figure 1 As shown in FIG. 1 , the target moving curve is a moving curve determined based on the center of mass of the legged robot, that is, the starting point and the destination position of the target moving curve are both determined by the center of mass of the legged robot. In other embodiments, the target moving curve can also be a moving curve determined based on the foot end coordinate point of a moving foot of the legged robot. The determination method of the moving curve is the same as the above Figure 1 The method for determining the target moving curve shown is similar, so the present application also includes a method for obtaining the actual torque value and the theoretical torque value and performing deviation judgment based on the moving curve determined by the foot end coordinate point of a moving foot of a foot-type robot.
[0051] In addition, other figures of the present application also illustrate the target movement curve determined by the center of mass of the legged robot as an example, but all include the case where the target movement curve is determined based on the foot end coordinate point of a certain moving foot of the legged robot.
[0052] The target movement curve 102 is updated, and the step of obtaining the theoretical torque value and the actual torque value of the legged robot in the process of moving according to the target movement curve is performed. That is, according to the updated target movement curve 102, the theoretical torque value E is obtained. 1` The actual torque value E2` and the theoretical torque value E1` are further compared with the preset threshold value E0 until the deviation E is less than or equal to the preset threshold value E0, and the footed robot 101 moves to the preset target point 1021 according to the target movement curve 102. It can be understood that the target movement curve 102 is updated, but the corresponding preset target point 1021 remains unchanged.
[0053] The present application obtains the deviation between the theoretical torque value and the actual torque value of the legged robot when it moves according to the target movement curve, further compares the deviation with a preset threshold, updates the target movement curve according to the comparison result, and adjusts it in real time until the legged robot reaches the preset destination. Therefore, there is no need to rely on ranging sensors to obtain ranging data, which greatly reduces the cost of the legged robot and reduces the amount of calculation of the legged robot.
[0054] In one embodiment, Figure 4 The figure is a flow chart of a legged robot movement method provided by an embodiment of the present application, which can be implemented by a computer program and can be run on a legged robot movement device based on the von Neumann system. The computer program can be integrated into an application or run as an independent tool application.
[0055] Specifically, the legged robot moving method includes:
[0056] S201: Obtain a target movement curve according to a movement speed and at least two preset position points.
[0057] At least two preset position points are obtained according to the preset multiple scene models and the preset starting point and the preset destination corresponding to each scene model. For example, in the scene of climbing stairs, according to the stair design standard specified in the national standard, the height h of each step is preset to be 30 cm, the length l is preset to be 40 cm, and the preset destination of the legged robot is preset to be the middle point of each step, and the preset starting point is the edge of each step.
[0058] In one embodiment, the method for obtaining the target movement curve is: according to the movement speed and the control period, obtaining the displacement distance corresponding to each control period; according to the displacement distance and at least two preset position points, fitting the target movement curve.
[0059] like Figure 5 As shown, it is a structural schematic diagram of a target movement curve provided in an embodiment of the present application, and the schematic diagram includes: a target movement curve 501, a first preset position point 5011, a second preset position point 5012, a third preset position point 5013, a fourth preset position point 5014, and a fifth preset position point 5015.
[0060] The control period T can be understood as the period of sending control instructions to the legged robot. The control instructions include movement parameters instructing the movement of the action foot of the legged robot. For example, the movement parameters include the rotation angle, rotation angular velocity, translation speed, etc. of the action foot. The movement speed v includes the rotation angular velocity and translation speed.
[0061] In one embodiment, the moving speed is from a moving instruction sent by a control device bound to the legged robot, for example, a moving instruction sent by a remote controller bound to the legged robot. In another embodiment, the moving speed is from a preset of the legged robot.
[0062] The displacement distance X can be understood as the distance the moving foot moves in each control cycle T. The displacement distance X = control cycle T × moving speed v.
[0063] like Figure 5 As shown, it includes 5 preset position points. The fifth preset position point 5015 is the starting point of the target movement curve 501, that is, the position point of the center of mass of the legged robot in the world coordinate system, which is obtained through the odometer information of the legged robot; the third preset position point 5013 is the highest point; the first preset position point 5011 is the target point of the target movement curve 501, that is, the preset destination, corresponding to the middle point of the high-level step with a length of l and a height of h, and it is preset that the legged robot is close to the edge of the step at this time, which is further obtained through the fifth preset position point 5015; the second preset position point 5012 is the middle point between the third preset position point 5013 and the first preset position point 5011, and the fourth preset position point 5014 is the middle point between the third preset position point 5013 and the fifth preset position point 5015.
[0064] For example, the fifth preset position point 5015 (x, y, z) as the starting point is obtained through the odometer information of the legged robot, and the first preset position point 5011 (x+L / 2+l / 2, y, z+h) as the destination is obtained through the torso length L of the legged robot and the fact that the legged robot is located on the edge of the steps; the third preset position point (x', y', z') as the highest point is obtained through prior experience and the kinematic parameters of the legged robot, such as the length of the moving foot, the rotation angle threshold of the moving foot, etc.; based on the third preset position point 5013, the first preset position point 5011 and the fifth preset position point 5015, the second preset position point 5012 and the fourth preset position point 5014 are obtained.
[0065] The Bezier curve is fitted according to at least two preset position points to obtain an initial target movement curve. The initial target movement curve is further interpolated according to the displacement distance X to obtain a final target movement curve 501. Therefore, the target movement curve 501 includes n displacement distances X, which corresponds to n control cycles T.
[0066] It can be understood that the present application also includes other methods for obtaining the target movement curve based on at least two preset position points. For example, there are two preset position points, namely the starting point of the legged robot obtained according to the odometer information, and the position point corresponding to the preset destination.
[0067] S202: Obtain theoretical torque values and actual torque values of the legged robot in a process of following the target movement curve.
[0068] The working principle and implementation of step S202 refer to the above step S101 and will not be described again here.
[0069] S203. When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, the target movement curve is updated, and the steps of obtaining the theoretical torque value and the actual torque value of the legged robot during the movement according to the target movement curve are executed until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold.
[0070] The working principle and steps of step S203 refer to the above step S102 and will not be repeated here.
[0071] The present application obtains a target movement curve through movement speed and at least two preset position points, wherein the at least two preset position points are obtained based on a large amount of environment modeling without using a fusion ranging sensor, thereby reducing costs, increasing calculation speed, and improving the response speed of the legged robot.
[0072] The present application obtains the deviation between the theoretical torque value and the actual torque value of the legged robot when it moves according to the target movement curve, further compares the deviation with a preset threshold, updates the target movement curve according to the comparison result, and adjusts it in real time until the legged robot reaches the preset destination. Therefore, there is no need to rely on ranging sensors to obtain ranging data, which greatly reduces the cost of the legged robot and reduces the amount of calculation of the legged robot.
[0073] In one embodiment, Figure 6 The figure is a flow chart of a legged robot movement method provided by an embodiment of the present application, which can be implemented by a computer program and can be run on a legged robot movement device based on the von Neumann system. The computer program can be integrated into an application or run as an independent tool application.
[0074] Specifically, the legged robot moving method includes:
[0075] S301, obtaining the theoretical torque value and the actual torque value corresponding to each control cycle of the legged robot.
[0076] In the embodiment of the present application, the process of the legged robot moving according to the target movement curve corresponds to at least one control cycle. The control cycle can be understood as a cycle of sending control instructions to the legged robot, and the control instructions include movement parameters instructing the action of the action foot of the legged robot.
[0077] like Figure 5The target movement curve 501 shown corresponds to n control cycles T. For example, the duration of each control cycle T is 0.5 seconds, and the movement time corresponding to the target movement curve 501 is 30 seconds, that is, the target movement curve 501 corresponds to 60 control cycles T.
[0078] The target movement curve 501 corresponds to n control cycles, and the n control cycles include: a first control cycle T1, a second control cycle T2, a third control cycle T3, a fourth control cycle T4, and so on.
[0079] Obtain the theoretical torque value and actual torque value corresponding to each control cycle of the footed robot, that is, obtain the theoretical torque value E1 corresponding to the first control cycle T1 1 And the actual torque value E2 1 , obtain the theoretical torque value E1 corresponding to the second control period T2 2 And the actual torque value E2 2 , obtain the theoretical torque value E1 corresponding to the third control period T3 3 And the actual torque value E2 3 , obtain the theoretical torque value E1 corresponding to the fourth control period T4 4 And the actual torque value E2 4 .
[0080] S302. When the deviation between the actual torque value and the theoretical torque value corresponding to the target control cycle is greater than a preset threshold, the target movement curve is updated, and the steps of obtaining the theoretical torque value and the actual torque value corresponding to each control cycle of the legged robot are executed until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold.
[0081] The at least one control cycle includes at least one target control cycle.
[0082] In one embodiment, after each control cycle T, the deviation between the actual torque value and the theoretical torque value is obtained, and the deviation is compared with a preset threshold. When it is detected that the deviation corresponding to a certain control cycle is greater than the preset threshold, the control cycle is determined to be the target control cycle. Therefore, the target movement curve is updated, and the steps of obtaining the theoretical torque value and the actual torque value corresponding to each control cycle of the legged robot are performed until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold.
[0083] In this embodiment, the method for determining whether to update the target movement is helpful to improving the response speed of the legged robot and improving the sensitivity of the legged robot to prevent the legged robot from being damaged by obstacles.
[0084] In another embodiment, after each control cycle T, the deviation between the actual torque value and the theoretical torque value is obtained, and the deviation is compared with a preset threshold. When it is detected that the deviation corresponding to a certain control cycle is greater than the preset threshold, the control cycle is determined to be the target control cycle, and the target movement curve is updated only when the target control cycle reaches M in total.
[0085] In this embodiment, the method for determining whether to update the target movement is helpful to improving the accuracy of the legged robot's determination of whether to hit a wall, and improving the working reliability of the legged robot.
[0086] In another embodiment, the deviation between the actual torque value and the theoretical torque value corresponding to each control cycle is obtained in turn, and when it is detected that the deviation corresponding to N consecutive target control cycles is greater than a preset threshold, the target movement curve is updated.
[0087] For example, the target movement curve 501 corresponds to 60 control cycles, and the control cycle in which the deviation between the actual torque value and the theoretical torque value is greater than the preset threshold is the target control cycle. When five consecutive target control cycles are detected, it is determined that the legged robot hits the wall, and the target movement curve is updated. And the steps of obtaining the theoretical torque value and the actual torque value corresponding to each control cycle of the legged robot are performed until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold.
[0088] In the embodiment of the present application, by detecting whether there are N consecutive target control cycles whose corresponding deviations are greater than a preset threshold, the target movement curve is updated. The judgment method is more practical, has high accuracy in judging whether the legged robot hits a wall, and effectively protects the legged robot from colliding with obstacles.
[0089] The present application obtains the deviation between the theoretical torque value and the actual torque value of the legged robot when it moves according to the target movement curve, further compares the deviation with a preset threshold, updates the target movement curve according to the comparison result, and adjusts it in real time until the legged robot reaches the preset destination. Therefore, there is no need to rely on ranging sensors to obtain ranging data, which greatly reduces the cost of the legged robot and reduces the amount of calculation of the legged robot.
[0090] In one embodiment, Figure 7 The figure is a flow chart of a legged robot movement method provided by an embodiment of the present application, which can be implemented by a computer program and can be run on a legged robot movement device based on the von Neumann system. The computer program can be integrated into an application or run as an independent tool application.
[0091] Specifically, the legged robot moving method includes:
[0092] S401. According to the target movement curve, obtain the theoretical torque value and the actual torque value of each driving motor on the walking foot of the legged robot corresponding to the target movement curve.
[0093] The legged robot comprises at least one walking leg, and each walking leg comprises at least one driving motor.
[0094] like Figure 8 As shown, it is a movement schematic diagram of a legged robot provided by an embodiment of the present application moving according to a target movement curve, and the movement schematic diagram includes: a legged robot, the legged robot corresponds to four walking feet, and the four walking feet include: a first walking foot 801, a second walking foot 802, a third walking foot, and a fourth walking foot. Each walking foot corresponds to two drive motors, the first walking foot 801 corresponds to a drive motor 8011 and a drive motor 8012, the second walking foot 802 corresponds to a drive motor 8021 and a drive motor 8022, and the drive motors of the third walking foot and the fourth walking foot are not shown in the figure.
[0095] Understandably, Figure 8 The legged robot shown and the number of drive motors corresponding to each walking leg are for illustration only. The present application also includes other types of legged robots, and there is no limitation on the type and number of drive motors corresponding to each walking leg.
[0096] According to the target movement curve, the theoretical torque value and the actual torque value of each driving motor on the walking foot of the legged robot corresponding to the target movement curve are obtained.
[0097] like Figure 8 As shown, at this time, the legged robot executes the target movement curve 102 based on the first walking foot 801, Figure 8 The target movement curve 102 shown corresponds to a target movement curve based on the center of mass of the legged robot as the starting point 1022 and the position point 1021 corresponding to the destination. The above-mentioned first walking foot 801 executes the target movement curve 102, which can be understood as the first walking foot 801 moving according to the moving trajectory of the sub-movement curve, wherein the sub-movement curve has the same curve shape as the target movement curve 102 but takes the foot end coordinate point of the first walking foot 801 as the starting point and the position point corresponding to the destination.
[0098] The actual torque value and the theoretical torque value when the driving motor 8011 of the walking foot 801 executes the corresponding target movement curve 102 , and the actual torque value and the theoretical torque value when the driving motor 8012 of the walking foot 801 executes the corresponding target movement curve 102 are obtained.
[0099] S402. When the deviation between the actual torque value and the theoretical torque value corresponding to at least one target driving motor is greater than a preset threshold, the target movement curve is updated, and the steps of obtaining the theoretical torque value and the actual torque value of each driving motor on the walking foot corresponding to the target movement curve executed by the legged robot are executed.
[0100] Wherein, the at least one drive motor includes at least one target drive motor.
[0101] For example, the actual torque value and the theoretical torque value when the driving motor 8011 of the walking foot 801 executes the corresponding target moving curve 102, and the actual torque value and the theoretical torque value when the driving motor 8012 of the walking foot 801 executes the corresponding target moving curve 102 are obtained; when the deviation corresponding to the driving motor 8011 is greater than the preset threshold, the driving motor 8011 is determined to be the target driving motor, the target moving curve is updated, and the steps of obtaining the theoretical torque value and the actual torque value of each driving motor on the walking foot corresponding to the legged robot executing the target moving curve are executed.
[0102] It is understandable that the present application does not limit the number of target drive motors. For example, only when it is detected that the deviation corresponding to the drive motor 8011 is greater than the preset threshold, and the deviation corresponding to the drive motor 8012 is greater than the preset threshold, the target movement curve is updated, and the step of obtaining the theoretical torque value and the actual torque value of each drive motor on the walking foot corresponding to the legged robot executing the target movement curve is performed.
[0103] In the embodiment of the present application, whether the legged robot hits the wall is determined by the deviation corresponding to the driving motor, so that the target movement curve is updated, which fully considers the various wall collision situations that may occur in the legged robot in a complex environment and effectively reduces the possibility of misjudgment.
[0104] In one embodiment, according to at least one control cycle corresponding to the legged robot's movement in accordance with the target movement curve, the theoretical torque value and the actual torque value of each driving motor on the walking foot of the legged robot corresponding to the target movement curve in each control cycle are obtained; when it is detected that N consecutive deviations among all deviations corresponding to at least one target driving motor are greater than a preset threshold, the target movement curve is updated.
[0105] For example, Figure 8 The target movement curve 102 shown in FIG. Figure 5 The target movement curve 501 shown, that is, the target movement curve 102 corresponds to n control cycles T.
[0106] When the action foot 801 executes the target movement curve 102, the corresponding theoretical torque value and actual torque value of the driving motor 8011 in each control cycle are obtained. For example, the theoretical torque value E corresponding to the driving motor 8011 in the first control cycle T1 is 11 1 and the actual torque value E 21 2 , the theoretical torque value E corresponding to the driving motor 8011 in the second control period T2 11 2 and the actual torque value E 21 2 , the theoretical torque value E corresponding to the driving motor 8011 in the third control period T3 11 3 and the actual torque value E 21 3 .
[0107] When the action foot 801 executes the target movement curve 102, the corresponding theoretical torque value and actual torque value of the driving motor 8012 in each control cycle are obtained. For example, the theoretical torque value E corresponding to the driving motor 8012 in the first control cycle T1 is 12 1 and the actual torque value E 22 2 , the theoretical torque value E corresponding to the driving motor 8012 in the second control period T2 12 2 and the actual torque value E 22 2 , the theoretical torque value E corresponding to the driving motor 8012 in the third control cycle T3 12 3 and the actual torque value E 22 3 .
[0108] When it is detected that N consecutive deviations among all deviations corresponding to at least one target drive motor are greater than a preset threshold, the target movement curve is updated. That is, when N consecutive deviations among all deviations corresponding to a certain drive motor are greater than the preset threshold, the drive motor is determined to be the target drive motor.
[0109] For example, the drive motor 8011 corresponds to 60 control cycles and the deviation between the actual torque value and the theoretical torque value in each control cycle. When 5 consecutive deviations are greater than the threshold, the drive motor 8011 is determined to be the target drive motor.
[0110] It is understandable that the present application does not limit the number of target drive motors.
[0111] In an embodiment of the present application, whether the legged robot hits a wall is determined by the corresponding deviation of the driving motor in each control cycle, thereby updating the target movement curve. This fully takes into account various wall collision situations that may occur in a complex environment for the legged robot, and effectively reduces the possibility of misjudgment.
[0112] The present application obtains the deviation between the theoretical torque value and the actual torque value of the legged robot when it moves according to the target movement curve, further compares the deviation with a preset threshold, updates the target movement curve according to the comparison result, and adjusts it in real time until the legged robot reaches the preset destination. Therefore, there is no need to rely on ranging sensors to obtain ranging data, which greatly reduces the cost of the legged robot and reduces the amount of calculation of the legged robot.
[0113] In one embodiment, Fig. 9 The figure is a flow chart of a legged robot movement method provided by an embodiment of the present application, which can be implemented by a computer program and can be run on a legged robot movement device based on the von Neumann system. The computer program can be integrated into an application or run as an independent tool application.
[0114] Specifically, the legged robot moving method includes:
[0115] S501, obtaining a theoretical torque value and an actual torque value of the legged robot in a process of following a target movement curve.
[0116] The working principle and implementation of step S501 refer to the above step S101 and will not be described in detail here.
[0117] S502: When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, compensate a target point among the at least two moving points corresponding to the target moving curve.
[0118] In one embodiment, the present application compensates the target point through step S502A. Specifically, step S502A includes S5021A and S5022A.
[0119] S5021A, instruct the legged robot to return to the starting point of the target movement curve.
[0120] The target point is the starting point of the target movement curve.
[0121] like Fig. 10A 102 is a schematic diagram of obtaining a target point after compensation provided by an embodiment of the present application. When the moving foot of the legged robot hits a wall while moving according to the target moving curve 102, the moving foot is instructed to return to the foot end position point of the moving foot corresponding to the starting point 1022.
[0122] S5022A, instructing the legged robot to move a preset distance in a preset direction, and obtaining a starting point corresponding to the legged robot after the movement.
[0123] like Fig. 10A As shown, the legged robot at the starting point 1022 hits the wall, indicating that the legged robot is translated 5 cm behind, that is, 5 cm in the positive direction of the x-axis in the world coordinate system, where the positive direction of the x-axis in the world coordinate system is the preset direction and 5 cm is the preset distance. According to the starting point 1022 before the movement and the odometer information of the legged robot, the starting point 1001 corresponding to the legged robot after the movement is obtained.
[0124] It is understandable that the present application also includes other settings of preset directions and preset distances, and the above are only examples.
[0125] In another embodiment, the present application compensates the target point through step S502B.
[0126] S502B, instructing the legged robot at the target point to move a preset distance in a preset direction, and obtaining the target point corresponding to the moved legged robot.
[0127] The target point is a moving point corresponding to when the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold value during the movement of the legged robot according to the target movement curve.
[0128] like Fig. 10B As shown, another schematic diagram of obtaining the movement of the compensated target point provided by an embodiment of the present application. The target movement curve 102 corresponds to n control cycles, and a movement point corresponds to the end of each control cycle. The theoretical torque value and the actual torque value of each driving motor on the walking foot 801 corresponding to the target movement curve 102 are obtained when the legged robot executes the target movement curve 102. When it is detected that there are N consecutive deviations greater than a preset threshold among all deviations corresponding to at least one target driving motor, the movement point 1023 corresponding to the moving foot at this moment is obtained.
[0129] Instruct the legged robot at the target point to move in a preset direction and a preset distance, and obtain the target point corresponding to the moved legged robot. Fig. 10B As shown, based on the PID control principle, the walking foot 801 is instructed to move from the target point 1023 to the position point 1002, and the target point 1002 corresponding to the legged robot after the movement is obtained according to the starting point 1023 before the movement and the odometer information of the legged robot.
[0130] S503, updating the target movement curve according to the compensated target point, and executing the step of obtaining the theoretical torque value and the actual torque value of the legged robot in the process of following the target movement curve, until the deviation between the actual torque value and the theoretical torque value is less than or equal to a preset threshold.
[0131] like Fig. 10A As shown, according to the new starting point 1001, and other preset position points and moving speeds, such as the position point 1021 corresponding to the preset destination, the target moving curve is updated, that is, the corresponding updated target moving curve 1000 is obtained.
[0132] like Fig. 10B As shown, according to the new target point 1002, and other preset position points and moving speeds, such as the position point 1021 corresponding to the preset destination, the target movement curve is updated, that is, the corresponding target movement curve 1003 after the update is obtained.
[0133] According to the updated target movement curve, the step of obtaining the theoretical torque value and the actual torque value of the legged robot in the process of following the target movement curve is performed until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold value. In other words, according to the corresponding target movement curve after the update, the legged robot is instructed to move to the preset destination.
[0134] The present application further updates the target movement curve by compensating the target point, that is, continuously updates the target movement curve by repeated trial and error until the legged robot moves to the preset destination. The updating method is simple.
[0135] The present application obtains the deviation between the theoretical torque value and the actual torque value of the legged robot when it moves according to the target movement curve, further compares the deviation with a preset threshold, updates the target movement curve according to the comparison result, and adjusts it in real time until the legged robot reaches the preset destination. Therefore, there is no need to rely on ranging sensors to obtain ranging data, which greatly reduces the cost of the legged robot and reduces the amount of calculation of the legged robot.
[0136] In one embodiment, Fig.11 The figure is a flow chart of a legged robot movement method provided by an embodiment of the present application, which can be implemented by a computer program and can be run on a legged robot movement device based on the von Neumann system. The computer program can be integrated into an application or run as an independent tool application.
[0137] Specifically, the legged robot moving method includes:
[0138] S601: Obtain a target movement curve according to a movement speed and at least two preset position points.
[0139] According to the moving speed and the control period, the displacement distance corresponding to each control period is obtained; according to the displacement distance and at least two preset position points, a target movement curve is fitted.
[0140] The working principle and implementation of step S601 refer to the above step S201 and will not be repeated here.
[0141] S602: According to the target movement curve, obtain the theoretical torque value and the actual torque value of each driving motor on the walking foot of the legged robot corresponding to the target movement curve.
[0142] According to at least one control cycle corresponding to the legged robot's movement in accordance with the target movement curve, the theoretical torque value and the actual torque value of each driving motor on the walking foot of the legged robot corresponding to the target movement curve in each control cycle are obtained.
[0143] The working principle and implementation of step S602 refer to the above step S401 and will not be described in detail here.
[0144] S603: There is at least one target driving motor whose actual torque value and theoretical torque value have a deviation greater than a preset threshold.
[0145] The working principle and implementation of step S603 refer to the above step S402 and will not be described again here.
[0146] S604: Instruct the legged robot to return to the starting point of the target movement curve.
[0147] The working principle and implementation of step S604 refer to the above step S5021A and will not be repeated here.
[0148] S605 , instructing the legged robot to move a preset distance in a preset direction, and obtaining a starting point corresponding to the moved legged robot.
[0149] The working principle and implementation of step S605 refer to the above step S5022A and will not be repeated here.
[0150] S606. Update the target movement curve according to the compensated target point, and execute the steps of obtaining the theoretical torque value and the actual torque value of the legged robot in the process of following the target movement curve, until the deviation between the actual torque value and the theoretical torque value is less than or equal to a preset threshold.
[0151] The working principle and implementation of step S606 refer to the above step S503 and will not be described again here.
[0152] The present application obtains the deviation between the theoretical torque value and the actual torque value of the legged robot when it moves according to the target movement curve, further compares the deviation with a preset threshold, updates the target movement curve according to the comparison result, and adjusts it in real time until the legged robot reaches the preset destination. Therefore, there is no need to rely on ranging sensors to obtain ranging data, which greatly reduces the cost of the legged robot and reduces the amount of calculation of the legged robot.
[0153] The present application also provides a computer storage medium, which can store multiple instructions, and the instructions are suitable for being loaded and executed by a processor as described above. Figure 1 - Fig.11 The legged robot movement method of the implementation regulations shown in the figure can be found in the specific implementation process. Figure 1 - Fig.11 The specific description of the implementation regulations shown will not be repeated here.
[0154] The present application also provides a computer program product, which stores at least one instruction, and the at least one instruction is loaded and executed by the processor as described above. Figure 1 - Fig.11 The legged robot movement method of the implementation regulations shown in the figure can be found in the specific implementation process. Figure 1 - Fig.11 The specific description of the implementation regulations shown will not be repeated here.
[0155] The following are device embodiments of the present application, which can be used to execute 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.
[0156] See also Fig.12 , which shows a schematic diagram of the structure of a legged robot mobile device provided by an exemplary embodiment of the present application. The legged robot mobile device can be implemented as all or part of the device through software, hardware or a combination of both. The legged robot mobile device includes an acquisition module 1201 and an update module 1202.
[0157] An acquisition module 1201 is used to acquire a theoretical torque value and an actual torque value of the legged robot during the movement according to the target movement curve;
[0158] The updating module 1202 is used to update the target movement curve when the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, and execute the step of obtaining the theoretical torque value and the actual torque value of the footed robot during the movement according to the target movement curve until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold.
[0159] In one or more embodiments, the legged robotic mobile device further comprises:
[0160] The curve acquisition module is used to acquire a target movement curve according to a movement speed and at least two preset position points.
[0161] In one or more embodiments, the curve acquisition module includes:
[0162] The displacement acquisition unit is used to acquire the displacement distance corresponding to each control period according to the moving speed and the control period;
[0163] The curve fitting unit is used to fit a target movement curve according to the displacement distance and at least two preset position points.
[0164] In one or more embodiments, the process of the legged robot moving according to the target movement curve corresponds to at least one control cycle;
[0165] The acquisition module 1201 includes:
[0166] A cycle acquisition unit, used to acquire a theoretical torque value and an actual torque value corresponding to each control cycle of the legged robot;
[0167] The update module 1202 includes:
[0168] A period update unit is used to update the target movement curve when the deviation between the actual torque value and the theoretical torque value corresponding to the target control period is greater than a preset threshold, and to obtain the theoretical torque value and the actual torque value corresponding to each control period of the legged robot, wherein the at least one control period includes at least one target control period.
[0169] In one or more embodiments, the period updating unit is further used to sequentially obtain the deviation between the actual torque value and the theoretical torque value corresponding to each of the control periods;
[0170] When it is detected that the deviations corresponding to N consecutive target control periods are greater than a preset threshold, the target movement curve is updated.
[0171] In one or more embodiments, the legged robot comprises at least one walking foot, and each of the walking feet comprises at least one driving motor;
[0172] The acquisition module 1201 includes:
[0173] A walking foot acquisition unit, used for acquiring, according to the target movement curve, a theoretical torque value and an actual torque value of each driving motor on the walking foot of the foot-type robot corresponding to the target movement curve;
[0174] The update module 1202 includes:
[0175] A walking foot update unit is used to update the target movement curve when the deviation between the actual torque value and the theoretical torque value corresponding to at least one target driving motor is greater than a preset threshold, and execute the steps of obtaining the theoretical torque value and the actual torque value of each driving motor on the walking foot of the legged robot corresponding to the target movement curve, wherein the at least one driving motor includes the at least one target driving motor.
[0176] In one or more embodiments, the walking foot acquisition unit is used to:
[0177] According to at least one control cycle corresponding to the movement of the legged robot in accordance with the target movement curve, obtaining a theoretical torque value and an actual torque value of each driving motor on the walking foot of the legged robot corresponding to the target movement curve in each control cycle;
[0178] The walking foot update unit is used to:
[0179] When it is detected that N consecutive deviations among all deviations corresponding to at least one target driving motor are greater than a preset threshold, the target movement curve is updated.
[0180] In one or more embodiments, the target movement curve corresponds to at least two movement points;
[0181] The update module 1202 includes:
[0182] a compensation unit, configured to compensate a target point among the at least two moving points corresponding to the target moving curve when a deviation between the actual torque value and the theoretical torque value is greater than a preset threshold;
[0183] An updating unit is used to update the target movement curve according to the compensated target point.
[0184] In one or more embodiments, the target point is a starting point of the target movement curve;
[0185] Compensation unit for:
[0186] Instructing the legged robot to return to the starting point of the target movement curve;
[0187] Instructing the legged robot to move a preset distance in a preset direction, and obtaining a starting point corresponding to the moved legged robot;
[0188] The updating unit is used to update the target movement curve according to the starting point corresponding to the moved foot-type robot.
[0189] In one or more embodiments, the target point is a moving point corresponding to when the deviation between the actual torque value and the theoretical torque value is greater than the preset threshold value during the movement of the footed robot according to the target movement curve;
[0190] A compensation unit, used to instruct the legged robot at the target point to move a preset distance in a preset direction, and obtain the target point corresponding to the moved legged robot;
[0191] The updating unit is used to update the target movement curve according to the target point corresponding to the moved foot-type robot.
[0192] In one or more embodiments, the legged robot includes at least one walking foot, each walking foot corresponding to a foot end;
[0193] The foot-type robot moving device also includes:
[0194] A coordinate acquisition module, used to acquire the coordinate data corresponding to at least one foot end of the foot-type robot in the world coordinate system, and calculate the angle between the contact plane formed by the at least one foot end and the reference plane corresponding to the world coordinate system;
[0195] The posture adjustment module is used to adjust the posture of the legged robot until the value of the angle is zero.
[0196] The present application obtains the deviation between the theoretical torque value and the actual torque value of the legged robot when it moves according to the target movement curve, further compares the deviation with a preset threshold, updates the target movement curve according to the comparison result, and adjusts it in real time until the legged robot reaches the preset destination. Therefore, there is no need to rely on ranging sensors to obtain ranging data, which greatly reduces the cost of the legged robot and reduces the amount of calculation of the legged robot.
[0197] See also Fig.13 , which is a schematic diagram of the structure of a legged robot according to an embodiment of the present application. As shown in FIG. 11 , the legged robot 1300 may include: at least one processor 1301 , at least one network interface 1304 , a user interface 1303 , a memory 1305 , and at least one communication bus 1302 .
[0198] The communication bus 1302 is used to realize the connection and communication between these components.
[0199] The user interface 1303 may include a display screen (Display) and a camera (Camera), and the optional user interface 1303 may also include a standard wired interface and a wireless interface.
[0200] The network interface 1304 may optionally include a standard wired interface or a wireless interface (such as a WI-FI interface).
[0201] Among them, the processor 1301 may include one or more processing cores. The processor 1301 uses various interfaces and lines to connect various parts within the entire server 1300, and executes various functions and processes data of the server 1300 by running or executing instructions, programs, code sets or instruction sets stored in the memory 1305, and calling data stored in the memory 1305. Optionally, the processor 1301 can be implemented in at least one hardware form of digital signal processing (Digital Signal Processing, DSP), field programmable gate array (Field-Programmable Gate Array, FPGA), and programmable logic array (Programmable Logic Array, PLA). The processor 1301 can integrate one or a combination of a central processing unit (Central Processing Unit, CPU), a graphics processing unit (Graphics Processing Unit, GPU) and a modem. Among them, the CPU mainly processes the operating system, user interface and application programs; the GPU is responsible for rendering and drawing the content to be displayed on the display screen; and the modem is used to process wireless communications. It can be understood that the above-mentioned modem may not be integrated into the processor 1301, and it can be implemented separately through a chip.
[0202] Among them, the memory 1305 may include a random access memory (Random Access Memory, RAM) and may also include a read-only memory (Read-Only Memory). Optionally, the memory 1305 includes a non-transitory computer-readable storage medium. The memory 1305 can be used to store instructions, programs, codes, code sets or instruction sets. The memory 1305 may include a program storage area and a data storage area, wherein the program storage area may store instructions for implementing an operating system, instructions for at least one function (such as a touch function, a sound playback function, an image playback function, etc.), instructions for implementing the above-mentioned method implementation regulations, etc.; the data storage area may store data involved in the above-mentioned method embodiments, etc. The memory 1305 may also be optionally at least one storage device located away from the aforementioned processor 1301. As Fig.13 As shown, the memory 1305 as a computer storage medium may include an operating system, a network communication module, a user interface module, and a legged robot mobile application.
[0203] exist Fig.13 In the legged robot 1300 shown, the user interface 1303 is mainly used to provide an input interface for the user and obtain the data input by the user; and the processor 1301 can be used to call the legged robot mobile application stored in the memory 1305, and specifically perform the following operations:
[0204] Obtaining theoretical torque values and actual torque values of the legged robot during movement according to the target movement curve;
[0205] When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, the target movement curve is updated, and the steps of obtaining the theoretical torque value and the actual torque value of the footed robot during the movement according to the target movement curve are executed until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold.
[0206] In one or more embodiments, before the processor 1301 executes the step of obtaining the theoretical torque value and the actual torque value of the footed robot during the movement according to the target movement curve, the processor 1301 further executes:
[0207] A target movement curve is obtained according to the movement speed and at least two preset position points.
[0208] In one or more embodiments, the processor 1301 executes the acquisition of the target movement curve according to the movement speed and at least two preset position points, and executes:
[0209] According to the moving speed and the control cycle, the displacement distance corresponding to each control cycle is obtained;
[0210] A target movement curve is fitted according to the displacement distance and at least two preset position points.
[0211] In one or more embodiments, the process of the legged robot moving according to the target movement curve corresponds to at least one control cycle;
[0212] The processor 1301 executes the acquisition of the theoretical torque value and the actual torque value of the footed robot in the process of moving according to the target movement curve, and executes:
[0213] Obtaining a theoretical torque value and an actual torque value corresponding to each control cycle of the legged robot;
[0214] The processor 1301 executes the step of updating the target movement curve when the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, and executes the step of obtaining the theoretical torque value and the actual torque value of the footed robot in the process of moving according to the target movement curve, and executes:
[0215] When the deviation between the actual torque value and the theoretical torque value corresponding to the target control cycle is greater than a preset threshold, the target movement curve is updated, and the theoretical torque value and the actual torque value corresponding to each control cycle of the legged robot are obtained, wherein the at least one control cycle includes at least one target control cycle.
[0216] In one or more embodiments, the processor 1301 executes the updating of the target movement curve when the deviation between the actual torque value and the theoretical torque value corresponding to the target control period is greater than a preset threshold value, and executes:
[0217] Sequentially obtaining the deviation between the actual torque value and the theoretical torque value corresponding to each of the control cycles;
[0218] When it is detected that the deviations corresponding to N consecutive target control periods are greater than a preset threshold, the target movement curve is updated.
[0219] In one or more embodiments, the legged robot comprises at least one walking foot, and each of the walking feet comprises at least one driving motor;
[0220] The processor 1301 executes the acquisition of the theoretical torque value and the actual torque value of the footed robot in the process of moving according to the target movement curve, and executes:
[0221] According to the target movement curve, a theoretical torque value and an actual torque value of each driving motor on the walking foot of the footed robot corresponding to the target movement curve are obtained;
[0222] The processor 1301 executes, when the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, updating the target movement curve, and obtaining the theoretical torque value and the actual torque value of the footed robot in the process of moving according to the target movement curve, and executing:
[0223] When there is a deviation between the actual torque value and the theoretical torque value corresponding to at least one target drive motor that is greater than a preset threshold, the target movement curve is updated, and the steps of obtaining the theoretical torque value and the actual torque value of each drive motor on the walking foot of the legged robot corresponding to the target movement curve are performed, wherein the at least one drive motor includes the at least one target drive motor.
[0224] In one or more embodiments, the processor 1301 executes the step of obtaining the theoretical torque value and the actual torque value of each driving motor on the walking foot of the footed robot corresponding to the target movement curve according to the target movement curve, and executing:
[0225] According to at least one control cycle corresponding to the movement of the legged robot in accordance with the target movement curve, obtaining a theoretical torque value and an actual torque value of each driving motor on the walking foot of the legged robot corresponding to the target movement curve in each control cycle;
[0226] The processor 1301 executes the updating of the target movement curve when there is a deviation between the actual torque value and the theoretical torque value corresponding to at least one target driving motor being greater than a preset threshold value, and executes:
[0227] When it is detected that N consecutive deviations among all deviations corresponding to at least one target driving motor are greater than a preset threshold, the target movement curve is updated.
[0228] In one or more embodiments, the target movement curve corresponds to at least two movement points;
[0229] The processor 1301 executes the updating of the target movement curve when the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold value, and executes:
[0230] When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, compensating a target point among the at least two moving points corresponding to the target moving curve;
[0231] The target movement curve is updated according to the compensated target point.
[0232] In one or more embodiments, the target point is a starting point of the target movement curve;
[0233] The processor 1301 executes the compensation of the target point among the at least two moving points corresponding to the target moving curve by executing:
[0234] Instructing the legged robot to return to the starting point of the target movement curve;
[0235] Instructing the legged robot to move a preset distance in a preset direction, and obtaining a starting point corresponding to the moved legged robot;
[0236] The processor 1301 executes the updating of the target movement curve according to the compensated starting point, and executes:
[0237] The target movement curve is updated according to the starting point corresponding to the moved footed robot.
[0238] In one or more embodiments, the target point is a moving point corresponding to when the deviation between the actual torque value and the theoretical torque value is greater than the preset threshold value during the movement of the footed robot according to the target movement curve;
[0239] The processor 1301 executes the compensation of the target point among the at least two moving points corresponding to the target moving curve by executing:
[0240] Instructing the legged robot at the target point to move in a preset direction and a preset distance, and obtaining the target point corresponding to the moved legged robot;
[0241] The processor 1301 executes the updating of the target movement curve according to the compensated target point, and executes:
[0242] The target movement curve is updated according to the target point corresponding to the moved footed robot.
[0243] In one or more embodiments, the legged robot includes at least one walking foot, each walking foot corresponding to a foot end;
[0244] Before the processor 1301 executes the method of obtaining the theoretical torque value and the actual torque value of the footed robot during the movement according to the target movement curve, the processor 1301 further executes:
[0245] Obtaining coordinate data corresponding to at least one foot end of the footed robot in a world coordinate system, and calculating an angle between a contact plane formed by the at least one foot end and a reference plane corresponding to the world coordinate system;
[0246] The posture of the legged robot is adjusted until the value of the angle is zero.
[0247] The present application obtains the deviation between the theoretical torque value and the actual torque value of the legged robot when it moves according to the target movement curve, further compares the deviation with a preset threshold, updates the target movement curve according to the comparison result, and adjusts it in real time until the legged robot reaches the preset destination. Therefore, there is no need to rely on ranging sensors to obtain ranging data, which greatly reduces the cost of the legged robot and reduces the amount of calculation of the legged robot.
[0248] Those skilled in the art can understand that all or part of the processes in the above-mentioned embodiments can be implemented by instructing related hardware through a computer program, and the program can be stored in a computer-readable storage medium. When the program is executed, it can include the processes of the implementation regulations of the above-mentioned methods. The storage medium can be a disk, an optical disk, a read-only storage memory, or a random access memory, etc.
[0249] The above disclosure is only the preferred embodiment of the present application, which certainly cannot be used to limit the scope of rights of the present application. Therefore, equivalent changes made according to the claims of the present application are still within the scope covered by the present application.
Claims
1. A method for moving a legged robot, characterized in that: The method comprises: Obtaining theoretical torque values and actual torque values of the legged robot during movement according to the target movement curve; When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, the target movement curve is updated, and the step of obtaining the theoretical torque value and the actual torque value of the footed robot in the process of moving according to the target movement curve is performed until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold; Wherein, the process of the legged robot moving according to the target movement curve corresponds to at least one control cycle; The step of obtaining the theoretical torque value and the actual torque value of the legged robot during the movement according to the target movement curve includes: Obtaining a theoretical torque value and an actual torque value corresponding to each control cycle of the legged robot; When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, the target movement curve is updated, and the step of obtaining the theoretical torque value and the actual torque value of the footed robot in the process of moving according to the target movement curve is performed, including: When the deviation between the actual torque value and the theoretical torque value corresponding to the target control cycle is greater than a preset threshold, the target movement curve is updated, and the theoretical torque value and the actual torque value corresponding to each control cycle of the legged robot are obtained, wherein the at least one control cycle includes at least one target control cycle.
2. The method according to claim 1, characterized in that Before obtaining the theoretical torque value and the actual torque value of the footed robot during the movement according to the target movement curve, the method further includes: A target movement curve is obtained according to the movement speed and at least two preset position points.
3. The method according to claim 2, characterized in that The step of obtaining a target movement curve according to the movement speed and at least two preset position points includes: According to the moving speed and the control cycle, the displacement distance corresponding to each control cycle is obtained; A target movement curve is fitted according to the displacement distance and at least two preset position points.
4. The method according to claim 1, characterized in that: When the deviation between the actual torque value and the theoretical torque value corresponding to the target control period is greater than a preset threshold, updating the target movement curve includes: Sequentially obtaining the deviation between the actual torque value and the theoretical torque value corresponding to each of the control cycles; When it is detected that the deviations corresponding to N consecutive target control periods are greater than a preset threshold, the target movement curve is updated.
5. The method according to claim 1, characterized in that The legged robot comprises at least one walking foot, and each walking foot comprises at least one driving motor; The step of obtaining the theoretical torque value and the actual torque value of the legged robot during the movement according to the target movement curve includes: According to the target movement curve, a theoretical torque value and an actual torque value of each driving motor on the walking foot of the footed robot corresponding to the target movement curve are obtained; When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, the target movement curve is updated, and the theoretical torque value and the actual torque value of the footed robot in the process of moving according to the target movement curve are obtained, including: When there is a deviation between the actual torque value and the theoretical torque value corresponding to at least one target drive motor that is greater than a preset threshold, the target movement curve is updated, and the steps of obtaining the theoretical torque value and the actual torque value of each drive motor on the walking foot of the legged robot corresponding to the target movement curve are performed, wherein the at least one drive motor includes the at least one target drive motor.
6. The method according to claim 5, characterized in that The step of obtaining, according to the target movement curve, a theoretical torque value and an actual torque value of each driving motor on the walking foot of the footed robot corresponding to the target movement curve, comprises: According to at least one control cycle corresponding to the movement of the legged robot in accordance with the target movement curve, obtaining a theoretical torque value and an actual torque value of each driving motor on the walking foot of the legged robot corresponding to the target movement curve in each control cycle; When there is a deviation between an actual torque value and a theoretical torque value corresponding to at least one target driving motor that is greater than a preset threshold, updating the target movement curve includes: When it is detected that N consecutive deviations among all deviations corresponding to at least one target driving motor are greater than a preset threshold, the target movement curve is updated.
7. The method according to claim 1, characterized in that The target movement curve corresponds to at least two movement points; When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, updating the target movement curve includes: When the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, compensating a target point among the at least two moving points corresponding to the target moving curve; The target movement curve is updated according to the compensated target point.
8. The method according to claim 7, characterized in that The target point is the starting point of the target movement curve; The compensating a target point among the at least two moving points corresponding to the target moving curve comprises: Instructing the legged robot to return to the starting point of the target movement curve; Instructing the legged robot to move a preset distance in a preset direction, and obtaining a starting point corresponding to the moved legged robot; The updating of the target movement curve according to the compensated starting point comprises: The target movement curve is updated according to the starting point corresponding to the moved footed robot.
9. The method according to claim 7, characterized in that: The target point is a moving point corresponding to when the deviation between the actual torque value and the theoretical torque value is greater than the preset threshold value during the movement of the footed robot according to the target movement curve; The compensating a target point among the at least two moving points corresponding to the target moving curve comprises: Instructing the legged robot at the target point to move in a preset direction and a preset distance, and obtaining the target point corresponding to the moved legged robot; The updating of the target movement curve according to the compensated target point comprises: The target movement curve is updated according to the target point corresponding to the moved footed robot.
10. The method according to claim 1, characterized in that The legged robot comprises at least one walking foot, each walking foot corresponding to a foot end; Before obtaining the theoretical torque value and the actual torque value of the legged robot during the movement according to the target movement curve, the method further includes: Obtaining coordinate data corresponding to at least one foot end of the footed robot in a world coordinate system, and calculating an angle between a contact plane formed by the at least one foot end and a reference plane corresponding to the world coordinate system; The posture of the legged robot is adjusted until the value of the angle is zero.
11. A legged robot mobile device, characterized in that: The device comprises: An acquisition module is used to obtain a theoretical torque value and an actual torque value of the legged robot during the movement according to the target movement curve; An updating module, configured to update the target movement curve when the deviation between the actual torque value and the theoretical torque value is greater than a preset threshold, and execute the step of obtaining the theoretical torque value and the actual torque value of the footed robot during the movement according to the target movement curve until the deviation between the actual torque value and the theoretical torque value is less than or equal to the preset threshold; Wherein, the process of the legged robot moving according to the target movement curve corresponds to at least one control cycle; Get modules, including: A cycle acquisition unit, used for acquiring a theoretical torque value and an actual torque value corresponding to each control cycle of the legged robot; Update modules, including: A period update unit is used to update the target movement curve when the deviation between the actual torque value and the theoretical torque value corresponding to the target control period is greater than a preset threshold, and to obtain the theoretical torque value and the actual torque value corresponding to each control period of the legged robot, wherein the at least one control period includes at least one target control period.
12. A computer storage medium, characterized in that: The computer storage medium stores a plurality of instructions, and the instructions are suitable for being loaded by a processor and executing the method steps according to any one of claims 1 to 10.
13. A legged robot, characterized in that: include: A processor and a memory; wherein the memory stores a computer program, and the computer program is suitable for being loaded by the processor and executing the method steps as claimed in any one of claims 1 to 10.
Citation Information
Patent Citations
Disturbance recovery humanoid robot space compliance control model construction method
CN110202580A
Foot force and moment following control method of bipedal robot
CN110244791A
Robot and flexible control method and device thereof
CN111098303A
Robot walking control method and device, robot control equipment and storage medium
CN113359800A
Method of tracking control for foot force and moment of biped robot
US20210009218A1
