Humanoid robot motion debugging protection device and method
Through the depth camera, the humanoid robot posture information is collected and the traction rope is controlled automatically tracked. Combined with target detection, the problems of high labor costs and major safety hazards in the debugging process of humanoid robots are solved, and automated safe traction and personnel identification are realized, reducing the risk of damage and Improved security.
Patent Information
- Application Number
- CN202411097201.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-09
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2044-08-09
AI Technical Summary
In the prior art, there are high labor costs and high safety risks during the debugging of humanoid robots. The robot may be damaged due to fall or system failure, and fail to effectively identify the on-site personnel, which poses a risk of stepping.
A humanoid robot motion debugging protection device is designed, including a protective support frame, a protection controller, a safety traction rope restraint, a guide pulley controller and a depth camera. The depth camera collects the robot's posture information, controls the traction rope to automatically track and track it in Shorten if necessary to prevent falls and avoid collisions with people through target detection.
It reduces labor costs, reduces the probability of robot damage, improves debugging efficiency and personnel safety, and avoids safety hazards caused by falls or collisions.
Smart Images

Figure CN118906089A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of robotics technology, and in particular to a motion debugging protection device and method for a humanoid robot. Background Art
[0002] Currently, there are two main methods for debugging humanoid robots' walking, running and other motor abilities. The first is to use a movable bracket and a traction rope to lift the humanoid robot. When the humanoid robot is running, one or two people are required to move the bracket and control the traction rope in real time to prevent the humanoid robot from falling and being damaged. The second is to install a cubic scaffolding on site, and the humanoid robot is hung above the scaffolding with a traction rope. The debugging personnel move the traction device above the scaffolding in real time and control the movement and tightening of the traction device to protect the humanoid robot.
[0003] The two current debugging methods have the following problems: When debugging a humanoid robot, in order to avoid excessive upward traction of the robot by the traction safety rope, which would cause deviations in the mechanical algorithm, a relatively loose length is often used in the traction safety rope during the actual debugging process to reduce the impact on the robot debugging process. If the humanoid robot falls or the system fails at this time, the debugger will not react in time to tighten the traction safety rope, causing the robot to fall abnormally, which poses a safety hazard to the robot body and the debugger. During the humanoid debugging process, an additional one or two people are required to move the scaffolding in real time and observe the robot's posture to control the safety traction rope. If the debugger or other personnel appear in the direction of the robot's advance, the humanoid robot may not recognize the presence of the person and may cause the debugger to be trampled, posing a safety hazard to the debugger. Summary of the invention
[0004] The present application provides a humanoid robot motion debugging protection device and method, which are used to solve the problems in the prior art of high labor costs for humanoid robot motion debugging and potential safety hazards for the humanoid robot and on-site personnel.
[0005] In a first aspect, the present application provides a humanoid robot motion debugging protection device, the device comprising:
[0006] A protection support frame, a protection controller, and a safety traction rope restraint, a first guide rail pulley controller, a second guide rail pulley controller, a third guide rail pulley controller and a depth camera arranged on the protection support frame; the safety traction rope restraint is connected to the humanoid robot through a safety traction rope;
[0007] The depth camera is used to collect the first posture information of the humanoid robot during the motion debugging of the humanoid robot, and send the first posture information to the protection controller;
[0008] The protection controller is specifically used to control the movement of the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller according to the first posture information, so that the safety traction rope and the humanoid robot are in the same vertical plane; and when it is determined according to the first posture information that there is a safety risk in the motion debugging, the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length.
[0009] Furthermore, the protection support frame includes a support column, a support top beam and a movable support cross beam; the support top beam includes a first support top beam and a second support top beam arranged in parallel; the depth camera is connected to the support column;
[0010] The first guide rail pulley controller is respectively connected to the first end of the first support top beam and the movable support cross beam; the second guide rail pulley controller is respectively connected to the second end of the second support top beam and the movable support cross beam; the third guide rail pulley controller is respectively connected to the movable support cross beam and the safety traction rope restraint.
[0011] Furthermore, the protective support frame includes a first supporting column and a second supporting column arranged diagonally;
[0012] The number of the depth cameras is at least two; wherein the first support column and the second support column are each connected to at least one depth camera.
[0013] Furthermore, the depth camera is specifically used to collect the position information of the first key point of the humanoid robot connected to the safety traction rope during the movement debugging of the humanoid robot; wherein the first key point is the center point of the connection point between the two mechanical arms of the humanoid robot and the torso;
[0014] The protection controller is specifically used to control the movement of the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller according to the position information of the first key point, so that the safety traction rope and the humanoid robot are in the same vertical plane.
[0015] Furthermore, the depth camera is specifically used to collect the position information of the second key point of the humanoid robot during the motion debugging of the humanoid robot; wherein the second key point is the center point of the connection point between the two mechanical legs and the torso of the humanoid robot;
[0016] The protection controller is specifically used to determine the inclination angle of the humanoid robot based on the position information of the first key point and the position information of the second key point; if the inclination angle is greater than a preset angle threshold, or the height of the first key point is less than a preset height threshold, it is determined that there is a safety risk in the motion debugging.
[0017] Furthermore, the depth camera is also used to collect second position information of the target object in the motion debugging scene during the motion debugging of the humanoid robot, and send the second position information to the protection controller;
[0018] The protection controller is also used to determine that there is a safety risk in motion debugging if it is determined that the distance between the humanoid robot and the target object is less than a preset distance threshold based on the first posture information and the second posture information, and control the safety traction rope restraint to adjust the safety traction rope to shorten to a preset length.
[0019] In a second aspect, the present application provides a humanoid robot motion debugging protection method, the method comprising:
[0020] The protection controller obtains the first position information of the humanoid robot collected by the depth camera during the motion debugging of the humanoid robot;
[0021] According to the first posture information, the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller in the humanoid robot motion debugging protection device are controlled to move so that the safety traction rope and the humanoid robot are in the same vertical plane; and when it is determined according to the first posture information that there is a safety risk in the motion debugging, the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length; wherein, the humanoid robot motion debugging protection device includes a protection support frame, and the safety traction rope restraint, the first guide rail pulley controller, the second guide rail pulley controller, the third guide rail pulley controller and the depth camera arranged on the protection support frame; the safety traction rope restraint is connected to the humanoid robot through the safety traction rope.
[0022] Furthermore, the method comprises:
[0023] Acquire the position information of the first key point of the humanoid robot connected to the safety traction rope collected by the depth camera during the motion debugging of the humanoid robot; wherein the first key point is the center point of the connection point between the two mechanical arms of the humanoid robot and the torso;
[0024] According to the position information of the first key point, the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller are controlled to move so that the safety traction rope and the humanoid robot are in the same vertical plane.
[0025] Furthermore, the method comprises:
[0026] Acquire the position information of the second key point of the humanoid robot collected by the depth camera during the motion debugging of the humanoid robot; wherein the second key point is the center point of the connection point between the two mechanical legs and the torso of the humanoid robot;
[0027] According to the position information of the first key point and the position information of the second key point, the inclination angle of the humanoid robot is determined; if the inclination angle is greater than a preset angle threshold, or the height of the first key point is less than a preset height threshold, it is determined that there is a safety risk in the motion debugging.
[0028] Further, the method comprises:
[0029] Acquire the second position information of the target object in the motion debugging scene collected by the depth camera during the motion debugging of the humanoid robot;
[0030] If it is determined based on the first posture information and the second posture information that the distance between the humanoid robot and the target object is less than a preset distance threshold, it is determined that there is a safety risk in the motion debugging, and the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length.
[0031] The above technical solution has the following advantages or beneficial effects:
[0032] The present application provides a humanoid robot motion debugging protection device, the device includes: a protection support frame, a protection controller, and a safety traction rope restraint set on the protection support frame, a first guide pulley controller, a second guide pulley controller, a third guide pulley controller and a depth camera; the safety traction rope restraint is connected to the humanoid robot through a safety traction rope. The protection support frame in the device constitutes a motion debugging area of the humanoid robot. During the motion debugging of the humanoid robot, the depth camera collects the first position information of the humanoid robot and sends the first position information to the protection controller; the protection controller controls the first guide pulley controller, the second guide pulley controller and the third guide pulley controller to move according to the first position information, so that the safety traction rope and the humanoid robot are in the same vertical plane; thereby realizing that the safety traction rope automatically tracks the movement of the humanoid robot during the debugging of the humanoid robot. And when it is determined that there is a safety risk in the motion debugging according to the first position information, the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length. The present application does not require manual participation, reducing labor costs. Thus, when there is a safety risk, the safety traction rope restraint is controlled to tighten the safety traction rope. The potential safety hazard of the humanoid robot and the personnel on site is eliminated, the probability of damage to the humanoid robot is reduced, the debugging efficiency of the humanoid robot is improved, and the safety of personnel is improved. BRIEF DESCRIPTION OF THE DRAWINGS
[0033] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the description of the embodiments 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 creative work.
[0034] Figure 1 It is a schematic diagram of a humanoid robot motion debugging device in the prior art;
[0035] Figure 2 A schematic diagram of the structure of the first humanoid robot motion debugging protection device provided in this application;
[0036] Figure 3 A schematic diagram of a humanoid robot motion debugging protection device scenario provided for this application;
[0037] Figure 4 A second humanoid robot motion debugging protection device provided in this application;
[0038] Figure 5 A top view of two depth cameras installed diagonally for this application;
[0039] Figure 6 A schematic diagram of the key points for identifying a humanoid robot provided for this application;
[0040] Figure 7 A schematic diagram of the first safety debugging process provided for this application;
[0041] Figure 8 A schematic diagram of key points of the target object in the motion debugging scene provided by this application;
[0042] Fig. 9 A schematic diagram of the second security debugging process provided for this application;
[0043] Fig.10 The front view of the humanoid robot motion debugging protection device provided in this application;
[0044] Fig.11 A top view of the humanoid robot motion debugging protection device provided in this application;
[0045] Fig.12 A left view of the humanoid robot motion debugging protection device provided in this application;
[0046] Fig.13 A schematic diagram of the structure of the depth camera fixing module provided in this application;
[0047] Fig.14 A schematic diagram of the structure of the safety traction rope restraint provided for this application;
[0048] Fig.15 A schematic diagram of the structure of the first guide rail pulley controller and the second guide rail pulley controller provided in the present application;
[0049] Fig.16 A schematic diagram of the structure of the third guide rail pulley controller provided in this application;
[0050] Fig.17 Schematic diagram of the humanoid robot motion debugging and protection process provided in this application. DETAILED DESCRIPTION
[0051] In order to make the purpose and implementation method of the present application clearer, the exemplary implementation method of the present application will be clearly and completely described below in conjunction with the drawings in the exemplary embodiments of the present application. Obviously, the described exemplary embodiments are only part of the embodiments of the present application, rather than all the embodiments.
[0052] It should be noted that the brief description of terms in this application is only for the convenience of understanding the embodiments described below, and is not intended to limit the embodiments of this application. Unless otherwise specified, these terms should be understood according to their ordinary and common meanings.
[0053] The terms "first", "second", "third", etc. in the specification and claims of this application and the above drawings are used to distinguish similar or similar objects or entities, and do not necessarily mean to limit a specific order or sequence, unless otherwise noted. It should be understood that the terms used in this way can be interchangeable under appropriate circumstances.
[0054] The terms "comprises," "comprising," and "having," and any variations thereof, are intended to cover but not exclude inclusion, for example, a product or device comprising a list of components is not necessarily limited to all the components expressly listed but may include other components not expressly listed or inherent to such product or device.
[0055] The term "module" refers to any known or later developed hardware, software, firmware, artificial intelligence, fuzzy logic, or combination of hardware and / or software code that is capable of performing the functions associated with that element.
[0056] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present application, rather than to limit it. Although the present application has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present application.
[0057] For the convenience of explanation, the above description has been made in conjunction with specific embodiments. However, the above exemplary discussion is not intended to be exhaustive or limit the embodiments to the specific forms disclosed above. Based on the above teachings, various modifications and variations can be obtained. The selection and description of the above embodiments are to better explain the principles and practical applications, so that those skilled in the art can better use the embodiments and various different variations of the embodiments suitable for specific use considerations.
[0058] Figure 1 Schematic diagram of a humanoid robot motion debugging device in the prior art, such as Figure 1 As shown, a movable bracket is used, and a traction rope is used to lift the humanoid robot. When the humanoid robot is running, one or two people are required to move the bracket in real time and control the traction rope to prevent the humanoid robot from falling and being damaged. This makes the humanoid robot motion debugging process consume a lot of manpower costs. In the actual debugging process, a relatively loose length of the traction safety rope is often used to reduce the impact on the robot debugging process. If the humanoid robot falls or the system fails at this time, the debugging personnel will not react in time to tighten the traction safety rope, causing the robot to fall abnormally, which poses a safety hazard to the robot body and the debugging personnel. If the debugging personnel or other personnel appear in the direction of the robot's advance, the humanoid robot may not recognize the presence of the person and may cause the debugging personnel to be trampled, posing a safety hazard to the debugging personnel.
[0059] In order to solve the above problems, the present application provides a humanoid robot motion debugging protection device and method with low labor cost and high safety.
[0060] In this application, the humanoid robot motion debugging protection device includes:
[0061] A protection support frame, a protection controller, and a safety traction rope restraint, a first guide rail pulley controller, a second guide rail pulley controller, a third guide rail pulley controller and a depth camera arranged on the protection support frame; the safety traction rope restraint is connected to the humanoid robot through a safety traction rope;
[0062] The depth camera is used to collect the first posture information of the humanoid robot during the motion debugging of the humanoid robot, and send the first posture information to the protection controller;
[0063] The protection controller is used to control the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller to move according to the first posture information, so that the safety traction rope and the humanoid robot are in the same vertical plane; and when it is determined according to the first posture information that there is a safety risk in the motion debugging, the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length.
[0064] The present application provides a humanoid robot motion debugging protection device, the device includes: a protection support frame, a protection controller, and a safety traction rope restraint set on the protection support frame, a first guide pulley controller, a second guide pulley controller, a third guide pulley controller and a depth camera; the safety traction rope restraint is connected to the humanoid robot through a safety traction rope. The protection support frame in the device constitutes a motion debugging area of the humanoid robot. During the motion debugging of the humanoid robot, the depth camera collects the first position information of the humanoid robot and sends the first position information to the protection controller; the protection controller controls the first guide pulley controller, the second guide pulley controller and the third guide pulley controller to move according to the first position information, so that the safety traction rope and the humanoid robot are in the same vertical plane; thereby realizing that the safety traction rope automatically tracks the movement of the humanoid robot during the debugging of the humanoid robot. And when it is determined that there is a safety risk in the motion debugging according to the first position information, the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length. The present application does not require manual participation, reducing labor costs. Thus, when there is a safety risk, the safety traction rope restraint is controlled to tighten the safety traction rope. The potential safety hazard of the humanoid robot and the personnel on site is eliminated, the probability of damage to the humanoid robot is reduced, the debugging efficiency of the humanoid robot is improved, and the safety of personnel is improved.
[0065] Figure 2 The first humanoid robot motion debugging protection device provided in the present application is a structural schematic diagram, comprising: a protection support frame 11, a safety traction rope restraint 12, a first guide rail pulley controller 13, a second guide rail pulley controller 14, a third guide rail pulley controller 15 and a protection controller 16; the protection support frame 11 comprises a support column 111, a support top beam 112 and a movable support cross beam 113; the support top beam 112 comprises a first support top beam 112a and a second support top beam 112b arranged in parallel; the depth camera 21 is connected to the support column;
[0066] The first guide rail pulley controller 13 is respectively connected to the first support top beam 112a and the first end of the movable support beam 113; the second guide rail pulley controller 14 is respectively connected to the second support top beam 112b and the second end of the movable support beam 113; the third guide rail pulley controller 15 is respectively connected to the movable support beam 113 and the safety traction rope restraint 12; the safety traction rope restraint 12 is connected to the humanoid robot through a safety traction rope.
[0067] The protection controller 16 is used to control the movement of the first guide rail pulley controller 13, the second guide rail pulley controller 14 and the third guide rail pulley controller 15 according to the first posture information, so that the safety traction rope and the humanoid robot are in the same vertical plane; and when it is determined according to the first posture information that there is a safety risk in the motion debugging, the safety traction rope restraint 12 is controlled to adjust the safety traction rope to shorten to a preset length.
[0068] Figure 3 A schematic diagram of a humanoid robot motion debugging protection device scenario provided in this application. Figure 3 The humanoid robot motion debugging protection device provided in the present application includes a protection support frame, which includes four support columns, four support top beams and a movable support cross beam. The four support top beams include two groups of support top beams arranged in parallel. The present application uses any group of support top beams arranged in parallel as the first support top beam and the second support top beam. The movable support cross beam is perpendicular to the first support top beam and the second support top beam, and is located between the first support top beam and the second support top beam.
[0069] In the present application, the first guide rail pulley controller is connected to the first end of the first support top beam and the movable support cross beam respectively; the second guide rail pulley controller is connected to the second end of the second support top beam and the movable support cross beam respectively. The first guide rail pulley controller and the second guide rail pulley controller can control the movable support cross beam to move along the top surface of the protective support frame and in a direction perpendicular to the movable support cross beam, thereby driving the safety traction rope restraint to move in a direction perpendicular to the movable support cross beam.
[0070] The third guide rail pulley controller is connected with the movable support crossbeam and the safety traction rope restraint device respectively. The third guide rail pulley controller can move along the movable support crossbeam, thereby driving the safety traction rope restraint device to move along the movable support crossbeam.
[0071] The safety traction rope restraint is connected to the humanoid robot through the safety traction rope. During the motion debugging of the humanoid robot, the humanoid robot moves according to the pre-configured motion trajectory. The internal area of the protection support frame in the present application constitutes the motion debugging area of the humanoid robot. During the motion of the humanoid robot, the protection controller controls the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller to move, thereby achieving that the safety traction rope and the humanoid robot are in the same vertical plane. And the protection controller controls the safety traction rope restraint to adjust the length of the safety traction rope. Thereby, when a safety hazard occurs during the motion debugging of the humanoid robot, the robot can be tightened to avoid the occurrence of dangerous events. Among them, the protection controller can be a smart terminal device such as a mobile phone or a computer.
[0072] The present application provides a humanoid robot motion debugging protection device, wherein the protection support frame in the device constitutes a motion debugging area of the humanoid robot. The first guide rail pulley controller is respectively connected to the first end of the first support top beam and the movable support cross beam; the second guide rail pulley controller is respectively connected to the second end of the second support top beam and the movable support cross beam; the third guide rail pulley controller is respectively connected to the movable support cross beam and the safety traction rope restraint. The first guide rail pulley controller and the second guide rail pulley controller are used to control the safety traction rope to move along the direction of the first support top beam, and the third guide rail pulley controller is used to control the safety traction rope to move along the direction of the movable support cross beam, thereby realizing that the safety traction rope automatically tracks the movement of the humanoid robot during the debugging process of the humanoid robot. The present application does not require manual participation, reducing labor costs. And the protection controller controls the safety traction rope restraint to adjust the length of the safety traction rope. Thus, when there is a safety risk, the safety traction rope restraint is controlled to tighten the safety traction rope. The safety hazards of the humanoid robot and the personnel on site are eliminated. The damage probability of the humanoid robot is reduced, the debugging efficiency of the humanoid robot is improved, and the safety of the personnel is improved.
[0073] In the present application, the depth camera installed in the humanoid robot motion debugging protection device is connected to the support column of the protection support frame, and the monitoring field angle of the depth camera includes the humanoid robot motion debugging area inside the protection support frame, ensuring that the depth camera can monitor the motion state of the humanoid robot during the motion debugging of the humanoid robot. During the motion debugging of the humanoid robot, the depth camera collects the motion state of the humanoid robot and determines the first position information of the humanoid robot. The first position information includes the position information of each key point of the humanoid robot. The depth camera sends the collected first position information of the humanoid robot to the protection controller. Optionally, the depth camera and the protection controller can establish a wireless connection through Bluetooth, wireless WIFI, etc., or can be connected by wire.
[0074] After the protection controller receives the first position information of the humanoid robot, it controls the first guide pulley controller, the second guide pulley controller and the third guide pulley controller to move according to the first position information. The protection controller can determine the spatial position information of the humanoid robot according to the first position information of the humanoid robot, and then control the first guide pulley controller and the second guide pulley controller to move along the plane formed by the supporting top beam and in the direction perpendicular to the movable supporting crossbeam according to the spatial position information of the humanoid robot, and control the third guide pulley controller to move along the direction of the movable supporting crossbeam, thereby ensuring that the position of the safety traction rope corresponds to that of the humanoid robot. The position correspondence between the safety traction rope and the humanoid robot means that the safety traction rope and the humanoid robot are in the same vertical plane, thereby realizing that the safety traction rope moves with the humanoid robot, saving labor costs.
[0075] It should be noted that the protection controller can determine the spatial position information of the humanoid robot based on the first position information of the humanoid robot, and then determine the respective position information of the first guide pulley controller, the second guide pulley controller and the third guide pulley controller when the safety traction rope and the humanoid robot are in the same vertical plane based on the spatial position information of the humanoid robot. By controlling the first guide pulley controller, the second guide pulley controller and the third guide pulley controller to move to the above respective position information, it can be achieved that the safety traction rope and the humanoid robot are in the same vertical plane after the first guide pulley controller, the second guide pulley controller and the third guide pulley controller move, and the safety traction rope moves with the humanoid robot.
[0076] In addition, the protection controller can determine whether there is a safety risk in motion debugging based on the first pose information of the humanoid robot. Optionally, the protection controller can pre-save the reference pose information when there is no safety risk in the humanoid robot, and then calculate the similarity between the first pose information and the reference pose information. If the similarity is greater than a preset similarity threshold, it is determined that there is no safety risk in motion debugging, otherwise it is determined that there is a safety risk in motion debugging. Optionally again, the protection controller can pre-save the reference relative position relationship between the key points of the humanoid robot when there is no safety risk, and then calculate the relative position relationship between the key points of the humanoid robot based on the first pose information, and compare the relative position relationship with the reference relative position relationship. If the relative position deviation is less than a preset threshold, it is determined that there is no safety risk in motion debugging, otherwise it is determined that there is a safety risk in motion debugging. The relative position relationship is, for example, the relative distance between the key points, and another example is the angle between the vectors formed by any two key points.
[0077] When the protection controller determines that there is a safety risk in the motion debugging according to the first posture information, it controls the safety traction rope restraint device to adjust the safety traction rope to be shortened to a preset length. The preset length can be a length that ensures that the humanoid robot does not fall to the ground. Preferably, the preset length can be a length that ensures that the humanoid robot is suspended by the safety traction rope to a floating state, which can ensure the safety of the humanoid robot and also ensure that the safety robot does not collide with other objects in the motion debugging area.
[0078] Considering the field of view of the depth camera, in order to ensure that there is no blind spot in monitoring, Figure 4 The second humanoid robot motion debugging protection device provided in the present application, the protection support frame includes a first support column 111a and a second support column 111b arranged diagonally;
[0079] The number of the depth cameras 21 is at least two; wherein the first supporting column and the second supporting column are each connected to at least one depth camera.
[0080] Figure 4 Taking the number of depth cameras as two as an example, in actual application, the humanoid robot motion debugging protection device may include more depth cameras, for example, the humanoid robot motion debugging protection device includes four depth cameras, and each supporting column is connected to a depth camera. Considering the cost of the device, the present application may set two depth cameras, which are respectively set on the first supporting column and the second supporting column. In this way, while taking into account the cost of the device, it is ensured that at least one depth camera can monitor the motion state of the humanoid robot.
[0081] In the present application, the depth camera is specifically used to collect the position information of the first key point of the humanoid robot connected to the safety traction rope during the motion debugging of the humanoid robot; wherein the first key point is the center point of the connection point between the two mechanical arms of the humanoid robot and the torso;
[0082] The protection controller is specifically used to control the movement of the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller according to the position information of the first key point, so that the safety traction rope and the humanoid robot are in the same vertical plane.
[0083] During the motion debugging of the humanoid robot, the depth camera collects the first position information of the humanoid robot. Optionally, the depth camera collects the connection points between the two mechanical arms of the humanoid robot and the torso of the humanoid robot, and then uses the center point of the line connecting the two connection points as the first key point, and the safety traction rope connects the first key point of the humanoid robot. The depth camera collects the position information of the first key point of the humanoid robot; and sends the position information of the first key point to the protection controller.
[0084] The protection controller controls the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller to move according to the position information of the first key point, so that the safety traction rope and the humanoid robot are in the same vertical plane.
[0085] The protection controller can determine the respective position information of the first guide pulley controller, the second guide pulley controller and the third guide pulley controller when the safety traction rope and the humanoid robot are in the same vertical plane based on the position information of the first key point of the humanoid robot. By controlling the first guide pulley controller, the second guide pulley controller and the third guide pulley controller to move to the above respective position information, the safety traction rope and the humanoid robot can be in the same vertical plane after the first guide pulley controller, the second guide pulley controller and the third guide pulley controller move.
[0086] In the present application, the depth camera is specifically used to collect the position information of the second key point of the humanoid robot during the motion debugging of the humanoid robot; wherein the second key point is the center point of the connection point between the two mechanical legs and the torso of the humanoid robot;
[0087] The protection controller is specifically used to determine the inclination angle of the humanoid robot based on the position information of the first key point and the position information of the second key point; if the inclination angle is greater than a preset angle threshold, or the height of the first key point is less than a preset height threshold, it is determined that there is a safety risk in the motion debugging.
[0088] During the motion debugging of the humanoid robot, the depth camera collects the first posture information of the humanoid robot. Optionally, the depth camera collects the connection points between the two mechanical legs of the humanoid robot and the torso of the humanoid robot, and then takes the center point of the line connecting the two connection points as the second key point. The protection controller determines the inclination angle of the humanoid robot based on the position information of the first key point and the position information of the second key point. Optionally, based on the position information of the first key point and the position information of the second key point, determine the vector pointing from the first key point to the second key point, or determine the vector pointing from the second key point to the first key point. Then determine the angle between the above vector and the Z axis as the inclination angle of the humanoid robot. The Z axis refers to the coordinate axis perpendicular to the ground.
[0089] When there is a safety risk in the humanoid robot, that is, the humanoid robot is in a tilted state, the torso of the humanoid robot is tilted, and the height of the key points of the humanoid robot from the ground will decrease. Based on the above considerations, the protection controller stores a preset angle threshold. If the tilt angle is greater than the preset angle threshold, it is determined that there is a safety risk in the motion debugging. At this time, the safety traction rope restraint is controlled to adjust the length of the safety traction rope. In addition, the protection controller stores a preset height threshold. If the height of the first key point is less than the preset height threshold, it is determined that there is a safety risk in the motion debugging. At this time, the safety traction rope restraint is controlled to adjust the length of the safety traction rope. The height of the first key point refers to the height of the first key point from the ground.
[0090] In the present application, in order to ensure the safety of the target object in the motion debugging scene, the depth camera is also used to collect the second posture information of the target object in the motion debugging scene during the motion debugging process of the humanoid robot, and send the second posture information to the protection controller;
[0091] The protection controller is also used to determine that there is a safety risk in motion debugging if it is determined that the distance between the humanoid robot and the target object is less than a preset distance threshold based on the first posture information and the second posture information, and control the safety traction rope restraint to adjust the safety traction rope to shorten to a preset length.
[0092] The depth camera can detect whether there is a target object in the humanoid robot motion debugging scene through the target detection algorithm. The target object can be a staff member or other objects appearing in the motion debugging scene.
[0093] If the depth camera detects the presence of a target object in the motion debugging scene of the humanoid robot, the second pose information of the target object in the motion debugging scene is collected. If the target object is a staff member, the second pose information of the target object can be collected in the same way as the first pose information of the humanoid robot. If the target object is other objects that appear in the motion debugging scene, the spatial contour information of the target object can be detected as the second pose information. The depth camera sends the second pose information of the target object to the protection controller.
[0094] The protection controller determines the three-dimensional spatial position of the humanoid robot based on the first posture information of the humanoid robot; and determines the three-dimensional spatial position of the target object based on the second posture information of the target object. Then, based on the three-dimensional spatial position of the humanoid robot and the three-dimensional spatial position of the target object, the distance between the humanoid robot and the target object is determined, which is the spatial distance between the humanoid robot and the target object. A preset distance threshold is pre-stored in the protection controller. When the distance between the humanoid robot and the target object is less than the preset distance threshold, it is considered that there is a risk of the humanoid robot colliding with the target object. Therefore, it is determined that there is a safety risk in the motion debugging, and the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length.
[0095] Figure 5 This is a top view of the two depth cameras provided in this application that are installed diagonally. This application monitors the motion status of a humanoid robot based on two depth cameras.
[0096] Figure 6 A schematic diagram of key points for identifying a humanoid robot provided in this application, Figure 6 Point A in the figure is the first key point, and point B is the second key point. Point A is located at the center point where the left arm, right arm and torso of the humanoid robot are connected, and is the connection point of the safety traction rope of the humanoid robot; the current position of the humanoid robot in the top-down view is determined according to the XY value of point A in the coordinate system, and the XY axis position of the humanoid robot is input into the protection controller. The protection controller drives the first guide pulley controller, the second guide pulley controller, and the third guide pulley controller at the top of the humanoid robot motion debugging protection device, so that the top of the humanoid robot safety traction rope is in the same vertical plane as the humanoid robot body. This method does not require manual adjustment of the humanoid robot debugging scaffolding, and the safety traction rope can be moved with the humanoid robot by real-time recognition of the position of the humanoid robot, saving labor costs.
[0097] like Figure 6 As shown, point A is located at the center point of the connection between the left arm, the right arm and the torso of the humanoid robot; point B is the center point of the connection between the left leg, the right leg and the torso of the humanoid robot.
[0098] Get the XYZ value of point A in the world coordinate system; get the XYZ value of point B in the world coordinate system; get the vector from point B to point A (or the vector from point A to point B) based on points AB; get the angle of the calculated vector angle relative to the Z axis. Given an angle threshold E for judging an imminent unbalance and fall, when the angle of the vector angle relative to the Z axis is greater than angle E, it is judged as an imminent unbalance and fall. Tighten the safety traction rope to the pre-set safety length to prevent the robot from falling.
[0099] Get the Z-axis coordinate value of point A. Given a safe height F (i.e., Z-axis coordinate) of point A, when the height of point A is less than the safe height F, it is judged as an imminent fall due to imbalance. Pull the safety traction rope to the preset safe length to prevent the robot from falling.
[0100] Figure 7 The first safety debugging process diagram provided for this application includes the following steps:
[0101] S101: Obtain a first key point A and a second key point B of the humanoid robot; determine the angle between the AB vector and the Z axis, and the height of point A;
[0102] S102: Determine whether the included angle is greater than a preset angle threshold, if yes, proceed to S103, if no, proceed to S104;
[0103] S103: Determine that there is a safety risk in the motion debugging; control the safety traction rope restraint device to adjust the length of the safety traction rope;
[0104] S104: Determine whether the height is less than a preset height threshold, if yes, proceed to S103, if no, proceed to S105;
[0105] S104: Determine that there is no safety risk in motion debugging.
[0106] Figure 8 A schematic diagram of key points of the target object in the motion debugging scene provided by this application, Figure 8 Take the target object as a staff member as an example. The key points of the target object include but are not limited to Figure 8 Point A, point B and point C in the diagram.
[0107] According to the maximum value of the z-axis, the maximum and minimum value of the x-axis, and the maximum and minimum value of the y-axis in the key points of the target object, the placeholder cube of the target object in the XYZ axis coordinate system is generated. According to the maximum value of the z-axis, the maximum and minimum value of the x-axis, and the maximum and minimum value of the y-axis in the key points of the humanoid robot, the placeholder cube of the humanoid robot in the XYZ axis coordinate system is generated.
[0108] The distance between the target object and the humanoid robot's space cube is determined. If it is less than the safety threshold, the safety traction rope will be pulled to a pre-set safety length to protect the debugging personnel from injury.
[0109] Fig. 9 The second safety debugging process diagram provided for this application includes the following steps:
[0110] S201: collecting key points of a target object through a depth camera to generate a first occupying cube of the target object in an XYZ axis coordinate system; collecting key points of a humanoid robot through a depth camera to generate a second occupying cube of the humanoid robot in an XYZ axis coordinate system;
[0111] S202: Determine the distance between the first placeholder cube and the second placeholder cube;
[0112] S203: Determine whether the distance is less than a preset distance threshold, if yes, proceed to S204, if no, proceed to S205;
[0113] S204: Determine that there is a safety risk in the motion debugging; control the safety traction rope restraint device to adjust the length of the safety traction rope;
[0114] S205: Determine that there is no safety risk in motion debugging.
[0115] Fig.10 The front view of the humanoid robot motion debugging protection device provided in this application; Fig.10 As shown, the humanoid robot motion debugging protection device includes a protection support frame 11, a safety traction rope restraint 12, a first guide rail pulley controller 13, a second guide rail pulley controller 14, a third guide rail pulley controller 15, and a depth camera 21. The protection support frame 11 includes a support column 111 and a support top beam 112. In order to ensure the safety of the device, the support column 111 is connected to a support column base 110 below.
[0116] Fig.11 A top view of the humanoid robot motion debugging protection device provided in this application; Fig.11As shown, the humanoid robot motion debugging protection device includes two diagonally arranged depth cameras 21, a first guide rail pulley controller 13, a second guide rail pulley controller 14, a third guide rail pulley controller 15, a supporting top beam 112 and a movable supporting cross beam 113.
[0117] Fig.12 The left side view of the humanoid robot motion debugging protection device provided in this application; Fig.12 As shown, the robot motion debugging protection device includes a protection support frame 11, a safety traction rope restraint 12, a third guide rail pulley controller 15, and a depth camera 21. The protection support frame 11 includes a support column 111 and a support top beam 112. In order to ensure the safety of the device, the support column 111 is connected to a support column base 110 below.
[0118] Support column base: used to support the support column to support the overall humanoid robot motion debugging protection device structure to ensure the stability and safety of the device.
[0119] Support column: supports the overall humanoid robot motion debugging protection device structure and can be installed with a depth camera.
[0120] Depth camera: used to collect color images and depth images of humanoid robots and target objects, and provide image data support for the recognition algorithm to determine the posture information.
[0121] The first guide rail pulley controller and the second guide rail pulley controller are used to drive the safety traction rope restraint to move in the direction perpendicular to the movable supporting beam.
[0122] The third guide rail pulley controller is used to drive the safety traction rope restraint to move along the movable support beam.
[0123] Safety traction rope restraint: When there is a safety risk, the safety traction rope can be tightened to prevent the humanoid robot from falling and protect the humanoid robot and the target object.
[0124] The overall structure of the device provided in the present application is a cuboid rectangular structure, and adopts a four-support column design. The rectangular interior formed by the supporting columns serves as a humanoid robot debugging area.
[0125] Fig.13 The device further comprises: a depth camera fixing module 31, through which the depth camera 21 is connected to the support column 111;
[0126] The depth camera fixing module 31 includes: a support column fixing screw 311, a support column fixing piece 312, a horizontal bearing 313, a vertical bearing 314, a connecting piece 315, and a camera fixing piece 316;
[0127] The support column fixing screw 311 fixes the support column fixing piece 312 to the support column 111; the support column fixing piece 312 is connected to the first end of the connecting piece 315 via the horizontal bearing 313; the second end of the connecting piece 315 is connected to the camera fixing piece 316 via the vertical bearing 314; the camera fixing piece 316 is used to connect to the depth camera 21.
[0128] Support column fixing screw: The support column fixing piece can be fixed to the support column by rotating it clockwise or counterclockwise. The support column fixing piece is adjustable in the vertical direction to achieve vertical height adjustment of the depth camera.
[0129] Horizontal bearing: The horizontal bearing allows the depth camera to move horizontally.
[0130] Connector: A rigid connector that connects the horizontal bearing and the vertical bearing.
[0131] Vertical bearing: The vertical bearing can be used to adjust the pitch angle of the depth camera.
[0132] Camera fixing part: It is a universal interface, including depth camera fixing screws, used to fix the depth camera.
[0133] The depth camera is fixed on the support column by the depth camera fixing module. The module consists of support column fixing screws, support column fixing parts, horizontal bearings, vertical bearings, connectors, and camera fixing parts. The camera fixing parts are industry-wide interfaces that support the installation of depth cameras of different models. The entire module is fixed on the support column by the support column fixing screws. Loosening the screws allows the module to move up and down freely, and tightening the screws can fix the module. The horizontal bearing can move the depth camera horizontally, and the vertical bearing can adjust the pitch angle of the depth camera. The depth camera fixing module can be used to adjust the height and multi-angle of the depth camera.
[0134] Fig.14 The schematic diagram of the safety traction rope restraint structure provided for this application is as follows: Fig.14 As shown, the safety traction rope restraint device includes: a first drive motor 121 and a safety traction rope winding module 122;
[0135] The first driving motor 121 is connected to the rotating shaft of the safety traction rope winding module 122 ; the safety traction rope 123 is wound around the periphery of the safety traction rope winding module 122 ; the safety traction rope 123 is connected to the humanoid robot through a traction hook 124 .
[0136] The first driving motor drives the safety traction rope winding module to rotate forward or reverse to tighten or loosen the safety traction rope.
[0137] Safety traction rope winding module: When rotating in the forward direction, loosen the safety traction rope to facilitate the debugging of the humanoid robot. When rotating in the reverse direction, wind the safety traction rope, tighten the traction hook, and pull up the humanoid robot.
[0138] Safety traction rope: The end is connected to a traction hook and is used to tow the humanoid robot.
[0139] Towing hook: directly connected to the humanoid robot.
[0140] The safety traction rope restraint is composed of a first drive motor 121, a safety traction rope winding module 122, a safety traction rope 123, and a traction hook 124. When the humanoid robot needs to be debugged, the first drive motor drives the safety traction rope winding module to loosen the safety traction rope to a preset length to facilitate the debugging of the humanoid robot. When an emergency situation occurs and the humanoid robot needs to be pulled up, the first drive motor drives the safety traction rope winding module to tighten the safety traction rope to a preset safety length to ensure that the humanoid robot has no risk of falling.
[0141] Fig.15 This is a schematic diagram of the structure of the first guide rail pulley controller and the second guide rail pulley controller provided in this application. The first guide rail pulley controller and the second guide rail pulley controller have the same structure. Fig.15 As shown, the first guide rail pulley controller and the second guide rail pulley controller respectively include: a second drive motor 131, a transmission shaft 132, a gear 133 and a gear track 134;
[0142] The second driving motor 131 is connected to the transmission shaft 132 ; the transmission shaft 132 is also connected to the gear 133 ; the gear 133 is also connected to the gear track 134 ; the gear track 134 is also connected to the movable supporting beam 113 .
[0143] The second drive motor is used to drive the transmission shaft to rotate forward and reverse, thereby driving the gears on the transmission shaft to move forward and backward on the gear track to achieve the longitudinal movement of the movable supporting beam.
[0144] Movable support beam: used to support the lateral and longitudinal movement of the safety traction rope restraint.
[0145] Transmission shaft: connects the second drive motor and the gear to provide torque for the gear.
[0146] Gear: Drives the movable support beam to achieve longitudinal movement by rotating on the gear track.
[0147] Gear track: used to drive the movable support beam to move when the gear rotates.
[0148] The safety traction rope restraint supports longitudinal movement. This function is composed of the second drive motor, transmission shaft, gear and gear track in the first guide rail pulley controller and the second guide rail pulley controller. The second drive motor drives the transmission shaft to rotate, and the transmission shaft drives the gear to rotate and move forward and backward on the gear track.
[0149] Fig.16 The third guide rail pulley controller structure diagram provided in this application is as follows: Fig.16 As shown, the third guide rail pulley controller includes: a third driving motor 151, a first rolling bearing 152 and a transverse moving member 153; the transverse moving member 153 includes a screw hole 153a, a sleeve hole 153b and a safety traction rope restraint device connecting member 153c; the inner wall of the sleeve hole 153b is provided with a second rolling bearing 153d;
[0150] The third driving motor 151 is connected to the first rolling bearing 152; the first rolling bearing 152 is also connected to the threaded opening 153a; the second rolling bearing 153d is connected to the movable supporting beam 113; the safety traction rope restraint connector 153c is used to connect to the safety traction rope restraint 12.
[0151] The first rolling bearing is provided with threads, and the third driving motor can drive the first rolling bearing to rotate forward or reversely.
[0152] The third driving motor drives the first rolling bearing to rotate forward or reversely, so as to drive the lateral moving part to move lateraly.
[0153] Movable supporting beam: used to support the lateral and longitudinal movement of the safety traction rope restraint; as a load-bearing beam for the lateral moving part, it bears the downward gravity of the lateral moving part.
[0154] Second rolling bearing: connects the transverse moving member and the movable supporting beam, and reduces the friction between the transverse moving member and the movable supporting beam through the rolling structure.
[0155] Screw mouth: directly interacts with the first rolling bearing, and the first rolling bearing rotates forward or reversely through the screw mouth to move the lateral position.
[0156] The safety traction rope restraint supports lateral movement, which is composed of the third drive motor in the third guide rail pulley controller, the first rolling bearing and the lateral moving part; the lateral moving part includes a screw mouth, a sleeve hole and a safety traction rope restraint connector; the inner wall of the sleeve hole is provided with a second rolling bearing. The third drive motor drives the first rolling bearing to rotate clockwise or counterclockwise, and the first rolling bearing can drive the lateral moving part to translate left and right by means of a thread. The lateral moving part is suspended as a whole on the movable support beam, and the lateral moving part is connected to the movable support beam through the second rolling bearing, and the friction between the lateral moving part and the movable support beam is reduced by the rolling structure.
[0157] Fig.17 The schematic diagram of the humanoid robot motion debugging and protection process provided in this application includes the following steps:
[0158] S301: The protection controller obtains the first position information of the humanoid robot collected by the depth camera during the motion debugging process of the humanoid robot;
[0159] S302: Control the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller in the humanoid robot motion debugging protection device to move according to the first posture information, so that the safety traction rope and the humanoid robot are in the same vertical plane; and when it is determined according to the first posture information that there is a safety risk in the motion debugging, control the safety traction rope restraint to adjust the safety traction rope to shorten to a preset length; wherein, the humanoid robot motion debugging protection device includes a protection support frame, and the safety traction rope restraint, the first guide rail pulley controller, the second guide rail pulley controller, the third guide rail pulley controller and the depth camera arranged on the protection support frame; the safety traction rope restraint is connected to the humanoid robot through the safety traction rope.
[0160] : The method comprises:
[0161] Acquire the position information of the first key point of the humanoid robot connected to the safety traction rope collected by the depth camera during the motion debugging of the humanoid robot; wherein the first key point is the center point of the connection point between the two mechanical arms of the humanoid robot and the torso;
[0162] According to the position information of the first key point, the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller are controlled to move so that the safety traction rope and the humanoid robot are in the same vertical plane.
[0163] The method comprises:
[0164] Acquire the position information of the second key point of the humanoid robot collected by the depth camera during the motion debugging of the humanoid robot; wherein the second key point is the center point of the connection point between the two mechanical legs and the torso of the humanoid robot;
[0165] According to the position information of the first key point and the position information of the second key point, the inclination angle of the humanoid robot is determined; if the inclination angle is greater than a preset angle threshold, or the height of the first key point is less than a preset height threshold, it is determined that there is a safety risk in the motion debugging.
[0166] The method comprises:
[0167] Acquire the second position information of the target object in the motion debugging scene collected by the depth camera during the motion debugging of the humanoid robot;
[0168] If it is determined based on the first posture information and the second posture information that the distance between the humanoid robot and the target object is less than a preset distance threshold, it is determined that there is a safety risk in the motion debugging, and the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length.
[0169] Through the humanoid robot motion debugging protection device and the humanoid robot posture recognition algorithm provided by this application, the position of the humanoid robot in the debugging area is identified, and the safety traction rope restraint is moved in real time directly above the humanoid robot; by identifying the posture of the humanoid robot, it is determined that the humanoid robot is about to fall, so the safety traction rope is tightened; the distance between the target object (debugging personnel) and the humanoid robot is identified, and based on the distance, it is determined whether the debugging personnel may be injured by the collision with the humanoid robot. If so, the safety traction rope is tightened.
[0170] The humanoid robot motion debugging protection device and humanoid robot posture recognition algorithm provided by the present application only require one person to debug, which saves the number of personnel required for debugging and reduces labor costs. The posture recognition of the humanoid robot by an external depth camera reduces the probability of damage to the humanoid robot caused by its own failure to detect whether it has fallen. During the debugging process, the recognition of the target object is increased by the depth camera, which solves the problem of possible damage to the target object during the debugging process of the humanoid robot and improves the safety of the debugging personnel.
[0171] Although the preferred embodiments of the present application have been described, those skilled in the art may make other changes and modifications to these embodiments once they have learned the basic creative concept. Therefore, the appended claims are intended to be interpreted as including the preferred embodiments and all changes and modifications falling within the scope of the present application.
[0172] Obviously, those skilled in the art can make various changes and modifications to the present application without departing from the spirit and scope of the present application. Thus, if these modifications and variations of the present application fall within the scope of the claims of the present application and their equivalents, the present application is also intended to include these modifications and variations.
Claims
1. A humanoid robot motion debugging protection device, characterized in that: The device comprises: A protection support frame, a protection controller, and a safety traction rope restraint, a first guide rail pulley controller, a second guide rail pulley controller, a third guide rail pulley controller and a depth camera arranged on the protection support frame; the safety traction rope restraint is connected to the humanoid robot through a safety traction rope; The depth camera is used to collect the first posture information of the humanoid robot during the motion debugging of the humanoid robot, and send the first posture information to the protection controller; The protection controller is used to control the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller to move according to the first posture information, so that the safety traction rope and the humanoid robot are in the same vertical plane; and when it is determined according to the first posture information that there is a safety risk in the motion debugging, the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length.
2. The device according to claim 1, characterized in that The protection support frame includes a support column, a support top beam and a movable support cross beam; the support top beam includes a first support top beam and a second support top beam arranged in parallel; the depth camera is connected to the support column; The first guide rail pulley controller is respectively connected to the first end of the first support top beam and the movable support cross beam; the second guide rail pulley controller is respectively connected to the second end of the second support top beam and the movable support cross beam; the third guide rail pulley controller is respectively connected to the movable support cross beam and the safety traction rope restraint.
3. The device according to claim 2, characterized in that The protective support frame comprises a first supporting column and a second supporting column arranged diagonally; The number of the depth cameras is at least two; wherein the first support column and the second support column are each connected to at least one depth camera.
4. The device according to claim 1, characterized in that The depth camera is specifically used to collect the position information of the first key point of the humanoid robot connected to the safety traction rope during the movement debugging of the humanoid robot; wherein the first key point is the center point of the connection point between the two mechanical arms of the humanoid robot and the torso; The protection controller is specifically used to control the movement of the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller according to the position information of the first key point, so that the safety traction rope and the humanoid robot are in the same vertical plane.
5. The device according to claim 4, characterized in that The depth camera is specifically used to collect the position information of the second key point of the humanoid robot during the motion debugging of the humanoid robot; wherein the second key point is the center point of the connection point between the two mechanical legs and the torso of the humanoid robot; The protection controller is specifically used to determine the inclination angle of the humanoid robot based on the position information of the first key point and the position information of the second key point; if the inclination angle is greater than a preset angle threshold, or the height of the first key point is less than a preset height threshold, it is determined that there is a safety risk in the motion debugging.
6. The device according to claim 1, characterized in that The depth camera is further used to collect second position information of the target object in the motion debugging scene during the motion debugging process of the humanoid robot, and send the second position information to the protection controller; The protection controller is also used to determine that there is a safety risk in motion debugging if it is determined that the distance between the humanoid robot and the target object is less than a preset distance threshold based on the first posture information and the second posture information, and control the safety traction rope restraint to adjust the safety traction rope to shorten to a preset length.
7. A humanoid robot motion debugging protection method, characterized in that: The method comprises: The protection controller obtains the first position information of the humanoid robot collected by the depth camera during the motion debugging of the humanoid robot; According to the first posture information, the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller in the humanoid robot motion debugging protection device are controlled to move so that the safety traction rope and the humanoid robot are in the same vertical plane; and when it is determined according to the first posture information that there is a safety risk in the motion debugging, the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length; wherein, the humanoid robot motion debugging protection device includes a protection support frame, and the safety traction rope restraint, the first guide rail pulley controller, the second guide rail pulley controller, the third guide rail pulley controller and the depth camera arranged on the protection support frame; the safety traction rope restraint is connected to the humanoid robot through the safety traction rope.
8. The method according to claim 7, characterized in that The method comprises: Acquire the position information of the first key point of the humanoid robot connected to the safety traction rope collected by the depth camera during the motion debugging of the humanoid robot; wherein the first key point is the center point of the connection point between the two mechanical arms of the humanoid robot and the torso; According to the position information of the first key point, the first guide rail pulley controller, the second guide rail pulley controller and the third guide rail pulley controller are controlled to move so that the safety traction rope and the humanoid robot are in the same vertical plane.
9. The method according to claim 8, characterized in that The method comprises: Acquire the position information of the second key point of the humanoid robot collected by the depth camera during the motion debugging of the humanoid robot; wherein the second key point is the center point of the connection point between the two mechanical legs and the torso of the humanoid robot; According to the position information of the first key point and the position information of the second key point, the inclination angle of the humanoid robot is determined; if the inclination angle is greater than a preset angle threshold, or the height of the first key point is less than a preset height threshold, it is determined that there is a safety risk in the motion debugging.
10. The method according to claim 7, characterized in that The method comprises: Acquire the second position information of the target object in the motion debugging scene collected by the depth camera during the motion debugging of the humanoid robot; If it is determined based on the first posture information and the second posture information that the distance between the humanoid robot and the target object is less than a preset distance threshold, it is determined that there is a safety risk in the motion debugging, and the safety traction rope restraint is controlled to adjust the safety traction rope to shorten to a preset length.
Citation Information
Patent Citations
Robot and tail end control method and device thereof
CN111113430A
Initiative traction protection system applied to quadruped robot walking test
CN111546374A
Foot-type robot walking test protection platform based on draw wire encoder principle
CN111823274A
Rigid-flexible coupling parallel robot multi-color spraying experiment device and spraying method
CN113117942A
Ground simulation test method for complex control process of multi-space robot
CN118150200A
Cited By
Humanoid robot active protection method and device, electronic equipment and storage medium
CN121061838A
Humanoid robot active protection method and device, electronic equipment and storage medium
CN121061838B
Robot control method, robot suspension system and control device
CN121552355A
