Control method and device, mechanical movement equipment and computer readable storage medium

By obtaining the motion sequence of the mechanical module and the safety door status of the storage warehouse, the movement movement in the action sequence is gradually performed, the problem of data loss during the working process of the mechanical motion module, and the safety of the data and the security of the operator.

CN119356161APending Publication Date: 2025-01-24AIKANG MEDTECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411372630.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-29
Publication Date
2025-01-24

AI Technical Summary

Technical Problem

During the operation of the mechanical motion module, direct power outage leads to loss of working data.

Method used

By obtaining the motion sequence of the mechanical module and the safety door status of the storage warehouse, when the security door is closed, the movement movement in the action sequence is gradually performed, and the action sequence is updated after the execution of each action to ensure the preservation of the data.

Benefits of technology

The working data of the mechanical module is effectively avoided, while ensuring the safety of the operator's security, it ensures the normal operation and data preservation of the mechanical mobility module.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119356161A_ABST
    Figure CN119356161A_ABST
Patent Text Reader

Abstract

The invention relates to a control method and device, mechanical movement equipment and a computer readable storage medium. The method comprises the following steps: acquiring a to-be-executed action sequence of a mechanical motion module; the action sequence to be executed comprises a plurality of motion actions which are sequentially arranged according to the execution sequence; obtaining the state of a safety door of the storage warehouse; when the safety door of the storage warehouse is in a closed state, the first motion action in the action sequence to be executed is determined as the current motion action, and the mechanical motion module is controlled to execute the current motion action; after the current motion action is executed, deleting the current motion action from the to-be-executed action sequence, and updating the to-be-executed action sequence; and returning to the step of acquiring the state of the safety door of the storage warehouse and continuing to execute. By adopting the method, loss of working data of the mechanical motion module can be avoided.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of control technology, and in particular to a control method, device, mechanical motion equipment and computer-readable storage medium. Background Art

[0002] With the development of automation control technology, the application of automation control technology is becoming more and more extensive. Automatically operated mechanical motion modules can replace people to complete various tasks. For example, in a storage warehouse, the mechanical motion module can perform various warehouse management tasks such as outbound, inbound, and inventory to manage the products in the warehouse, ensure the safety of personnel and improve work efficiency. During the operation of the mechanical motion module in the storage warehouse, an emergency may occur and the operator is required to enter the storage warehouse. In order to avoid the mechanical motion module from causing harm to the operator, the prior art usually directly cuts off the power to the mechanical motion module to force the mechanical motion of the mechanical motion module to stop.

[0003] However, when the mechanical motion module is working, directly cutting off the power to the mechanical motion module will result in loss of working data of the mechanical motion module. Summary of the invention

[0004] Based on this, it is necessary to provide a control method, device, mechanical motion equipment and computer-readable storage medium that can avoid the loss of working data of the mechanical motion module in order to address the above technical problems.

[0005] In a first aspect, the present application provides a control method for controlling the mechanical motion of a mechanical motion module in a storage warehouse, the control method comprising:

[0006] Acquire a sequence of actions to be executed of the mechanical motion module; the sequence of actions to be executed includes a plurality of motion actions arranged in sequence according to an execution order;

[0007] Obtaining the status of the security door of the storage warehouse;

[0008] When the safety door of the storage warehouse is in a closed state, determining the first motion action in the action sequence to be executed as the current motion action, and controlling the mechanical motion module to execute the current motion action;

[0009] After the current motion action is executed, the current motion action is deleted from the sequence of actions to be executed, and the sequence of actions to be executed is updated;

[0010] Return to the step of obtaining the status of the security door of the storage warehouse and continue executing.

[0011] In a second aspect, the present application further provides a control device for controlling the mechanical motion of a mechanical motion module in a storage warehouse, the control device comprising:

[0012] An acquisition module, used to acquire an action sequence to be executed by the mechanical motion module; the action sequence includes a plurality of motion actions arranged in sequence according to an execution order; and acquire the state of the safety door of the storage warehouse;

[0013] A control module is used to, when the safety door of the storage warehouse is in a closed state, determine the first motion action in the sequence of actions to be executed as the current motion action, and control the mechanical motion module to execute the current motion action; after the current motion action is executed, delete the current motion action from the sequence of actions to be executed, and update the sequence of actions to be executed; and return to the step of obtaining the state of the safety door of the storage warehouse to continue execution.

[0014] In a third aspect, the present application further provides a mechanical motion device, the mechanical motion device comprising:

[0015] Mechanical motion module, used to perform mechanical actions in the storage warehouse;

[0016] A mechanical control module is used to obtain the action sequence to be executed of the mechanical motion module; the action sequence includes multiple motion actions arranged in sequence according to the execution order; obtain the status of the safety door of the storage warehouse; when the safety door of the storage warehouse is in a closed state, determine the first motion action in the action sequence to be executed as the current motion action, and control the mechanical motion module to execute the current motion action; after the current motion action is executed, delete the current motion action from the action sequence to be executed, and update the action sequence to be executed; return to the step of obtaining the status of the safety door of the storage warehouse and continue execution.

[0017] A readable storage medium having a computer program stored thereon, wherein when the computer program is executed by a processor, the following steps are implemented:

[0018] Acquire a sequence of actions to be executed of the mechanical motion module; the sequence of actions to be executed includes a plurality of motion actions arranged in sequence according to an execution order;

[0019] Obtaining the status of the security door of the storage warehouse;

[0020] When the safety door of the storage warehouse is in a closed state, determining the first motion action in the action sequence to be executed as the current motion action, and controlling the mechanical motion module to execute the current motion action;

[0021] After the current motion action is executed, the current motion action is deleted from the sequence of actions to be executed, and the sequence of actions to be executed is updated;

[0022] Return to the step of obtaining the status of the security door of the storage warehouse and continue executing.

