Real-time interaction method between robot arm and payload adapter docking status

By installing capture devices and sensors on the active end of the load adapter, combining the control mode and visual control of the ground station, the docking status of the load adapter is judged in real time and the attitude is adjusted, which solves the problems of difficulty in confirming the docking status of the load adapter and stress damage, and improves the machinery Accuracy and efficiency of arm installation out-of-cabin loads.

CN118456449BActive Publication Date: 2024-11-05ZHONGLU SPACE LIQUID METAL TECHNOLOGY (JIANGSU) CO LTD +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410914323.5
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-07-09
Publication Date
2024-11-05
Estimated Expiration
2044-07-09

AI Technical Summary

Technical Problem

During the installation of the out-of-cabin load of the robot arm, it is difficult to confirm the docking status of the load adapter and the continuous force of the robot arm may lead to stress damage and robot arm life consumption.

Method used

Using a real-time interaction method for docking state between the robot arm and the load adapter, by installing the capture device and the first contact sensor at four corners of the active end of the load adapter, the low-precision and high-precision position control mode of the ground station are used, combining visual control and Sensor data, judge the docking status in real time, and adjust the attitude of the load adapter based on the attitude information to avoid continuous force application.

Benefits of technology

It improves the accuracy of docking state judgment, reduces the risk of stress damage, and improves the working efficiency of the robot arm installation outside the cabin load.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118456449B_ABST
    Figure CN118456449B_ABST
Patent Text Reader

Abstract

The present invention relates to the field of spacecraft technology, and more particularly to a method for real-time interaction between a manipulator and a payload adapter in docking status, wherein a manipulator is used to dock a primary and a passive end of a payload adapter, and the manipulator reads the docking status of the primary and passive ends of the payload adapter according to docking status parameters in the return data of the active end of the payload adapter; if the docking is not in place, the active end of the payload adapter feeds back its own attitude information to the manipulator according to the triggering state of the sensor, and the manipulator adjusts the attitude of the active end of the payload adapter according to the attitude information of the active end of the payload adapter; if the docking is in place, the ground station switches the manipulator to a follow-up mode, and drives the active end of the payload adapter to lock the passive end of the payload adapter. The present invention can timely judge the docking status during the docking process between the primary and passive ends of the payload adapter, and the judgment method takes into account the influence of sensor failure and unstable contact state, thereby improving the judgment accuracy of the docking status.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of spacecraft, and in particular relates to a real-time interaction method for docking status between a mechanical arm and a payload adapter. Background Art

[0002] In order to allocate resources efficiently, large spacecraft have begun to set up exposure platforms outside the cabin, install a large number of extravehicular payload interface support equipment on the exposure platforms, and concentrate on conducting extravehicular payload support tests.

