Docking information exchange method between robot arm and payload adapter
By installing contact sensors on the active end of the load adapter and combining the control mode of the robot arm, the problem of difficulty in confirming the docking state of the load adapter is solved, and accurate judgment and abnormal handling of the docking state are achieved, ensuring the robot arm installation cabin Efficient operation of external loads.
Patent Information
- Application Number
- CN202410914325.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-09
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-07-09
AI Technical Summary
It is difficult to confirm the docking state of the main and passive ends of the load adapter on the rail, especially in the out-of-cabin environment, which leads to inaccurate judgment of the docking state.
The first contact sensor and the second contact sensor are installed on the docking surface of the active end of the load adapter. Through the low-precision and high-precision position control and visual control mode of the robot arm, the docking status is confirmed in combination with sensor data interpretation to ensure the lock of the capture device. Tight and unlock operation.
The accurate judgment of the docking status of the main and passive ends of the load adapter is achieved, ensuring the normal operation of the load load outside the cabin installation of the robot arm, and timely unlocking in abnormal situations to avoid docking errors.
Smart Images

Figure CN118493402B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of spacecraft, and in particular relates to a method for docking information interaction between a robot 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 active and passive ends of the load adapter come into contact, a force is generated. The relative position and posture of the active and passive ends of the load adapter will change slightly, and the contact state of the contact sensor will change continuously, making it difficult to judge the state.
[0011] 2. The environment outside the cabin is harsh, the probability of the contact sensor failing and always showing a no-contact state increases, and the docking status cannot be accurately obtained. Summary of the invention
[0012] In view of this, the present invention aims to provide a method for interacting docking information between 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 docking information interaction between a manipulator and a payload adapter, 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 close to 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 robot arm grabs the load assembly and transfers the load assembly to a first predetermined distance from the passive end of the load adapter in a low-precision position control mode;
[0016] S2: the robot arm switches from the low-precision position control mode to the high-precision position control mode, and transfers the load assembly from the first predetermined distance to the second predetermined distance from the passive end of the load adapter;
[0017] S3: The robot arm switches from the high-precision position control mode to the visual control mode, and drives the load assembly to approach the passive end of the load adapter with a predetermined force output capacity until the active end of the load adapter docks with the passive end of the load adapter;
[0018] S4: The robotic arm continues to apply force, and the ground station interprets the docking status of the active end of the payload adapter and the passive end of the payload adapter based on the sensor data sent back by the active end of the payload adapter;
[0019] If any of the following conditions are met, the active end of the load adapter is considered to be properly connected to the passive end of the load adapter:
[0020] (1) All four first contact sensors are triggered;
[0021] (2) The two second contact sensors at the diagonal position are triggered;
[0022] (3) Two second contact sensors on the same side are triggered, and at least one first contact sensor on the opposite side is triggered;
[0023] S5: When the ground station confirms that the active end of the payload adapter is docked with the passive end of the payload adapter, a mode switching command is sent to the robotic arm to switch the robotic arm from the visual control mode to the follow-up mode, and a locking command is sent to the active end of the payload adapter to enable the capture device to lock the passive end of the payload adapter.
[0024] Furthermore, after the active end of the load adapter and the passive end of the load adapter are connected for a preset time, if any of the following situations occurs, it is considered that the active end of the load adapter and the passive end of the load adapter are connected abnormally:
[0025] (1) Only the first contact sensor is triggered, and the number does not exceed three;
[0026] (2) Only one of the second touch sensors is triggered, the number of the triggered first touch sensors does not exceed three, and the triggered first touch sensors include a first touch sensor in the same area as the triggered second touch sensor;
[0027] (3) The two second contact sensors on the same side are triggered, and no contact sensor on the opposite side is triggered.
[0028] Furthermore, the preset time is 40s.
[0029] Furthermore, after step S5, the following steps are also included:
[0030] S6: When the ground station confirms that the docking between the active end of the payload adapter and the passive end of the payload adapter is abnormal, a mode switching command is sent to the robotic arm to switch the robotic arm from the visual control mode to the follow-up mode, and an unlocking command is sent 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, when the first contact sensor and the second contact sensor are detected as being in a trigger state for four consecutive sampling periods or are detected as being in a trigger state three times intermittently, they are considered to be triggered.
[0032] Furthermore, the first predetermined distance is 2 m.
[0033] Furthermore, the second predetermined distance is 0.5 m.
[0034] Compared with the prior art, the invention can achieve the following beneficial effects:
[0035] During the docking process between the active and passive ends of the payload adapter, the present invention can accurately determine the docking status and effectively support the work of the robotic arm in installing the extravehicular payload. BRIEF DESCRIPTION OF THE DRAWINGS
[0036] 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:
[0037] Figure 1 A schematic diagram of the structure of the active end of the load adapter of the present invention;
[0038] Figure 2 A schematic diagram of the structure of the passive end of the load adapter according to an embodiment of the present invention;
[0039] Figure 3 A schematic diagram of a process flow of a method for interacting information between a manipulator and a payload adapter in accordance with an embodiment of the present invention;
[0040] Figure 4 A schematic diagram of the relative positions of the first contact sensor and the second contact sensor on the active end of the load adapter according to an embodiment of the present invention;
[0041] 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;
[0042] 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.
[0043] Description of reference numerals:
[0044] Capturing device 1, capturing pin 2, second contact sensor 3, first contact sensor 4. DETAILED DESCRIPTION
[0045] 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.
[0046] 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.
[0047] 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.
[0048] 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.
[0049] The present invention will be described in detail below with reference to the accompanying drawings and in combination with embodiments.
[0050] like Figure 1-Figure 6 As shown, the method for interacting docking information between a robotic arm and a 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 an extravehicular payload, and to guide subsequent on-orbit actions of the robotic arm and the payload adapter.
[0051] 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.
[0052] The installation requirements of the first contact sensor 4 and the second contact sensor 3 are as follows:
[0053] 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;
[0054] 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;
[0055] 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.
[0056] 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.
[0057] The method for exchanging docking information between a robot arm and a payload adapter provided by an embodiment of the present invention comprises the following steps:
[0058] S1: The robot arm grabs the load assembly and transfers the load assembly to a first predetermined distance from the passive end of the load adapter in a low-precision position control mode.
[0059] 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.
[0060] S2: The robot arm switches from the low-precision position control mode to the high-precision position control mode, and transfers the load assembly from the first predetermined distance to the second predetermined distance from the passive end of the load adapter.
[0061] 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.
[0062] S3: The robot arm switches from the high-precision position control mode to the vision control mode, and drives the load assembly to approach the passive end of the load adapter with a predetermined force output capacity until the active end of the load adapter docks with the passive end of the load adapter.
[0063] S4: The robotic arm continues to apply force, and the ground station determines the docking status of the active end of the payload adapter and the passive end of the payload adapter based on the sensor data sent back by the active end of the payload adapter.
[0064] If any of the following conditions are met, the active end of the load adapter is considered to be properly connected to the passive end of the load adapter:
[0065] (1) All four first contact sensors 4 are triggered;
[0066] (2) The two second contact sensors at the diagonal position are triggered;
[0067] (3) Two second contact sensors on the same side are triggered, and at least one first contact sensor 4 on the opposite side is triggered.
[0068] S5: When the ground station confirms that the active end of the payload adapter is docked with the passive end of the payload adapter, a mode switching command is sent to the robotic arm to switch the robotic arm from the visual control mode to the follow-up mode, and a locking command is sent to the active end of the payload adapter to enable the capture device 1 to lock the passive end of the payload adapter.
[0069] 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.
[0070] After the active end of the load adapter and the passive end of the load adapter are connected for a preset time, if any of the following situations occurs, it is considered that the active end of the load adapter and the passive end of the load adapter are connected abnormally:
[0071] (1) Only the first contact sensors 4 are triggered, and the number does not exceed three;
[0072] (2) Only one of the second touch sensors is triggered, the number of the triggered first touch sensors 4 does not exceed three, and the triggered first touch sensors 4 include the first touch sensors 4 in the same area as the triggered second touch sensors;
[0073] (3) The two second contact sensors on the same side are triggered, and no contact sensor on the opposite side is triggered.
[0074] The preset time is set to 40s. When the robot grabs the active end of the payload adapter and docks it with the passive end of the payload adapter, in most cases, it will be successfully docked in a very short time (within 1 second). If the relative posture deviation between the active and passive ends of the payload adapter is too large and cannot be docked smoothly, the active end of the payload adapter will also adjust its own posture under the action of the robot arm force. The longer the preset time, the greater the possibility that the active and passive ends of the payload adapter will be docked in place. However, this situation will cause the motor of the robot arm to stall. For the protection of the motor, the use time of this mode will generally not exceed 1 minute. Considering the actual application, it takes at least 10 seconds for the ground to send instructions, so the docking confirmation time of the payload adapter is set to 40 seconds.
[0075] The basis for determining whether the first contact sensor 4 and the second contact sensor are triggered is as follows:
[0076] When the first contact sensor 4 and the second contact sensor are detected as being in a trigger state for four consecutive sampling periods or are detected as being in a trigger state three times intermittently, they are considered to be triggered.
[0077] The sampling period of the contact sensor is 500ms. During the entire docking process, if there are 4 or more sampling periods without collecting the trigger state, it is regarded as the trigger state.
[0078] 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. If a second contact sensor is triggered, the first contact sensor 4 near it will definitely be triggered.
[0079] After step S5, the following steps are also included:
[0080] S6: When the ground station confirms that the docking between the active end of the payload adapter and the passive end of the payload adapter is abnormal, a mode switching command is sent to the robotic arm to switch the robotic arm from the visual control mode to the follow-up mode, and an unlocking command is sent 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.
[0081] 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.
[0082] 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.
[0083] 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 exchanging docking information between a manipulator and a payload adapter, 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 on the docking surface of the active end of the payload adapter near the four capture devices; It is characterized in that The method comprises the following steps: S1: The robot arm grabs the load assembly and transfers the load assembly to a first predetermined distance from the passive end of the load adapter in a low-precision position control mode; S2: the robot arm switches from the low-precision position control mode to the high-precision position control mode, and transfers the load assembly from the first predetermined distance to the second predetermined distance from the passive end of the load adapter; S3: The robot arm switches from the high-precision position control mode to the visual control mode, and drives the load assembly to approach the passive end of the load adapter with a predetermined force output capacity until the active end of the load adapter docks with the passive end of the load adapter; S4: The robotic arm continues to apply force, and the ground station interprets the docking status of the active end of the payload adapter and the passive end of the payload adapter based on the sensor data sent back by the active end of the payload adapter; If any of the following conditions are met, the active end of the load adapter is considered to be properly connected to the passive end of the load adapter: (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; 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, a mode switching command is sent to the manipulator to switch the manipulator from the visual control mode to the follow-up mode, and a locking command is sent to the active end of the payload adapter to enable the capture device to lock the passive end of the payload adapter; After the active end of the load adapter and the passive end of the load adapter are connected for a preset time, if any of the following situations occurs, it is considered that the active end of the load adapter and the passive end of the load adapter are connected abnormally: (1) Only the first contact sensor is triggered, and the number does not exceed three; (2) Only one of the second touch sensors is triggered, the number of the triggered first touch sensors does not exceed three, and the triggered first touch sensors include a first touch sensor in the same area as the triggered second touch sensor; (3) The two second contact sensors on the same side are triggered, and no contact sensor on the opposite side is triggered; After step S5, the following steps are also included: S6: When the ground station confirms that the docking between the active end of the payload adapter and the passive end of the payload adapter is abnormal, a mode switching command is sent to the robotic arm to switch the robotic arm from the visual control mode to the follow-up mode, and an unlocking command is sent 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.
2. The method for exchanging information between a manipulator and a payload adapter according to claim 1, It is characterized in that The default time is 40s.
3. The method for exchanging information between a robot arm and a payload adapter according to claim 1, It is characterized in that When the first contact sensor and the second contact sensor are detected as being in a trigger state for four consecutive sampling cycles or are detected as being in a trigger state three times intermittently, they are considered to be triggered.
4. The method for exchanging information between a robot arm and a payload adapter according to claim 1, It is characterized in that The first predetermined distance is 2 m.
5. The method for exchanging information between a manipulator and a payload adapter when docking according to claim 1, It is characterized in that The second predetermined distance is 0.5 m.