[0023] The above control method, device, mechanical motion equipment and computer-readable storage medium, the action sequence to be executed of the mechanical motion module includes a plurality of motion actions arranged in sequence according to the execution order, the state of the safety door of the storage warehouse is obtained, when the safety door of the storage warehouse is in a closed state, the first motion action in the action sequence to be executed is determined as the current motion action, the mechanical motion module is controlled to execute the current motion action, after the current motion action is executed, the current motion action is deleted from the action sequence to be executed, the action sequence to be executed is updated, so that it can be determined whether there are still motion actions to be executed in the action sequence, and the step of obtaining the state of the safety door of the storage warehouse is returned to continue execution, so that each motion action in the action sequence can be executed in sequence, and only when the safety door of the storage warehouse is in a closed state, the mechanical module is controlled to execute the current motion action, so that all actions can be executed and the safety of the operator can be guaranteed to a certain extent. During the execution process, each mechanical motion module can save data normally, avoiding the loss of working data of the mechanical motion module. BRIEF DESCRIPTION OF THE DRAWINGS

[0024] In order to more clearly illustrate the technical solutions in the embodiments of the present application or related technologies, the drawings required for use in the embodiments of the present application or related technical descriptions 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 related drawings can be obtained based on these drawings without paying creative work.

[0025] Figure 1 An application environment diagram of a control method in an embodiment;

[0026] Figure 2 A schematic flow chart of a control method in one embodiment;

[0027] Figure 3 A schematic flow chart of a control step in an embodiment;

[0028] Figure 4 is a structural block diagram of a control device in one embodiment;

[0029] Figure 5 is a structural block diagram of a mechanical motion device in one embodiment;

[0030] Figure 6FIG. 4 is a diagram showing the internal structure of a computer device in one embodiment. DETAILED DESCRIPTION

[0031] In order to make the purpose, technical solution and advantages of the present application more clearly understood, the present application is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application and are not used to limit the present application.

[0032] The control method provided in the embodiment of the present application can be applied to Figure 1 In the application environment shown. Among them, the control end 102 can communicate with the mechanical motion module 104. Among them, the control end 102 can be a terminal or server independent of the mechanical motion module 104. The terminal can be a personal computer, a laptop, a smart phone, a tablet computer, an industrial computer or other. The server can be an independent physical server, or a server cluster or distributed system composed of multiple physical servers, or a cloud server providing cloud computing services. The control end 102 can also constitute a mechanical motion device with the mechanical motion module 104, and the control end 102 can be a mechanical control module in the mechanical motion device, which can be a hardware circuit, a controller or a virtual control device. The mechanical motion module 104 is arranged in a storage warehouse. The storage warehouse is a warehouse for storing products. The storage warehouse can be a blood product storage warehouse or a warehouse for storing other products. The blood product storage warehouse can store blood products, and the blood product storage warehouse can be a warehouse for long-term storage of blood products, or a warehouse for short-term storage of blood products. The blood product storage warehouse includes but is not limited to one of a blood product cold storage, a quick freezing warehouse and a red blood cell cold storage.

[0033] Based on Figure 1 In the application environment shown, the control end 102 can obtain the action sequence to be executed of the mechanical motion module 104, obtain the status of the safety door of the storage warehouse, and when the safety door of the storage warehouse is in a closed state, determine the first motion action in the action sequence to be executed as the current motion action, control the mechanical motion module 104 to execute the current motion action, and after the current motion action is executed, delete the current motion action from the action sequence to be executed, update the action sequence to be executed, and return to the step of obtaining the status of the safety door of the storage warehouse to continue execution.

[0034] In an exemplary embodiment, Figure 2 As shown, a control method is provided for controlling the mechanical motion of a mechanical motion module in a storage warehouse. Figure 1 The control end 102 in the example is used to illustrate, including the following steps 202 to 206. Among them:

[0035] Step 202, obtaining a sequence of actions to be executed of the mechanical motion module; the sequence of actions to be executed includes a plurality of motion actions arranged in sequence according to an execution order.

[0036] Among them, the mechanical motion module can perform mechanical motion or stop mechanical motion, and is not necessarily in a real-time motion state. The mechanical motion can be a motion motion or a motion stop motion. The mechanical motion module can complete the warehouse management task by executing one or more action sequences. Warehouse management tasks may include outbound tasks, inbound tasks, inventory tasks or others. The outbound task is the task of transferring products stored in the storage warehouse to the outside of the storage warehouse. The inbound task is the task of transferring products to the storage warehouse for internal storage. The inventory task is the task of checking and counting the materials in the storage warehouse. The materials can be products stored in the storage warehouse, storage facilities for storing products, etc. Storage facilities such as cargo boxes, shelves or others.

[0037] Motion actions are the basic action units that control the motion of mechanical motion modules divided into action sequences. Motion sequences are used to complete warehouse management tasks. The smallest action unit in an action sequence can be an atomic motion action. An atomic motion action is an indivisible motion action. Once an atomic motion action starts executing, it must continue to execute until it is completed. A motion action can be an atomic motion action or a combined motion action formed by combining at least two atomic motion actions.

[0038] Exemplarily, the control end may obtain, in response to a task triggering event, a sequence of actions to be executed by the mechanical motion module indicated by the task triggering event.

[0039] The task trigger event is an event that instructs the mechanical motion module to move to complete the warehouse management task. The task trigger event can be an automatic trigger event, for example, it is automatically triggered when the presence of unstocked blood bags is detected. The task trigger event can also be a manual trigger operation, for example, it can be a trigger operation of the outbound button set on the control end.

[0040] In one embodiment, the control end may determine the target task indicated by the task triggering event in response to the task triggering event, and generate an action sequence to be executed by the mechanical motion module for completing the target task.

[0041] Among them, the target task is a specified warehouse management task. The target task can be a task of outgoing a specified product from a storage warehouse, a task of storing a product in a specified storage location in a storage warehouse, or a task of taking inventory of a specified product in a storage warehouse. The generated action sequence can be an action sequence for completing the target task, or a combination of multiple action sequences for completing the target task. For example, in the case where the target task is to outgoing a blood bag with a specified number from a storage warehouse, the action sequence can be an action sequence for taking out a blood bag with a specified number stored in the storage warehouse and placing the taken-out blood bag to a specified outgoing location; the action sequence can also be two action sequences, one action sequence for taking out a blood bag with a specified number stored in a storage warehouse, and the other action sequence for placing the taken-out blood bag to a specified outgoing location.

[0042] Step 204, obtaining the status of the security door of the storage warehouse.

[0043] The state of the safety door is obtained by obtaining whether the safety lock of the safety door is open or not. When the safety lock of the safety door is in the open state, it can be determined that the safety door is in the open state. When the safety lock of the safety door is in the closed state, it can be determined that the safety door is in the closed state. When the operator enters the storage warehouse, the safety lock can be manually opened, and after coming out of the storage warehouse, the safety lock can be reset to put the safety lock in the closed state.