[0003] The extravehicular payload interface support device is usually called a payload adapter, which is divided into two parts: the active end and the passive end (respectively Figure 1 and Figure 2 As shown in the figure, the two parts are used in orbit. The passive end of the payload adapter is installed on the exposed platform outside the cabin, and is composed of a mechanical structure and various interface connectors, which are connected to the power distribution, information, and thermal control systems on the spacecraft; the active end of the payload adapter is composed of a mechanical structure, an electronic control system, a motor, a transmission mechanism, a capture device, a connector, and a manual operation interface. The electronic control system can control the motor to drive the transmission mechanism, and then drive the capture device to achieve locking or unlocking functions.

[0004] The active end of the payload adapter, the extravehicular payload, and the target adapter of the manipulator are pre-installed together to form a payload assembly. When the manipulator grabs the target adapter of the manipulator outside the cabin, the active end of the payload adapter is connected to the power supply and control system of the manipulator, and can receive instructions sent by the manipulator, control the motor to drive the transmission mechanism, and then drive the capture device to lock or unlock the passive end of the payload adapter.

[0005] Normally, the installation of extravehicular payloads is completed jointly by the robotic arm and the active end of the payload adapter. The payload assembly is transferred to the outside of the cabin through a special mechanism, then grabbed by the robotic arm and transferred to the designated passive end of the payload adapter on the exposure platform. After the docking of the active and passive ends of the payload adapter is completed, the active end of the payload adapter is controlled to complete the locking of the passive end of the payload adapter, thereby realizing the connection between the spacecraft power distribution, information, and thermal control systems and the extravehicular payload. After the installation of the extravehicular payload is completed, the robotic arm is withdrawn, and the active and passive ends of the payload adapter remain locked to each other through structural design, which can support the testing of extravehicular payloads for a long time.

[0006] In the process of installing the extravehicular payload by the robotic arm, the most important step is to achieve the docking of the active and passive ends of the payload adapter through the robotic arm, ensure that the docking surfaces between the active and passive ends of the payload adapter fit together, and control the active end of the payload adapter to complete the locking of the passive end of the payload adapter after docking. Due to the constraints of the force-applying characteristics of the robotic arm, after completing the docking of the active and passive ends of the payload adapter and before controlling the active end of the payload adapter to implement the locking operation, the robotic arm itself will switch to the follow-up state, that is, the robotic arm will no longer apply any force to the outside, and the entire robotic arm will "float" in outer space so that its own movement will not be affected when the active end of the payload adapter implements the locking operation. In order to prevent the robot arm from drifting away after switching to the follow-up state, causing the main and passive ends of the load adapter to separate again, matching capture devices 1 and capture pins 2 are designed at the main and passive ends of the load adapter. The capture devices 1 are distributed at the four corners of the docking surface of the active end of the load adapter, and the capture pins 2 are distributed at the four corners of the docking surface of the passive end of the load adapter. When the active end of the load adapter is docked with the passive end of the load adapter under the control of the robot arm, mutual capture can be achieved. At this time, the main and passive ends of the load adapter are constrained by each other and cannot be separated even after the robot arm switches to the follow-up mode, which can ensure the normal implementation of subsequent locking operations. Therefore, how to confirm whether the main and passive ends of the load adapter have been docked is a key link in the installation of extravehicular payloads by the robot arm.

[0007] Since the main and passive ends of the load adapter will generate a force pulling them together during the locking process, the locking operation does not require the main and passive ends of the load adapter to have complete contact with each other in order to implement the locking operation. In order to reduce the operational requirements for the robotic arm, the effective position of the capture device 1 is a certain distance higher than the docking surface, that is, during the docking process, the main and passive ends of the load adapter first enter a state of capturing each other, and only after further approaching will the main and passive ends of the load adapter contact each other. As long as the capture state is entered, the active end of the load adapter can complete the subsequent locking action.

[0008] To this end, a one-way door mechanism is designed inside each capture device 1 to realize the capture function, and a first contact sensor is installed on the side near the root inside each capture device 1. When the active and passive ends of the load adapter are close enough, the capture pin 2 will fall into the one-way door mechanism of the capture device 1, and continue to push the one-way door open under the action of the mechanical arm until it is completely placed in the capture device 1. At this time, the capture pin 2 will squeeze and trigger the first contact sensor, and the one-way door will return to its original position under the action of the internal spring force. The capture pin 2 cannot push the one-way door back inside the capture device 1, thereby realizing the capture of the passive end of the load adapter by the active end of the load adapter. In addition, a second contact sensor 3 is installed at the position of each capture device 1 on the docking surface of the active end of the load adapter. When the active and passive ends of the load adapter are in contact, the second contact sensor 3 will be triggered.

[0009] Although a contact sensor is installed at the active end of the load adapter to determine the relative position of the active and passive ends of the load adapter, the following problems still exist when it is used in orbit:

[0010] 1. When the manipulator installs the extravehicular payload, there is an initial posture deviation. When the active and passive ends of the payload adapter are docked, all contact sensors may not be triggered, while the active and passive ends of the payload adapter have been fully captured, resulting in missed status judgment.

[0011] 2. Although the posture of the active end of the payload adapter can be adjusted by continuously applying force with a robotic arm, eventually triggering all contact sensors, the robotic arm continuously applies force to "squeeze" the active end of the payload adapter, which poses a risk of stress damage to both parties and will also accelerate the consumption of the robotic arm's on-orbit life. Summary of the invention

[0012] In view of this, the present invention aims to provide a real-time interactive method for the docking status of a robotic arm and a payload adapter, so as to solve the technical problem of difficulty in in-orbit confirmation of the docking status of the active and passive ends of the payload adapter.

[0013] To achieve the above object, the technical solution created by the present invention is implemented as follows:

[0014] A method for real-time interaction between a manipulator and a payload adapter docking state, wherein the payload adapter is divided into an active end and a passive end, the active end of the payload adapter, an extravehicular payload, and a manipulator target adapter form a payload assembly, capture devices are respectively installed at four corners of a docking surface of the active end of the payload adapter, first contact sensors are respectively installed inside the four capture devices, and second contact sensors are respectively installed at positions near the four capture devices on the docking surface of the active end of the payload adapter; the method comprises the following steps:

[0015] S1: The ground station switches the manipulator to a low-precision position control mode, and the manipulator transfers the payload assembly to a first predetermined distance from the passive end of the payload adapter in the low-precision position control mode;

[0016] S2: The ground station sets the robotic arm to a high-precision position control mode, and the robotic arm transfers the payload assembly from the first predetermined distance to the second predetermined distance from the passive end of the payload adapter in the high-precision position control mode;

[0017] S3: The ground station sets the manipulator and the active end of the payload adapter to an interactive state, and switches the manipulator to a visual control mode. The manipulator drives the payload assembly to approach the passive end of the payload adapter with a predetermined force until the active end of the payload adapter docks with the passive end of the payload adapter.

[0018] S4: The robot arm reads the docking status parameters in the return data of the active end of the payload adapter in real time to determine the docking status of the active end of the payload adapter and the passive end of the payload adapter. If any of the following conditions is met, the active end of the payload adapter and the passive end of the payload adapter are considered to be docked in place:

[0019] (1) All four first contact sensors are triggered;

[0020] (2) The two second contact sensors at the diagonal position are triggered;

[0021] (3) Two second contact sensors on the same side are triggered, and at least one first contact sensor on the opposite side is triggered;

[0022] When the active end of the load adapter is not properly docked with the passive end of the load adapter, the active end of the load adapter feeds back its own posture information to the manipulator according to the triggering state of the first contact sensor and the second contact sensor, and the manipulator adjusts the posture of the active end of the load adapter according to the posture information of the active end of the load adapter; wherein,

[0023] Determining the posture information of the locking direction of the active end of the load adapter and the posture information of the active end of the load adapter perpendicular to the locking direction according to the triggering states of the first contact sensor and the second contact sensor;

[0024] The attitude information of the active end of the payload adapter in the locking direction is represented by the upper 4 bits of the docking state parameter, and the attitude information of the active end of the payload adapter perpendicular to the locking direction is represented by the lower 4 bits of the docking state parameter;

[0025] The attitude information includes a positive bias state, a negative bias state and a horizontal state. When the attitude information of the active end of the load adapter in the locking direction and the attitude information of the active end of the load adapter perpendicular to the locking direction are both in the horizontal state, it is considered that the active end of the load adapter and the passive end of the load adapter are docked in place;

[0026] S5: When the ground station confirms that the active end of the payload adapter is docked with the passive end of the payload adapter, the ground station switches the manipulator arm to the follow-up mode and sends a locking command to the active end of the payload adapter, so that the capture device locks the passive end of the payload adapter.

[0027] Furthermore, the robotic arm determines the docking status of the active end of the payload adapter and the passive end of the payload adapter once every preset time. When the docking is not in place, the robotic arm adjusts the posture angle of the active end of the payload adapter according to the current posture information of the active end of the payload adapter.

[0028] Furthermore, the robot arm adjusts the active end of the load adapter in one direction each time, and the adjustment angle is 1°.

[0029] Furthermore, the robot arm first adjusts the attitude angle of the active end of the load adapter in the locking direction, and then adjusts the attitude angle of the active end of the load adapter perpendicular to the locking direction.

[0030] Furthermore, when the robotic arm adjusts the attitude angle of the active end of the payload adapter and determines that it has not been docked for four consecutive times, the ground station switches the robotic arm to the follow-up mode and sends an unlocking command to the active end of the payload adapter to complete the unlocking between the active end of the payload adapter and the passive end of the payload adapter. Then the robotic arm drives the payload assembly backward to separate the active end of the payload adapter from the passive end of the payload adapter.

[0031] Furthermore, the preset time is 5s.

[0032] Furthermore, when adjusting the attitude angle of the active end of the load adapter, the robot arm adjusts the force applied to the active end of the load adapter according to the attitude information of the locking direction of the active end of the load adapter and the attitude information of the active end of the load adapter perpendicular to the locking direction.

[0033] Furthermore, the first predetermined distance is 2 m.

[0034] Furthermore, the second predetermined distance is 0.5 m.

[0035] Furthermore, when the first contact sensor and the second contact sensor are detected as being in a trigger state for four consecutive telemetry cycles or are detected as being in a trigger state three times intermittently, they are considered to be triggered.

[0036] Compared with the prior art, the invention can achieve the following beneficial effects:

[0037] 1. During the docking process between the active end of the payload adapter and the active end of the payload adapter, the docking status is judged in a timely manner. The judgment method takes into account the influence of sensor failure and unstable contact status, improves the judgment accuracy of the docking status, and can effectively support the work of the robotic arm to install the extravehicular payload.

[0038] 2. When adjusting the attitude angle of the active end of the load adapter, the robot arm can adjust the forces applied in two directions according to the current attitude of the active end of the load adapter, avoiding the risk of stress damage to each other caused by continuous force "squeezing" the load adapter. BRIEF DESCRIPTION OF THE DRAWINGS

[0039] The drawings constituting part of the present invention are used to provide a further understanding of the present invention. The exemplary embodiments and descriptions of the present invention are used to explain the present invention and do not constitute an improper limitation on the present invention. In the drawings:

[0040] Figure 1 A schematic diagram of the structure of the active end of the load adapter of the present invention;

[0041] Figure 2 A schematic diagram of the structure of the passive end of the load adapter according to an embodiment of the present invention;

[0042] Figure 3 A schematic flow chart of a method for real-time interaction between a robot arm and a payload adapter in docking state according to an embodiment of the present invention;

[0043] Figure 4 A schematic diagram of the relative positions of the first contact sensor and the second contact sensor of an embodiment of the present invention on the active end of the load adapter;

[0044] Figure 5 A schematic diagram of the positional relationship between the capture device and the first contact sensor of an embodiment of the present invention;

[0045] Figure 6 A schematic diagram of the relative positions of the capture pin and the first contact sensor after the capture pin falls into the capture device according to an embodiment of the present invention.

[0046] Description of reference numerals:

[0047] Capturing device 1, capturing pin 2, second contact sensor 3, first contact sensor 4. DETAILED DESCRIPTION

[0048] In order to make the purpose, technical solution and advantages of the invention more clear, the invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be understood that the specific embodiments described here are only used to explain the invention and do not constitute a limitation of the invention.

[0049] It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments may be combined with each other.

[0050] In the description of the present invention, it should be understood that the terms "center", "longitudinal", "lateral", "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside" and the like indicate positions or positional relationships based on the positions or positional relationships shown in the accompanying drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as a limitation on the present invention. In addition, the terms "first", "second", etc. are only used for descriptive purposes, and cannot be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Thus, features defined as "first", "second", etc. may explicitly or implicitly include one or more of the features. In the description of the present invention, unless otherwise specified, "multiple" means two or more.

[0051] In the description of the invention, it should be noted that, unless otherwise clearly specified and limited, the terms "installation", "connection" and "connection" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in the invention can be understood according to specific circumstances.

[0052] The present invention will be described in detail below with reference to the accompanying drawings and in combination with embodiments.

[0053] like Figure 1-Figure 6 As shown, the real-time interaction method of the docking status of the robotic arm and the payload adapter provided in an embodiment of the present invention is used to determine whether the active and passive ends of the payload adapter are properly docked during the process of the robotic arm installing the extravehicular payload, and to guide the subsequent on-orbit actions of the robotic arm and the payload adapter.

[0054] The payload adapter is divided into an active end and a passive end. The active end of the payload adapter, the extravehicular payload, and the robotic arm target adapter form a payload assembly. Capture devices 1 are respectively installed on the four corners of the docking surface of the active end of the payload adapter, and first contact sensors 4 are respectively installed inside the four capture devices 1. Second contact sensors 3 are respectively installed on the docking surface of the active end of the payload adapter near the four capture devices 1.

[0055] The payload adapter is divided into an active end and a passive end. The active end of the payload adapter, the extravehicular payload, and the robotic arm target adapter form a payload assembly. Capture devices 1 are respectively installed on the four corners of the docking surface of the active end of the payload adapter, and first contact sensors 4 are respectively installed inside the four capture devices 1. Second contact sensors 3 are respectively installed on the docking surface of the active end of the payload adapter near the four capture devices 1.

[0056] The installation requirements of the first contact sensor 4 and the second contact sensor 3 are as follows:

[0057] 1. The four second contact sensors 3 are at the same height, symmetrically arranged on the docking surface of the active end of the load adapter, respectively located at the top and bottom edges of the active end of the load adapter, and the distance from the adjacent side edges is no more than 5% of the length of the top or bottom edge;

[0058] Second, the four first contact sensors 4 are at the same height and symmetrically placed, and are located at the four corners of the docking surface as much as possible, closer to the center of the side of the active end of the load adapter than the adjacent second contact sensor 3, and the distance from the adjacent top edge or bottom edge is 5% to 8% of the side length;

[0059] 3. The height difference between the first contact sensor 4 and the second contact sensor 3 is not greater than 2% of the side length.

[0060] The above-mentioned first contact sensor 4 and second contact sensor 3 are designed mainly to determine the relative position of each contact sensor in three-dimensional space. In the subsequent process of docking the active and passive ends of the load adapter, the relative posture state of the active end and the passive end of the load adapter is judged by the triggering status of each contact sensor, and then it is determined whether the load adapter has moved into place.

[0061] The method for real-time interaction between the docking status of a robot arm and a payload adapter provided by an embodiment of the present invention comprises the following steps:

[0062] S1: The ground station switches the manipulator arm to a low-precision position control mode, and the manipulator arm transfers the payload assembly to a first predetermined distance from the passive end of the payload adapter in the low-precision position control mode.

[0063] The robot arm transfers the load assembly to a remote position directly above the passive end of the load adapter, ensuring that the active end of the load adapter is more than 2m away from the passive end of the load adapter, that is, the first predetermined distance is 2m.

[0064] S2: The ground station sets the robotic arm to a high-precision position control mode, and the robotic arm transfers the payload assembly from the first predetermined distance to the second predetermined distance from the passive end of the payload adapter in the high-precision position control mode.

[0065] The robot arm drives the load assembly toward the passive end of the load adapter in a high-precision position control mode until it is close to the top of the passive end of the load adapter, ensuring that the active end of the load adapter is within 0.5m of the passive end of the load adapter, that is, the second predetermined distance is 0.5m.

[0066] S3: The ground station sets the manipulator arm and the active end of the payload adapter to an interactive state, and switches the manipulator arm to a visual control mode. The manipulator arm drives the payload assembly to approach the passive end of the payload adapter with a predetermined force until the active end of the payload adapter docks with the passive end of the payload adapter.

[0067] S4: The robot arm reads the docking status parameters in the return data of the active end of the payload adapter in real time, and judges the docking status of the active end of the payload adapter and the passive end of the payload adapter.

[0068] The docking status parameter is a byte at a specific position in the returned data. 0x00 indicates that the four first contact sensors 4 and the four second contact sensors 3 are not triggered, and 0xAA indicates that the docking is in place.

[0069] When the docking state parameter of the active end of the load adapter changes to 0xAA, it is considered that the active end of the load adapter is docked with the passive end of the load adapter, and step S5 is executed.

[0070] The basis for the docking status parameter of the active end of the payload adapter to become 0xAA is as follows:

[0071] (1) All four first contact sensors 4 are triggered;

[0072] (2) The two second contact sensors 3 at the diagonal position are triggered;

[0073] (3) Two second contact sensors 3 on the same side are triggered, and at least one first contact sensor 4 on the opposite side is triggered.

[0074] If any of the above conditions are met, it is considered that the active end of the load adapter and the passive end of the load adapter are properly connected.

[0075] The basis for determining whether the first contact sensor 4 and the second contact sensor 3 are triggered is as follows:

[0076] When the first contact sensor 4 and the second contact sensor 3 are detected as being in a trigger state for four consecutive telemetry cycles or are detected as being in a trigger state three times intermittently, they are considered to be triggered.

[0077] Since the effective position of the capture device 1 is a certain distance higher than the docking surface, the first contact sensor 4 is higher than the second contact sensor 3. If a second contact sensor 3 is triggered, the first contact sensor 4 near it will definitely be triggered.

[0078] During the docking process between the active end of the load adapter and the passive end of the load adapter, when the first second contact sensor 3 is triggered, the active end of the load adapter feeds back its own posture information to the robotic arm according to the triggering status of the first contact sensor 4 and the second contact sensor 3. If the active end of the load adapter and the passive end of the load adapter are not docked within 5 seconds, the active end of the load adapter feeds back its own posture information to the robotic arm according to the triggering status of the first contact sensor 4 and the second contact sensor 3, and the robotic arm adjusts the posture of the active end of the load adapter according to the posture information of the active end of the load adapter.

[0079] During the posture adjustment of the active end of the load adapter, the posture information of the locking direction of the active end of the load adapter and the posture information of the active end of the load adapter perpendicular to the locking direction are determined according to the triggering states of the first contact sensor 4 and the second contact sensor 3.

[0080] The attitude information of the locking direction of the active end of the load adapter is represented by the high 4 bits of the docking state parameter, and the attitude information of the active end of the load adapter perpendicular to the locking direction is represented by the low 4 bits of the docking state parameter. Among them, 1100B represents the positive bias state, 0011B represents the negative bias state, and 1010B represents the horizontal state. The corresponding directions of the positive bias and the negative bias are agreed upon in advance by the active end of the load adapter and the manipulator. The corresponding directions of the positive bias and the negative bias are actually two opposite directions; the horizontal state means that the locking direction of the active end of the load adapter is parallel to the horizontal plane, and the direction perpendicular to the locking direction of the active end of the load adapter is parallel to the plumb bob plane. At this time, the docking surface of the active end of the load adapter is parallel to the docking surface of the passive end of the load adapter. Then the docking state parameter is 10101010B, that is, 0xAA, which is regarded as the active end of the load adapter and the passive end of the load adapter docking in place.

[0081] The present invention adjusts the active end of the load adapter in a locking direction and in a direction perpendicular to the locking direction according to the positive bias state and the negative bias state, thereby realizing the posture angle adjustment of the active end of the load adapter.

[0082] The robotic arm determines the docking status of the active end of the load adapter and the passive end of the load adapter every 5 seconds. If it is determined that the active end of the load adapter and the passive end of the load adapter are not docked, the robotic arm adjusts the attitude angle of the active end of the load adapter according to the current attitude information of the active end of the load adapter.

[0083] When the robot arm adjusts the attitude angle of the active end of the payload adapter and determines that the docking is not in place for four consecutive times, step S6 is executed.

[0084] When adjusting the attitude angle of the active end of the load adapter, the robotic arm adjusts the force applied to the active end of the load adapter according to the attitude information of the locking direction of the active end of the load adapter and the attitude information of the active end of the load adapter perpendicular to the locking direction, to ensure that the robotic arm will not excessively "squeeze" the active end of the load adapter due to continuous force application, thereby avoiding the risk of stress damage between the robotic arm and the active end of the load adapter.

[0085] The robot arm adjusts the active end of the load adapter in one direction each time, and the adjustment angle is 1°.

[0086] If two orthogonal directions (i.e., the locking direction of the active end of the load adapter and its perpendicular direction) need to be adjusted, the robot arm first adjusts the attitude angle of the locking direction of the active end of the load adapter, and then adjusts the attitude angle of the active end of the load adapter perpendicular to the locking direction.

[0087] S5: When the ground station confirms that the active end of the payload adapter is docked with the passive end of the payload adapter, the ground station switches the robotic arm to the follow-up mode and sends a locking command to the active end of the payload adapter, so that the capture device 1 locks the passive end of the payload adapter.

[0088] When the docking state parameter changes to 0xAA, the robot arm immediately switches to the follow-up mode and locks the active end of the payload adapter and the passive end of the payload adapter.

[0089] When the capture device 1 performs the locking action, the one-way door returns to its original position under the action of the internal spring force, and the capture pin 2 cannot push the one-way door open in the reverse direction inside the capture device 1, thereby locking the capture pin 2 and realizing the capture of the passive end of the load adapter by the active end of the load adapter.

[0090] S6: The ground station switches the manipulator arm to the follow-up mode and sends an unlocking command to the active end of the payload adapter to complete the unlocking between the active end of the payload adapter and the passive end of the payload adapter. Then the manipulator arm drives the payload assembly backward to separate the active end of the payload adapter from the passive end of the payload adapter.

[0091] When the active end of the load adapter and the passive end of the load adapter are unlocked, the robotic arm drives the load assembly back to a relatively close position just above the passive end of the load adapter (the active end of the load adapter and the active end of the load adapter are within 0.5m), and the follow-up work is carried out after the decision is made by the ground technicians.

[0092] It should be understood that the various forms of processes shown above can be used to reorder, add or delete steps. For example, the steps described in the disclosure of the present invention can be performed in parallel, sequentially or in different orders, as long as the desired results of the technical solution disclosed in the present invention can be achieved, and this document does not limit this.

[0093] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims

1. A method for real-time interaction between a manipulator and a payload adapter in docking status, wherein the payload adapter is divided into an active end and a passive end, the active end of the payload adapter, an extravehicular payload, and a manipulator target adapter form a payload assembly, capture devices are respectively installed at the four corners of the docking surface of the active end of the payload adapter, first contact sensors are respectively installed inside the four capture devices, and second contact sensors are respectively installed at positions near the four capture devices on the docking surface of the active end of the payload adapter; characterized in that: The method comprises the following steps: S1: The ground station switches the manipulator to a low-precision position control mode, and the manipulator transfers the payload assembly to a first predetermined distance from the passive end of the payload adapter in the low-precision position control mode; S2: The ground station sets the robotic arm to a high-precision position control mode, and the robotic arm transfers the payload assembly from the first predetermined distance to the second predetermined distance from the passive end of the payload adapter in the high-precision position control mode; S3: The ground station sets the manipulator and the active end of the payload adapter to an interactive state, and switches the manipulator to a visual control mode. The manipulator drives the payload assembly to approach the passive end of the payload adapter with a predetermined force until the active end of the payload adapter docks with the passive end of the payload adapter. S4: The robot arm reads the docking status parameters in the return data of the active end of the payload adapter in real time to determine the docking status of the active end of the payload adapter and the passive end of the payload adapter. If any of the following conditions is met, the active end of the payload adapter and the passive end of the payload adapter are considered to be docked in place: (1) All four first contact sensors are triggered; (2) The two second contact sensors at the diagonal position are triggered; (3) Two second contact sensors on the same side are triggered, and at least one first contact sensor on the opposite side is triggered; When the active end of the load adapter is not properly docked with the passive end of the load adapter, the active end of the load adapter feeds back its own posture information to the manipulator according to the triggering state of the first contact sensor and the second contact sensor, and the manipulator adjusts the posture of the active end of the load adapter according to the posture information of the active end of the load adapter; wherein, Determining the posture information of the locking direction of the active end of the load adapter and the posture information of the active end of the load adapter perpendicular to the locking direction according to the triggering states of the first contact sensor and the second contact sensor; The attitude information of the active end of the payload adapter in the locking direction is represented by the upper 4 bits of the docking state parameter, and the attitude information of the active end of the payload adapter perpendicular to the locking direction is represented by the lower 4 bits of the docking state parameter; The attitude information includes a positive bias state, a negative bias state and a horizontal state. When the attitude information of the active end of the load adapter in the locking direction and the attitude information of the active end of the load adapter perpendicular to the locking direction are both in the horizontal state, it is considered that the active end of the load adapter and the passive end of the load adapter are docked in place; S5: When the ground station confirms that the active end of the payload adapter is properly docked with the passive end of the payload adapter, the ground station switches the manipulator arm to the follow-up mode and sends a locking command to the active end of the payload adapter so that the capture device locks the passive end of the payload adapter; The robot arm determines the docking status of the active end of the payload adapter and the passive end of the payload adapter every preset time. When the docking is not in place, the robot arm adjusts the attitude angle of the active end of the payload adapter according to the current attitude information of the active end of the payload adapter. When the manipulator adjusts the attitude angle of the active end of the payload adapter and determines that it is not docked for four consecutive times, the ground station switches the manipulator to the follow-up mode and sends an unlocking command to the active end of the payload adapter to complete the unlocking between the active end of the payload adapter and the passive end of the payload adapter. Then the manipulator drives the payload assembly backward to separate the active end of the payload adapter from the passive end of the payload adapter. When adjusting the attitude angle of the active end of the load adapter, the robot arm adjusts the force applied to the active end of the load adapter according to the attitude information of the locking direction of the active end of the load adapter and the attitude information of the active end of the load adapter perpendicular to the locking direction.

2. The real-time interaction method of the docking status between the robot arm and the payload adapter according to claim 1 is characterized in that: The robot arm adjusts the active end of the load adapter in one direction each time, and the adjustment angle is 1°.

3. The real-time interaction method of the docking status between the robot arm and the payload adapter according to claim 2 is characterized in that: The robot arm first adjusts the attitude angle of the active end of the load adapter in the locking direction, and then adjusts the attitude angle of the active end of the load adapter perpendicular to the locking direction.

4. The method for real-time interaction between the docking status of a robot arm and a payload adapter according to claim 1, characterized in that: The default time is 5s.

5. The method for real-time interaction between the docking status of a robot arm and a payload adapter according to claim 1, characterized in that: The first predetermined distance is 2 m.

6. The method for real-time interaction between the docking status of a robot arm and a payload adapter according to claim 1, characterized in that: The second predetermined distance is 0.5 m.

7. The method for real-time interaction between the docking status of a robot arm and a payload adapter according to claim 1, characterized in that: When the first contact sensor and the second contact sensor are detected as being in a trigger state for four consecutive telemetry cycles or are detected as being in a trigger state three times intermittently, they are considered to be triggered.