[0044] For example, a sensor for detecting the state of the security door may be provided in the storage warehouse. In this embodiment, the control end may send a detection instruction to the sensor, and receive a state detection result obtained by the sensor detecting the current state of the security door in response to the detection instruction. The detection instruction is a computer instruction for instructing the sensor to detect the state of the security door. It can be understood that the sensor can detect whether the security lock is opened or not, thereby determining the state of the security door.

[0045] Step 206: When the safety door of the storage warehouse is in a closed state, the first motion action in the action sequence to be executed is determined as the current motion action, and the mechanical motion module is controlled to execute the current motion action.

[0046] Exemplarily, when the security door of the storage warehouse is in a closed state, the control end may determine the first motion action in the sequence of actions to be executed as the current motion action, may generate a first instruction to instruct the execution of the current motion action, and send the first instruction to the mechanical motion module to control the mechanical motion module to execute the current motion action. The first instruction is a computer instruction instructing the mechanical motion module to execute the current motion action. When receiving the first instruction, the mechanical motion module may respond to the first instruction and execute the current motion action.

[0047] Step 208: After the current motion action is executed, the current motion action is deleted from the sequence of actions to be executed, and the sequence of actions to be executed is updated.

[0048] Exemplarily, after the current motion action is executed, the current motion action is deleted from the action sequence to be executed, the action sequence to be executed is updated, and an updated action sequence is obtained. If the updated action sequence does not contain any motion action, it is determined that the action sequence is executed. Step 210 returns to the step of obtaining the status of the security door of the storage warehouse and continues to execute.

[0049] Exemplarily, when there is a motion action in the updated action sequence, the process returns to step 204 to continue execution, that is, steps 204 , 206 , and 208 are executed.

[0050] In the above control method, the action sequence to be executed of the mechanical motion module includes multiple motion actions arranged in sequence according to the execution order, the state of the safety door of the storage warehouse is obtained, and when the safety door of the storage warehouse is in a closed state, the first motion action in the action sequence to be executed is determined as the current motion action, and the mechanical motion module is controlled to execute the current motion action. After the current motion action is executed, the current motion action is deleted from the action sequence to be executed, and the action sequence to be executed is updated, so that it can be determined whether there are still motion actions to be executed in the action sequence, and the step of obtaining the state of the safety door of the storage warehouse is returned to continue execution. In this way, each motion action in the action sequence can be executed in sequence, and only when the safety door of the storage warehouse is in a closed state, the mechanical module is controlled to execute the current motion action, which can not only complete all actions, but also ensure the safety of the operator to a certain extent. During the execution process, the mechanical motion module can save data normally, avoiding the loss of the working data of the mechanical motion module.

[0051] In an exemplary embodiment, after step 204, the above control method also includes the following steps: when the safety door of the storage warehouse is in an open state, controlling the mechanical motion module to wait until the safety door is in a closed state, executing the step of determining the first motion action in the action sequence to be executed as the current motion action, and controlling the mechanical motion module to execute the current motion action.

[0052] The waiting means that the mechanical motion module keeps the state of stopping the mechanical motion.

[0053] Exemplarily, when the safety door is in an open state, the control end can control the mechanical motion module to wait until the safety door is in a closed state, execute step 206 to determine the first motion action in the action sequence to be executed as the current motion action, and control the mechanical motion module to execute the current motion action.

[0054] In one embodiment, a sensor for detecting the state of the safety door may be provided in the storage warehouse, and the sensor may detect the state of the safety door in real time. When a change in the state of the safety door is detected, the state detection result of the changed safety door may be sent to the control end. In this embodiment, the step of controlling the mechanical motion module to wait until the safety door is in a closed state may include: the control end may control the mechanical motion module to wait, and when the state detection result of the safety door sent by the sensor is received, and the state detection result indicates that the safety door of the storage warehouse is in a closed state, the waiting is ended.

[0055] In one embodiment, the step of controlling the mechanical motion module to wait until the safety door is in a closed state includes: controlling the mechanical motion module to alternately execute the step of waiting for a preset time and the step of obtaining the state of the safety door of the storage warehouse until the safety door is in a closed state. The preset time is a pre-set time length. The preset time can be 10 milliseconds, 20 milliseconds, 1 second or others.

[0056] In this embodiment, when the safety door of the storage warehouse is in the open state, the mechanical motion module is controlled to wait until the safety door is in the closed state, which can avoid starting new motion actions when the operator enters the storage warehouse, and can ensure the safety of the operator to a certain extent.

[0057] In one embodiment, the storage warehouse is provided with a plurality of shelves arranged along a first preset direction for storing blood bags, each shelf includes a plurality of storage positions arranged along a second preset direction, each storage position is used to place a cargo frame, the cargo frame is used to store blood bags, the cargo frame is stored in the storage position along a third preset direction, or leaves the storage position in the opposite direction of the third preset direction; wherein each movement action includes at least one of a cargo frame transmission action, a cargo frame grabbing action and a cargo frame releasing action.

[0058] Among them, the storage warehouse can establish a three-dimensional rectangular coordinate system. For example, a three-dimensional rectangular coordinate system can be established with a vertex in the space of the storage warehouse as the origin of the coordinates and the direction pointing to the interior of the space of the storage warehouse as the positive direction. In one embodiment, the first preset direction can be the positive direction of the X-axis (horizontal axis), the second preset direction can be the positive direction of the Z-axis (vertical axis), and the third preset direction can be the positive direction of the Y-axis (longitudinal axis). In another embodiment, the first preset direction can be the positive direction of the Y-axis (longitudinal axis), the second preset direction can be the positive direction of the Z-axis (vertical axis), and the third preset direction can be the positive direction of the X-axis (horizontal axis).

[0059] The cargo box can be used to store one or more blood bags. The blood bags are used to hold blood products. The shelves, storage locations, cargo boxes, and blood bags can each have identification information, such as numbers, codes, and the like. After the blood bags are stored in the cargo box, the identification information of the blood bags can be bound to the identification information of the cargo box. After the cargo box is placed in the storage location, the identification information of the cargo box can be bound to the identification information of the storage location. It can be understood that the identification information of the storage location is used to distinguish different storage locations among the multiple storage locations of each of the multiple shelves, so that the shelf and storage location where the blood bag is located can be located according to the identification information of the blood bag. The mechanical motion module can be provided with an identification module, and the identification module is used to identify the identification information. The identification module can be a radio frequency identification module, a scanning module, or other.

[0060] The cargo frame transmission action is the action of the mechanical motion module moving along any one of the first preset direction, the second preset direction and the third preset direction, or in the opposite direction of any one of the first preset direction, the second preset direction and the third preset direction; the cargo frame grabbing action is the action of the mechanical motion module grabbing the cargo frame; the cargo frame releasing action is the action of the mechanical motion module releasing the grabbed cargo frame.

[0061] The mechanical motion module may include a moving mechanism, a lifting mechanism, and a push-pull gripper for a cargo frame. The moving mechanism may drive the entire mechanical motion module to move along a first preset direction or in the opposite direction thereof. The lifting mechanism may be lifted and lowered along a second preset direction or in the opposite direction thereof. The push-pull gripper for a cargo frame may move along a third preset direction to extend the gripper, and the push-pull gripper for a cargo frame may also move in the opposite direction of the third preset direction to retract the gripper. The push-pull gripper for a cargo frame may also grab a cargo frame or release a grabbed cargo frame. In this embodiment, the cargo frame transmission action may be an action of the moving mechanism moving along a first preset direction or in the opposite direction thereof, an action of the lifting mechanism moving along a second preset direction or in the opposite direction thereof, or an action of the push-pull gripper for a cargo frame moving along a third preset direction or in the opposite direction thereof. The cargo frame grabbing action may be an action of the push-pull gripper for a cargo frame grabbing a cargo frame. The cargo frame releasing action may be an action of the push-pull gripper for a cargo frame releasing a grabbed cargo frame.

[0062] In this embodiment, the storage warehouse is provided with a plurality of shelves arranged along a first preset direction, each shelf includes a plurality of storage positions arranged along a second preset direction, and cargo frames are stored in the storage positions along a third preset direction, or leave the storage positions in the opposite direction of the third preset direction, so that the mechanical motion module can execute cargo frame transmission action, cargo frame grabbing action and cargo frame releasing action, so that the cargo frames can be automatically taken out or stored, which can improve the working efficiency of the mechanical motion module in the storage warehouse.

[0063] In one embodiment, the mechanical motion module includes a moving mechanism, a lifting mechanism and a cargo frame push-pull gripper; when the action sequence is used to obtain a cargo frame storing blood bags from a first storage position among multiple storage positions, and the first storage position is set in a first storage area of ​​the shelf, the action sequence includes multiple motion actions in sequence: the moving mechanism drives the mechanical motion module to move to the first storage area along a first preset direction; the lifting mechanism drives the cargo frame push-pull gripper to move to the docking point of the first storage position along a second preset direction; the cargo frame push-pull gripper moves to the first storage position along a third preset direction to grab the cargo frame storing blood bags at the first preset storage position; and the cargo frame push-pull gripper moves in the opposite direction of the third preset direction to leave the first preset storage position.

[0064] Each storage position is a storage space for accommodating a cargo frame of a certain volume. The docking point of the first storage position may be a position aligned with the center of the first storage position along the second preset direction.

[0065] In this embodiment, the various parts of the mechanical motion module can execute multiple motion actions in the action sequence in sequence, so that the cargo frame storing blood bags can be obtained from the first storage position among multiple storage positions, and each motion action involves at least a movement in a preset direction, and at most a movement in a preset direction and a grasping action. In this way, when the various parts of the mechanical motion module execute multiple motion actions in sequence, each motion action takes less time. While ensuring that the motion action is completed so that the data can be stored in time, the motion state of the mechanical motion module is adjusted in time according to the state of the safety door to ensure the safety of people in the storage warehouse.

[0066] In one embodiment, the mechanical motion module includes a moving mechanism, a lifting mechanism and a cargo frame push-pull gripper; when the action sequence is used to store the cargo frame storing blood bags at a second storage position among multiple storage positions, and the second storage position is set in a second shelf among multiple shelves, then when the cargo frame push-pull gripper grabs the cargo frame storing blood bags, the action sequence includes multiple motion actions in sequence: the moving mechanism drives the mechanical motion module to move to the second storage area along the first preset direction; the lifting mechanism drives the cargo frame push-pull gripper to move to the docking point of the second storage position along the second preset direction; the cargo frame push-pull gripper moves to the second storage position along the third preset direction to place the grabbed cargo frame storing blood bags at the second preset storage position; and the cargo frame push-pull gripper moves in the opposite direction of the third preset direction to leave the second preset storage position.

[0067] Among them, the docking point of the second storage position can be a position where the lifting mechanism of the mechanical motion module is slightly higher than the bottom of the second storage position along the second preset direction. For example, it can be a position where the second slider is higher than the bottom of the second storage position at a preset height along the second preset direction. The preset height is 50 mm, 1 cm or others.

[0068] In this embodiment, the various parts of the mechanical motion module can execute multiple motion actions in the action sequence in sequence, so that the cargo frame storing blood bags can be stored in the second storage position of multiple storage positions. Moreover, each motion action involves at least one movement in a preset direction, and at most one movement in a preset direction and a release action. In this way, when the various parts of the mechanical motion module execute multiple motion actions in sequence, each motion action takes less time. While ensuring that the motion action is completed so that the data can be stored in time, the motion state of the mechanical motion module is adjusted in time according to the state of the safety door to ensure the safety of people in the storage warehouse.

[0069] In one embodiment, the storage warehouse includes a plurality of workspaces, each of which is provided with a mechanical motion module and a safety door, and the mechanical motion modules in each workspace are independently controlled based on the safety door of the workspace in which they are located.

[0070] The different workspaces are independent of each other. For example, the multiple workspaces may include a blood cold storage and a blood quick freezing storage.

[0071] Exemplarily, the independent control of the mechanical motion modules in each workspace based on the safety doors of their respective workspaces can be achieved through the following steps: the control end can obtain the action sequence of the mechanical motion module of any workspace among multiple workspaces; when the safety door of the workspace where the mechanical motion module is located is in a closed state, the first motion action in the action sequence is determined as the current motion action, and the mechanical motion module is controlled to execute the current motion action; after the current motion action is executed, if there is a next motion action of the current motion action in the action sequence and the safety door where the mechanical motion module is located is in an open state, the mechanical motion module is controlled to wait until the safety door of the workspace is in a closed state, the next motion action is updated to the current motion action, and the step of controlling the mechanical motion module to execute the current motion action is returned to continue execution.

[0072] In this embodiment, the mechanical motion modules in each workspace are independently controlled based on the safety doors of the workspaces where they are located. Different workspaces do not affect each other, which can improve the work efficiency of the mechanical motion modules.

[0073] In one embodiment, the storage warehouse is provided with a safety door and multiple different working areas, and each working area is provided with a mechanical motion module that moves within the working area; in step 206, controlling the mechanical motion module to wait until the safety door is in a closed state includes: when it is determined that there is an operator in the storage warehouse, obtaining the target distance between the operator and the working area where the mechanical motion module is located; when the target distance is less than the preset distance, controlling the mechanical motion module to wait until the safety door is in a closed state.

[0074] The work area is a spatial area divided from the space where the storage warehouse is located. The target distance is the distance between the operator and the work area. The target distance can be measured by a distance measuring device in the storage warehouse. The distance measuring device can be an infrared rangefinder, a laser rangefinder, a radar rangefinder or other. The preset distance is a pre-set safety distance. The preset distance is 2 meters, 3 meters or other. Each of the multiple work areas in the storage warehouse can be provided with a distance measuring device to measure the target distance between each work area and the operator entering the storage warehouse.

[0075] For example, the control end can detect whether there is an operator in the storage warehouse through a detection device, such as a camera, a thermal imaging device or others.

[0076] In this embodiment, by obtaining the target distance between the operator and the working area where the mechanical motion module is located, when the target distance is less than the preset distance, the mechanical motion module is controlled to wait, thereby preventing the operator from being injured after entering the storage warehouse and ensuring the operator's safety.

[0077] In one embodiment, the control method further includes: when the target distance is not less than the preset distance, the control end can update the next motion action to the current motion action, and return to the step of controlling the mechanical motion module to execute the current motion action to continue to execute. In this embodiment, when the target distance is not less than the preset distance, that is, the operator is within the safe range compared to the mechanical motion module in the working area, the mechanical motion module continues to execute the motion action, which can improve the operating efficiency of the mechanical motion module while ensuring the safety of the operator.

[0078] In one embodiment, when receiving status information transmitted by the sensor of the storage warehouse indicating that the safety door is in an open state, the motion status information of the mechanical motion module is obtained; when the motion status information indicates that the mechanical motion module is performing a motion action, an alarm prompt is issued. The alarm prompt is used to remind the operator that the mechanical motion module in the storage warehouse is working. The alarm prompt can be in various forms, such as voice, prompt light, etc.

[0079] In a specific embodiment, the mechanical motion module (which may be referred to as a manipulator module) may include a moving mechanism, a lifting mechanism, and a cargo frame push-pull gripper. The storage warehouse is provided with a plurality of shelves arranged along the positive direction of the X-axis for storing blood bags, each shelf including a plurality of storage locations arranged along the positive direction of the Z-axis, each storage location being used to place a cargo frame, the cargo frame being used to store blood bags, the cargo frame being stored in the storage location along the positive direction of the Y-axis, or being moved away from the storage location along the negative direction of the Y-axis (i.e., the opposite direction of the positive direction of the Y-axis). See, for example, Figure 3 The control step flow diagram shown in the figure, the action sequence can be used for the pickup box or the delivery box. Among them:

[0080] When the action sequence is used for picking up the cargo frame, the action sequence may include four motion actions; the first motion action may be that the moving mechanism drives the mechanical motion module to move to the first shelf along the positive direction of the X axis; the second motion action may be that the lifting mechanism drives the cargo frame push-pull gripper to move to a position level with the first storage position along the positive direction of the Z axis; the third motion action may be that the cargo frame push-pull gripper moves to the first storage position along the positive direction of the Y axis and grabs the cargo frame storing the blood bag at the first preset storage position; the fourth motion action may be that the cargo frame push-pull gripper moves along the negative direction of the Y axis to leave the first preset storage position. Among them, the storage position may also be called a work station. When it moves to the shelf, the mechanical motion module is in front of the storage position, which can be understood as the mechanical motion module being in front of the work station. The cargo frame push-pull gripper can move to the first storage position along the positive direction of the Y axis to extend the gripper; the cargo frame push-pull gripper can also move away from the first storage position along the negative direction of the Y axis to retract the gripper.

[0081] When the action sequence is used for a delivery frame, the action sequence may include four motion actions; the first motion action may be that the moving mechanism drives the mechanical motion module to move to the second shelf along the positive direction of the X-axis; the second motion action may be that the lifting mechanism drives the cargo frame push-pull gripper to move along the positive direction of the Z-axis to a position slightly higher than the second storage position; the third motion action may be that the cargo frame push-pull gripper moves along the positive direction of the Y-axis to the second storage position and places the grabbed cargo frame storing blood bags at the second preset storage position; the fourth motion action may be that the cargo frame push-pull gripper moves along the negative direction of the Y-axis to leave the second preset storage position.

[0082] Based on the above action sequence for the pickup box or delivery box and Figure 3 An optional embodiment of the above control method may specifically include the following steps:

[0083] The control end can obtain the action sequence to be executed by the mechanical motion module and the status of the safety door in the storage warehouse.

[0084] When the safety door is in a closed state, the control end may determine the first motion action in the action sequence to be executed as the current motion action, and control the mechanical motion module to execute the current motion action.

[0085] When the safety door is in the open state, the control end can control the mechanical motion module to alternately execute the steps of waiting for 10 milliseconds and obtaining the status of the safety door in the storage warehouse until the safety door is in the closed state, and then determine the first motion action in the action sequence to be executed as the current motion action, and control the mechanical motion module to execute the current motion action.

[0086] After the current motion action is executed, the current motion action is deleted from the action sequence to be executed, and the action sequence to be executed is updated.

[0087] In the case where there is a motion action in the updated action sequence, the step of returning to obtain the state of the safety door of the storage warehouse is continued.

[0088] In the case that there is no motion action in the updated action sequence, it is determined that the execution is completed, and the cargo box is successfully grabbed or successfully put down.

[0089] It should be understood that, although the steps in the flowcharts involved in the above embodiments are displayed in sequence according to the indication of the arrows, these steps are not necessarily executed in sequence according to the order indicated by the arrows. Unless there is a clear explanation in this article, the execution of these steps is not strictly limited in order, and these steps can be executed in other orders. Moreover, at least a part of the steps in the flowcharts involved in the above embodiments may include multiple steps or multiple stages, and these steps or stages are not necessarily executed at the same time, but can be executed at different times, and the execution order of these steps or stages is not necessarily carried out in sequence, but can be executed in turn or alternately with other steps or at least a part of the steps or stages in other steps.

[0090] Based on the same inventive concept, the embodiment of the present application also provides a control device for implementing the control method involved above. The implementation scheme for solving the problem provided by the device is similar to the implementation scheme recorded in the above method, so the specific limitations in one or more control device embodiments provided below can refer to the limitations on the control method above, and will not be repeated here.

[0091] In an exemplary embodiment, Figure 4 As shown, a control device 400 is provided for controlling the mechanical motion of a mechanical motion module in a storage warehouse. The control device 400 includes: an acquisition module 410 and a control module 420, wherein:

[0092] The acquisition module 410 is used to acquire the action sequence to be executed of the mechanical motion module; the action sequence to be executed includes a plurality of motion actions arranged in sequence according to the execution order; and acquire the state of the safety door of the storage warehouse;

[0093] The control module 420 is used to determine the first motion action in the action sequence to be executed as the current motion action when the safety door of the storage warehouse is in a closed state, and control the mechanical motion module to execute the current motion action; after the current motion action is executed, the current motion action is deleted from the action sequence to be executed, and the action sequence to be executed is updated; and return to the step of obtaining the status of the safety door of the storage warehouse to continue execution.

[0094] In one embodiment, the control module 420 is also used to control the mechanical motion module to wait until the safety door is in a closed state when the safety door of the storage warehouse is in an open state, and to execute the step of determining the first motion action in the action sequence to be executed as the current motion action, and controlling the mechanical motion module to execute the current motion action.

[0095] In one embodiment, the storage warehouse is provided with a plurality of shelves arranged along a first preset direction for storing blood bags, each shelf includes a plurality of storage positions arranged along a second preset direction, each storage position is used to place a cargo frame, the cargo frame is used to store blood bags, the cargo frame is stored in the storage position along a third preset direction, or leaves the storage position in the opposite direction of the third preset direction; wherein each movement action includes at least one of a cargo frame transmission action, a cargo frame grabbing action and a cargo frame releasing action.

[0096] In one embodiment, the mechanical motion module includes a moving mechanism, a lifting mechanism and a cargo frame push-pull gripper; when the action sequence is used to obtain a cargo frame storing blood bags from a first storage position among multiple storage positions, and the first storage position is set in a first shelf of multiple shelves, the action sequence includes multiple motion actions in sequence: the moving mechanism drives the mechanical motion module to move to the first shelf along a first preset direction; the lifting mechanism drives the cargo frame push-pull gripper to move to the docking point of the first storage position along a second preset direction; the cargo frame push-pull gripper moves to the first storage position along a third preset direction and grabs the cargo frame storing blood bags at the first preset storage position; and the cargo frame push-pull gripper moves in the opposite direction of the third preset direction to leave the first preset storage position.

[0097] In one embodiment, the mechanical motion module includes a moving mechanism, a lifting mechanism and a cargo frame push-pull gripper; when the action sequence is used to store the cargo frame storing blood bags at a second storage position among multiple storage positions, and the second storage position is set in the second shelf of the multiple shelves, then when the cargo frame push-pull gripper grabs the cargo frame storing blood bags, the action sequence includes multiple motion actions in sequence: the moving mechanism drives the mechanical motion module to move to the second shelf along the first preset direction; the lifting mechanism drives the cargo frame push-pull gripper to move to the docking point of the second storage position along the second preset direction; the cargo frame push-pull gripper moves to the second storage position along the third preset direction and places the grabbed cargo frame storing blood bags at the second preset storage position; and the cargo frame push-pull gripper moves in the opposite direction of the third preset direction to leave the second preset storage position.

[0098] In one embodiment, the storage warehouse includes a plurality of workspaces, each of which is provided with a mechanical motion module and a safety door, and the mechanical motion modules in each workspace are independently controlled based on the safety door of the workspace in which they are located.

[0099] In one embodiment, the storage warehouse is provided with a safety door and multiple different working areas, and each working area is provided with a mechanical motion module that moves within the working area; the control module 420 is also used to obtain the target distance between the operator and the working area where the mechanical motion module is located when it is determined that there is an operator in the storage warehouse; when the target distance is less than the preset distance, the mechanical motion module is controlled to wait until the safety door is in a closed state.

[0100] Each module in the above control device can be implemented in whole or in part by software, hardware or a combination thereof. Each module can be embedded in or independent of a processor in a computer device in the form of hardware, or can be stored in a memory in a computer device in the form of software, so that the processor can call and execute operations corresponding to each module.

[0101] In an exemplary embodiment, Figure 5 As shown, a mechanical motion device 500 is provided, comprising:

[0102] The mechanical motion module 510 is used to perform mechanical actions in the storage warehouse.

[0103] The mechanical control module 520 is used to obtain the action sequence to be executed of the mechanical motion module 510; the action sequence to be executed includes multiple motion actions arranged in sequence according to the execution order; the status of the safety door of the storage warehouse is obtained; when the safety door of the storage warehouse is in a closed state, the first motion action in the action sequence to be executed is determined as the current motion action, and the mechanical motion module 510 is controlled to execute the current motion action; after the current motion action is executed, the current motion action is deleted from the action sequence to be executed, and the action sequence to be executed is updated; return to the step of obtaining the status of the safety door of the storage warehouse and continue execution.

[0104] In one embodiment, the mechanical control module 520 is also used to control the mechanical motion module to wait until the safety door is in a closed state when the safety door of the storage warehouse is in an open state, and to execute the step of determining the first motion action in the action sequence to be executed as the current motion action, and controlling the mechanical motion module to execute the current motion action.

[0105] In one embodiment, the storage warehouse is provided with a plurality of shelves arranged along a first preset direction for storing blood bags, each shelf includes a plurality of storage positions arranged along a second preset direction, each storage position is used to place a cargo frame, the cargo frame is used to store blood bags, the cargo frame is stored in the storage position along a third preset direction, or leaves the storage position in the opposite direction of the third preset direction; wherein each movement action includes at least one of a cargo frame transmission action, a cargo frame grabbing action, and a cargo frame releasing action

[0106] In one embodiment, the mechanical motion module 510 includes a moving mechanism, a lifting mechanism and a cargo frame push-pull gripper; the moving mechanism is used to perform a cargo frame transmission action along a first preset direction or in the opposite direction of the first preset direction; the lifting mechanism is used to perform a cargo frame transmission action along a second preset direction or in the opposite direction of the second preset direction; the cargo frame push-pull gripper is used to perform a cargo frame transmission action, a cargo frame grabbing action or a cargo frame releasing action along a third preset direction or in the opposite direction of the third preset direction.

[0107] In one embodiment, when the action sequence is used to obtain a cargo frame storing blood bags from a first storage position among multiple storage positions, and the first storage position is set in a first shelf of multiple shelves, the action sequence includes multiple motion actions in sequence: the moving mechanism drives the mechanical motion module 510 to move to the first shelf along the first preset direction; the lifting mechanism drives the cargo frame push-pull gripper to move to the docking point of the first storage position along the second preset direction; the cargo frame push-pull gripper moves to the first storage position along the third preset direction and grabs the cargo frame storing blood bags at the first preset storage position; and the cargo frame push-pull gripper moves in the opposite direction of the third preset direction to leave the first preset storage position.

[0108] In one embodiment, the mechanical motion module 510 includes a moving mechanism, a lifting mechanism and a cargo frame push-pull gripper; when the action sequence is used to store the cargo frame storing blood bags at a second storage position among multiple storage positions, and the second storage position is set in a second shelf of the multiple shelves, then when the cargo frame push-pull gripper grabs the cargo frame storing blood bags, the action sequence includes multiple motion actions in sequence: the moving mechanism drives the mechanical motion module 510 to move to the second shelf along the first preset direction; the lifting mechanism drives the cargo frame push-pull gripper to move to the docking point of the second storage position along the second preset direction; the cargo frame push-pull gripper moves to the second storage position along the third preset direction and places the grabbed cargo frame storing blood bags at the second preset storage position; and the cargo frame push-pull gripper moves in the opposite direction of the third preset direction to leave the second preset storage position.

[0109] In one embodiment, the storage warehouse includes a plurality of workspaces, each of which is provided with a mechanical motion module 510 and a safety door, and the mechanical motion modules 510 in each workspace are independently controlled based on the safety door of the workspace in which they are located.

[0110] In one embodiment, the storage warehouse is provided with a safety door and multiple different working areas, and each working area is provided with a mechanical motion module 510 that moves within the working area; the mechanical control module 520 is also used to obtain the target distance between the operator and the working area where the mechanical motion module 510 is located when it is determined that there is an operator in the storage warehouse; when the target distance is less than the preset distance, the mechanical motion module 510 is controlled to wait until the safety door is in a closed state.

[0111] In an exemplary embodiment, a computer device is provided. The computer device may be a terminal, and its internal structure diagram may be as shown in FIG. Figure 6As shown. The computer device includes a processor, a memory, an input / output interface, a communication interface, a display unit and an input device. Among them, the processor, the memory and the input / output interface are connected through a system bus, and the communication interface, the display unit and the input device are connected to the system bus through the input / output interface. Among them, the processor of the computer device is used to provide computing and control capabilities. The memory of the computer device includes a non-volatile storage medium and an internal memory. The non-volatile storage medium stores an operating system and a computer program. The internal memory provides an environment for the operation of the operating system and the computer program in the non-volatile storage medium. The input / output interface of the computer device is used to exchange information between the processor and an external device. The communication interface of the computer device is used to communicate with an external terminal in a wired or wireless manner, and the wireless manner can be implemented through WIFI, a mobile cellular network, near field communication (Near Field Communication, NFC) or other technologies. When the computer program is executed by the processor, a control method is implemented. The display unit of the computer device is used to form a visually visible picture, which can be a display screen, a projection device or a virtual reality imaging device. The display screen can be a liquid crystal display screen or an electronic ink display screen, and the input device of the computer device can be a touch layer covering the display screen, or a button, trackball or touchpad set on the computer device shell, or an external keyboard, touchpad or mouse.

[0112] Those skilled in the art will understand that Figure 6 The structure shown in the figure is only a block diagram of a part of the structure related to the solution of the present application, and does not constitute a limitation on the computer device to which the solution of the present application is applied. The specific computer device may include more or fewer components than those shown in the figure, or combine certain components, or have a different arrangement of components.

[0113] In one embodiment, a computer device is further provided, including a memory and a processor, wherein a computer program is stored in the memory, and the processor implements the steps in the above-mentioned method embodiments when executing the computer program.

[0114] In one embodiment, a computer-readable storage medium is provided, on which a computer program is stored. When the computer program is executed by a processor, the steps in the above-mentioned method embodiments are implemented.

[0115] In one embodiment, a computer program product is provided, including a computer program, which implements the steps in the above method embodiments when executed by a processor.

[0116] Those of ordinary skill in the art can understand that all or part of the processes in the above-mentioned embodiment methods can be completed by instructing the relevant hardware through a computer program, and the computer program can be stored in a non-volatile computer-readable storage medium. When the computer program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, any reference to the memory, database or other medium used in the embodiments provided in the present application can include at least one of non-volatile memory and volatile memory. Non-volatile memory can include read-only memory (ROM), magnetic tape, floppy disk, flash memory, optical memory, high-density embedded non-volatile memory, resistive random access memory (ReRAM), magnetic random access memory (MRAM), ferroelectric random access memory (FRAM), phase change memory (PCM), graphene memory, etc. Volatile memory can include random access memory (RAM) or external cache memory, etc. As an illustration and not limitation, RAM can be in various forms, such as static random access memory (SRAM) or dynamic random access memory (DRAM). The database involved in each embodiment provided in this application may include at least one of a relational database and a non-relational database. Non-relational databases may include distributed databases based on blockchains, etc., but are not limited to this. The processor involved in each embodiment provided in this application may be a general-purpose processor, a central processing unit, a graphics processor, a digital signal processor, a programmable logic device, a data processing logic device based on quantum computing, an artificial intelligence (AI) processor, etc., but are not limited to this.

[0117] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this application.

[0118] The above-described embodiments only express several implementation methods of the present application, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the present application. It should be pointed out that, for a person of ordinary skill in the art, several variations and improvements can be made without departing from the concept of the present application, and these all belong to the protection scope of the present application. Therefore, the protection scope of the present application shall be subject to the attached claims.

Claims

1. A control method for controlling the mechanical motion of a mechanical motion module in a storage warehouse, characterized in that: The control method comprises: Acquire a sequence of actions to be executed of the mechanical motion module; the sequence of actions to be executed includes a plurality of motion actions arranged in sequence according to an execution order; Obtaining the status of the security door of the storage warehouse; When the safety door of the storage warehouse is in a closed state, determining the first motion action in the sequence of actions to be executed as the current motion action, and controlling the mechanical motion module to execute the current motion action; After the current motion action is executed, the current motion action is deleted from the sequence of actions to be executed, and the sequence of actions to be executed is updated; Return to the step of obtaining the status of the security door of the storage warehouse and continue executing.

2. The control method according to claim 1, characterized in that: The control method further comprises: When the safety door of the storage warehouse is in an open state, the mechanical motion module is controlled to wait until the safety door is in a closed state, and the first motion action in the sequence of actions to be executed is determined as the current motion action, and the mechanical motion module is controlled to execute the step of executing the current motion action.

3. The control method according to claim 1, characterized in that: The storage warehouse is provided with a plurality of shelves arranged along a first preset direction for storing blood bags, each of the shelves comprises a plurality of storage positions arranged along a second preset direction, each storage position is used to place a cargo frame, the cargo frame is used to store the blood bags, the cargo frame is stored in the storage position along a third preset direction, or leaves the storage position in the opposite direction of the third preset direction; Wherein, each of the movement actions includes at least one of a cargo frame transmission action, a cargo frame grabbing action and a cargo frame releasing action.

4. The control method according to claim 3, characterized in that: The mechanical motion module includes a moving mechanism, a lifting mechanism and a cargo frame push-pull gripper; when the action sequence is used to obtain a cargo frame storing blood bags from a first storage position among the multiple storage positions, and the first storage position is set in the first shelf of the multiple shelves, the multiple motion actions included in the action sequence are, in sequence, The moving mechanism drives the mechanical motion module to move along the first preset direction to the first shelf; The lifting mechanism drives the push-pull gripper of the cargo frame to move along the second preset direction to the docking position of the first storage position; The cargo frame push-pull gripper moves along the third preset direction to the first storage position and grabs the cargo frame storing the blood bags at the first preset storage position; and, The cargo frame push-pull gripper moves in a direction opposite to the third preset direction to leave the first preset storage position.

5. The control method according to claim 3, characterized in that: The mechanical motion module includes a moving mechanism, a lifting mechanism and a cargo frame push-pull gripper; when the action sequence is used to store the cargo frame storing blood bags at a second storage position among the multiple storage positions, and the second storage position is set in a second shelf of the multiple shelves, then when the cargo frame push-pull gripper grabs the cargo frame storing blood bags, the multiple motion actions included in the action sequence are, in sequence, The moving mechanism drives the mechanical motion module to move along the first preset direction to the second shelf; The lifting mechanism drives the push-pull gripper of the cargo frame to move along the second preset direction to the docking position of the second storage position; The cargo frame push-pull gripper moves along the third preset direction to the second storage position, and places the grabbed cargo frame storing the blood bags at the second preset storage position; and, The cargo frame push-pull gripper moves in a direction opposite to the third preset direction to leave the second preset storage position.

6. The control method according to claim 1, characterized in that: The storage warehouse includes a plurality of workspaces, each of which is provided with a mechanical motion module and a safety door. The mechanical motion modules in each of the workspaces are independently controlled based on the safety door of the workspace in which they are located.

7. The control method according to claim 1, characterized in that: The storage warehouse is provided with a safety door and a plurality of different working areas, each working area is provided with a mechanical motion module moving within the working area; The controlling the mechanical motion module to wait until the safety door is in a closed state comprises: In the case where it is determined that there is an operator in the storage warehouse, obtaining a target distance between the operator and the working area where the mechanical motion module is located; When the target distance is less than the preset distance, the mechanical motion module is controlled to wait until the safety door is in a closed state.

8. A control device, characterized in that: Used to control the mechanical movement of the mechanical motion module in the storage warehouse, the control device includes: An acquisition module is used to acquire the action sequence to be executed of the mechanical motion module; the action sequence to be executed includes a plurality of motion actions arranged in sequence according to the execution order; and acquire the state of the safety door of the storage warehouse; A control module is used to, when the safety door of the storage warehouse is in a closed state, determine the first motion action in the sequence of actions to be executed as the current motion action, and control the mechanical motion module to execute the current motion action; after the current motion action is executed, delete the current motion action from the sequence of actions to be executed, and update the sequence of actions to be executed; and return to the step of obtaining the state of the safety door of the storage warehouse to continue execution.

9. A mechanical motion device, characterized in that: The mechanical motion device comprises: Mechanical motion module, used to perform mechanical actions in the storage warehouse; A mechanical control module is used to obtain the action sequence to be executed of the mechanical motion module; the action sequence includes multiple motion actions arranged in sequence according to the execution order; obtain the status of the safety door of the storage warehouse; when the safety door of the storage warehouse is in a closed state, determine the first motion action in the action sequence to be executed as the current motion action, and control the mechanical motion module to execute the current motion action; after the current motion action is executed, delete the current motion action from the action sequence to be executed, and update the action sequence to be executed; return to the step of obtaining the status of the safety door of the storage warehouse and continue execution.

10. The mechanical motion device according to claim 9, characterized in that The mechanical motion module includes a moving mechanism, a lifting mechanism and a cargo frame push-pull gripper; the moving mechanism is used to perform a cargo frame transport action along a first preset direction or in the opposite direction of the first preset direction; the lifting mechanism is used to perform a cargo frame transport action along a second preset direction or in the opposite direction of the second preset direction; The cargo frame push-pull gripper is used to perform a cargo frame transmission action, a cargo frame grabbing action, or a cargo frame releasing action along a third preset direction or in a direction opposite to the third preset direction.

11. A readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the steps of the control method according to any one of claims 1 to 7 are implemented.