Control system and method of robot suitable for autonomous carrying
By designing an autonomous transport robot system integrating upper computer, sensor and motor control, the problem of single robot control system in the existing technology is solved, and the independent transport and elevator ride between floors is realized. Relieves the problems of insufficient labor and handling costs.
Patent Information
- Application Number
- CN202410888274.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-04
- Publication Date
- 2024-11-08
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The existing robot control system is relatively single, and it cannot integrate independent handling and elevator riding. It lacks work flexibility and cannot effectively solve the problem of insufficient labor.
An autonomous handling robot control system including upper computer, sensor, servo driver circuit, auditory system, WiFi module, CAN analyzer and vision system is designed, and is connected through serial processing module, Ethernet bidirectional communication, USB bidirectional communication, etc. Each component realizes robotic environmental identification, path planning and elevator operation.
It realizes independent cargo handling and elevator ride between floors, alleviates the pressure of labor shortage, saves labor costs, and realizes flexible cargo handling and elevator operation through visual, auditory, positioning and motor control systems.
Smart Images

Figure CN118908116A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of autonomous cargo handling and elevator control, and in particular to a control system and method suitable for an autonomous handling robot. Background Art
[0002] With the development of modern logistics services, the automation and intelligence requirements of the service industry are getting higher and higher. In recent years, my country's logistics volume has increased year by year, and with the aging of the population, it is difficult to equip the corresponding labor force, which will lead to a shortage of labor. Therefore, replacing manual labor with robots is a development trend.
[0003] Robot control technology is a relatively important component of the entire robot system that requires high precision. With the continuous growth of science and technology and the development of IoT big data, using smart devices to control robots has become a trend.
[0004] However, the existing robot control systems are relatively simple, cannot realize the integration of autonomous handling and elevator riding, and lack working flexibility. Therefore, a new type of intelligent autonomous cargo handling and riding robot is needed to solve the above problems. Summary of the invention
[0005] In order to overcome the shortcomings of the prior art, the purpose of the present invention is to provide a control system and method suitable for an autonomous transport robot, so as to solve the problems raised in the above background technology that the existing robot control system is relatively single, cannot realize the integration of autonomous transport and elevator riding, and lacks working flexibility.
[0006] To achieve the above object, the present invention provides the following technical solutions:
[0007] A control system suitable for an autonomous handling robot comprises a host computer, wherein the host computer is connected to a sensor, a steering gear drive circuit and an auditory system respectively through a serial port processing module, the host computer is connected to a WiFi module and a lower computer respectively through Ethernet two-way communication, the host computer controls a lifting platform motor and a chassis motor respectively through a CAN analyzer, and the host computer is connected to a visual system through USB two-way communication.
[0008] Furthermore, the sensors include ultrasonic sensors, radars and IMU sensors, the servo drive circuit is connected to the robotic arm gripper, and the auditory system is connected to the iFlytek voice module. The ultrasonic sensors, radars and IMU sensors can be used to identify and judge the surrounding environment and the body posture. If the body posture is incorrect, it can be fed back to the host computer, and timely controlled and adjusted through the host computer. The robotic arm gripper can cooperate with the robotic arm to complete the handling task, and the iFlytek voice module can provide offline human-computer voice interaction.
[0009] Furthermore, the WiFi module is connected to the user control terminal and the autonomous charging pile through a local area network, the lower computer controls the movement of the robotic arm through a network cable, the lifting platform motor controls the rise and fall of the lifting platform, the chassis motor controls the movement of the mobile robot, and the visual system obtains image information through D435i.
[0010] A control method for an autonomous handling robot comprises the following steps:
[0011] 1) The system powers on and self-checks and waits for instructions;
[0012] 2) Optimal path planning for the starting floor;
[0013] 3) Execute autonomous handling procedures;
[0014] 4) Complete the elevator ride task;
[0015] 5) Optimal path planning to the target floor;
[0016] 6) Execute the object placement procedure;
[0017] 7) Return to the starting point and recharge autonomously.
[0018] Furthermore, in step 1), when the system is wrong, the corresponding error code is output. When the system self-check passes, the mechanical device returns to the initial state and the program is initialized, and the system enters the standby state, waiting for the online user control terminal to issue the corresponding instruction, synchronize to the host computer through the data forwarding LAN, or directly give the host computer the corresponding instruction offline; choose one of the methods to complete the system power-on self-check and wait for instructions.
[0019] Furthermore, in the step 2), the upper computer outputs a signal after receiving the cargo transportation instruction on the starting floor, disconnects from the autonomous charging pile, accesses the serial port processing module, and identifies and judges the surrounding environment and the posture of the fuselage through ultrasonic sensors, radar sensors and IMU sensors, thereby establishing a local map of the handling floor and completing the optimal transportation path planning for the handling floor.
[0020] In step 3), the host computer sends a CAN signal to the CAN analyzer to control the chassis motor, driving the robot to run to a reasonable position in front of the handling location according to the planned path, and sends a CAN signal to the CAN analyzer to control the lifting platform motor, thereby driving the camera on the lifting platform to accurately identify the target object. At the same time, the robot performs vehicle-arm coordinated control to adjust its position to the working space that the robot arm can grasp; the host computer then controls the lower computer and the steering gear drive circuit to control the gripper on the robot arm to grasp the object through Ethernet and serial communication, and adjusts the vehicle arm posture after placing the object in the specified position to complete the autonomous handling program.
[0021] In the step 4), the robot runs to a reasonable position in front of the elevator button according to the planned path as described above. The host computer determines whether to press the up button or the down button based on the comparison between the command floor and the starting floor, so that the camera extracts the pixel depth information of the required button and starts the vehicle arm coordination system. When the elevator button is within the working space of the robotic arm, the host computer completes the robotic arm's execution of the elevator button pressing action through compliant control. After that, the robot is controlled to move to the elevator door to wait for the elevator to arrive; after entering the elevator, the above-mentioned elevator button pressing process is repeated, except that the corresponding identification button information target floor number is used. After reaching the target floor, the robot drives out of the elevator, thereby completing the elevator ride task.
[0022] In step 5), after the robot reaches the target floor, it switches the global address and uses ultrasonic sensors, radar sensors and IMU sensors to identify the surrounding environment and body posture, thereby establishing a local map of the target floor and completing the optimal path planning for the target floor.
[0023] In step 6), according to the planned path as described above, the host computer sends a CAN command to the chassis to make the robot move to the placement location; the robot arm, camera and lifting platform motor work together to make the camera recognize the object to be grasped according to the command. The robot arm places the grasped object to the target point through posture calculation, in coordination with the lifting platform and the robot arm gripper, thereby completing the object placement program.
[0024] In step 7), a series of reverse actions are planned to complete the return to the original route based on the process of reaching the target point. When the robot returns to the vicinity of the charging pile, the radar scans the contour of the charging pile so that the positive and negative poles of the robot are aligned with the charging pile, thereby completing the return to the starting point and completing autonomous charging.
[0025] The technical concept of the present invention is: when the robot is working, it first performs a system self-check, a mechanical device returns to the center position, and a program is initialized. When the system is wrong, the corresponding error code is output. After the system self-check passes, it enters a standby state, waiting for the user control end to issue a corresponding instruction, synchronize to the host computer through a data forwarding server or a local area network, or directly send an instruction to the host computer offline. After receiving the instruction, the host computer starts to execute the corresponding program to work.
[0026] Compared with the prior art, the beneficial effects of the present invention are as follows: the present invention realizes the transformation of cargo transportation between floors from manual transportation to autonomous transportation by robots combined with elevators, and realizes autonomous elevator riding and cargo transportation through vision, hearing, positioning and motor control systems, thereby alleviating the pressure of labor shortage and saving transportation labor costs. BRIEF DESCRIPTION OF THE DRAWINGS
[0027] Figure 1 It is a hardware schematic diagram of the control system of the present invention;
[0028] Figure 2 is a control system initialization flow chart of the present invention;
[0029] Figure 3 is a flow chart of the control system path planning program of the present invention;
[0030] Figure 4 It is a flow chart of the visual positioning program of the control system of the present invention;
[0031] Figure 5 is a flow chart of the cyclic harvesting program of the control system of the present invention;
[0032] Figure 6 It is a flow chart of the control method of the present invention;
[0033] Figure 7 is a flow chart of the control system path planning program of the present invention;
[0034] Figure 8 It is a flow chart of the visual positioning program of the control system of the present invention;
[0035] In the figure: 1-host computer, 2-sensor, 201-ultrasonic sensor, 202-IMU, 203-radar, 204-robotic arm gripper, 205-iFLYTEK voice module, 3-servo drive circuit, 14-serial port processing module, 4-auditory system, 101-user monitoring terminal, 11-local area network, 5-WIFI module, 6-slave computer, 103-robotic arm, 9-chassis motor, 105-robot, 7-CAN analyzer command transceiver, 8-lifting platform motor, 104-lifting platform, 10-visual system, 106-D435i binocular camera. DETAILED DESCRIPTION
[0036] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0037] Reference Figures 1 to 8, a control system suitable for an autonomous handling robot, comprising a host computer 1, wherein the host computer 1 is connected to a sensor 2, a steering gear drive circuit 3 and an auditory system 4 through a serial port processing module 14, wherein the host computer 1 is connected to a WiFi module 5 and a lower computer 6 through the function of Ethernet two-way communication, wherein the host computer 1 controls a lifting platform motor 8 and a chassis motor 9 through a CAN analyzer 7, and wherein the host computer 1 is connected to a visual system 10 through USB two-way communication. When the robot is working, the system self-checks, the mechanical device returns to the center position, and the program is initialized. When the system has an error, the corresponding error code is output. After the system self-check passes, the system enters a standby state. The system enters a standby state, waiting for the online user control terminal (101) to issue a corresponding instruction, which is synchronized to the host computer (1) through a data forwarding local area network (11), or the corresponding instruction is directly given to the host computer (1) offline. After receiving the instruction, the host computer 1 starts to execute the corresponding program to work.
[0038] In the present invention, the sensor 2 includes an ultrasonic sensor 201, an IMU sensor 202 and a radar 203, the servo drive circuit 3 is connected to the robotic arm gripper 204, and the auditory system 4 is connected to the iFlytek voice module 205. The ultrasonic sensor 201, the IMU sensor 202 and the radar 203 are used to identify and judge the surrounding environment and the fuselage posture. When the fuselage posture is incorrect, feedback can be given to the host computer 1, and timely control and adjustment can be performed through the host computer 1. The robotic arm gripper 204 can cooperate with the robotic arm to complete the handling task, and the iFlytek voice module 205 can provide offline human-computer voice interaction.
[0039] In the present invention, the WiFi module 5 is connected to the user control terminal 101 and the autonomous charging pile 102 through the local area network 11; the lower computer 6 controls the movement of the robotic arm 103 through the network cable; the lifting platform motor 8 controls the rise and fall of the lifting platform 104; the chassis motor 9 controls the movement of the mobile robot 105; and the visual system 10 obtains image information through the camera 106.
[0040] A control method for an autonomous handling robot comprises the following steps:
[0041] 1) The system powers on and self-checks and waits for instructions;
[0042] In the present invention, when the system is powered on and self-checks and waits for instructions, the corresponding error code is output when the system is wrong. After the system self-check passes, the mechanical device returns to the initial state and the program is initialized, and the system enters the standby state, waiting for the online user control terminal 101 to issue a corresponding instruction, which is synchronized to the host computer 1 through the data forwarding local area network 11, or directly gives the host computer 1 a corresponding instruction offline.
[0043] 2) Optimal path planning for the starting floor;
[0044] In the present invention, when the optimal path is planned, the upper computer 1 outputs a signal after receiving the cargo transportation instruction on the starting floor, disconnects from the autonomous charging pile 102, and identifies and judges the surrounding environment and the posture of the fuselage through the ultrasonic sensor 201, radar sensor 202 and IMU sensor 203 of the sensor 2, thereby establishing a local map of the handling floor and completing the optimal transportation path planning for the handling floor.
[0045] 3) Execute autonomous handling procedures;
[0046] In the present invention, when executing the autonomous handling procedure, the host computer 1 sends a CAN signal to the CAN analyzer 7 to control the chassis motor 9 to work, drive the robot 105 to run to a reasonable position before the handling location according to the designated path, and send a CAN signal to the CAN analyzer 7 to control the lifting platform motor, thereby driving the camera 106 on the lifting platform 104 to accurately identify the target object. At the same time, the robot 105 performs vehicle-arm coordinated control to adjust its position to the workspace that the mechanical arm 103 can grasp; then the host computer controls the lower computer 6 and the steering gear drive circuit 3 through Ethernet and serial communication to control the gripper 204 on the mechanical arm 103 to grasp the object, and adjusts the vehicle arm posture after placing the object in the specified position, completing the execution of the autonomous handling procedure.
[0047] 4) Complete the elevator ride task;
[0048] In the present invention, the robot 105 runs to a reasonable position in front of the elevator button according to the planning path as described in 7. The host computer 1 determines whether the up button or the down button should be pressed based on the comparison between the command floor and the starting floor, so that the camera 106 extracts the pixel depth information of the required button and starts the vehicle-arm coordination system. When the elevator button is within the working space of the manipulator 103, the host computer 1 completes the manipulator 103 to execute the elevator button pressing action through compliant control. After that, the robot 105 is controlled to move to the elevator door to wait for the elevator to arrive; after entering the elevator, the above-mentioned elevator button pressing process is repeated, except that the corresponding identification button information target floor number is used. After reaching the target floor, the robot 105 drives out of the elevator, thereby completing the elevator riding task.
[0049] 5) Optimal path planning to the target floor;
[0050] In the present invention, when the optimal path planning for the target floor is completed, after the robot 105 reaches the target floor, it switches the global address and uses the ultrasonic sensor 201, IMU sensor 202 and radar sensor 203 to identify the surrounding environment and body posture, thereby establishing a local map of the target floor and completing the optimal path planning for the target floor.
[0051] 6) Execute the object placement procedure;
[0052] In the present invention, when executing the object placement program, according to the planned path 9, the host computer 1 sends a CAN command to the chassis to make the robot 105 move to the placement location; through the coordinated work of the mechanical arm 103, the camera 106 and the lifting platform motor 8, the camera 106 recognizes the object to be grasped according to the command. The mechanical arm 103 places the grasped object at the target point through posture calculation in coordination with the lifting platform 104 and the mechanical arm gripper 204, thereby completing the execution of the object placement program.
[0053] 7) Return to the starting point and recharge autonomously.
[0054] In the present invention, when the robot 105 returns to the starting point and completes autonomous charging, a series of reverse actions are planned to complete the return to the starting point in combination with the above process to the target point. When the robot 105 returns to the vicinity of the charging pile 102, the radar 203 scans the contour of the charging pile 102 at this moment, so that the positive and negative poles of the robot are aligned with the charging pile 102, thereby completing the return to the starting point and completing autonomous charging, so as to prepare for the next elevator handling task.
[0055] like Figure 2 As shown, when the robot is working, it first performs a system self-check, and outputs a corresponding error code when the system is wrong. When the system self-check passes, the mechanical device returns to the initial state and the program is initialized, and the system enters a standby state, waiting for the online user control terminal 101 to issue a corresponding instruction, which is synchronized to the host computer 1 through the data forwarding local area network 11, or directly gives the host computer 1 a corresponding instruction offline.
[0056] like Figure 3 As shown, the upper computer 1 outputs a signal after receiving the instruction. After receiving the cargo transportation instruction on the starting floor, the upper computer 1 outputs a signal, disconnects from the autonomous charging pile 102, and identifies and judges the surrounding environment and the body posture through the ultrasonic sensor 201, radar sensor 202 and IMU sensor 203 of the sensor 2, thereby establishing a local map of the handling floor and completing the optimal transportation path planning for the handling floor.
[0057] like Figure 4 As shown, after the optimal path planning is completed, the host computer 1 sends a CAN signal to the CAN analyzer 7 to control the chassis motor 9 to work, drive the robot 105 to run to a reasonable position before the handling location according to the planned path, and send a CAN signal to the CAN analyzer 7 to control the lifting platform motor, thereby driving the camera 106 on the lifting platform 104 to accurately identify the target object. At the same time, the robot 105 performs vehicle-arm coordinated control to adjust its own position to the workspace that the robot arm 103 can grasp; then the host computer controls the lower computer 6 and the steering gear drive circuit 3 through Ethernet and serial communication to control the gripper 204 on the robot arm 103 to grasp the object, and adjusts the vehicle arm posture after placing the object in the specified position, completing the execution of the autonomous handling program.
[0058] like Figure 5 As shown, after completing the autonomous transport program, it runs to a reasonable position in front of the elevator button. The host computer 1 determines whether to press the up button or the down button based on the comparison between the command floor and the starting floor, so that the camera 106 extracts the pixel depth information of the required button and starts the vehicle-arm coordination system. When the elevator button is within the working space of the manipulator 103, the host computer 1 completes the manipulator 103 to execute the elevator button pressing action through compliant control. After that, the robot 105 is controlled to move to the elevator door to wait for the elevator to arrive; after entering the elevator, the above-mentioned elevator button pressing process is repeated, except that the corresponding identification button information target floor number is used. After reaching the target floor, the robot 105 drives out of the elevator, thereby completing the elevator riding task.
[0059] like Figure 6 As shown, after completing the elevator ride task, the robot 105 reaches the target floor, switches the global address and uses the ultrasonic sensor 201, IMU sensor 202 and radar sensor 203 to identify the surrounding environment and body posture, thereby establishing a local map of the target floor and completing the optimal path planning for the target floor.
[0060] like Figure 2 As shown, after the optimal path planning is completed, according to the planned path, the host computer 1 sends a CAN command to the chassis to make the robot 105 move to the placement location; through the coordinated work of the mechanical arm 103, the camera 106 and the lifting platform motor 8, the camera 106 recognizes the object to be grasped according to the command. The mechanical arm 103 places the grasped object to the target point through posture calculation in coordination with the lifting platform 104 and the mechanical arm gripper 204, thereby completing the execution of the object placement program.
[0061] like Figure 7 As shown, after completing the object placement program, combined with the above process to the target point, a series of reverse actions are planned to complete the return. When the robot 105 returns to the vicinity of the charging pile 102, the radar 203 scans the contour of the charging pile 102, so that the positive and negative poles of the robot are aligned with the charging pile 102, thereby completing the return to the starting point and completing autonomous charging, so as to prepare for the next elevator handling task.
[0062] When the robot is working, it first performs a system self-check, mechanical device returns to the center position, and program initialization. When the system is wrong, the corresponding error code is output. After the system self-check passes, it enters the standby state, waiting for the user control terminal 12 to issue a corresponding instruction, synchronize to the host computer 1 through the data forwarding local area network 10, or send instructions to the host computer 1 directly offline. After receiving the instruction, the host computer 1 starts to execute the corresponding program to work. The present invention realizes the transformation of cargo handling between floors from manual handling to robot combined with elevator autonomy. Through vision, hearing, positioning and motor control systems, autonomous elevator riding and cargo handling are realized, which alleviates the pressure of insufficient labor and saves the labor cost of handling.
[0063] It is obvious to those skilled in the art that the present invention is not limited to the details of the exemplary embodiments described above, and that the present invention can be implemented in other specific forms without departing from the spirit or essential features of the present invention. Therefore, the embodiments should be regarded as exemplary and non-limiting from any point of view, and the scope of the present invention is defined by the appended claims rather than the above description, and it is intended that all changes falling within the meaning and scope of the equivalent elements of the claims are included in the present invention, and any reference numerals in the claims should not be regarded as limiting the claims involved.
[0064] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can make equivalent replacements or changes according to the technical scheme and inventive concept of the present invention within the technical scope disclosed by the present invention, which should be covered by the protection scope of the present invention.
Claims
1. A control system for a robot adapted for autonomous handling, comprising a host computer (1), characterized in that: The host computer (1) is connected to a sensor (2), a steering gear drive circuit (3) and an auditory system (4) through a serial port processing module (14); the host computer (1) is connected to a WiFi module (5) and a lower computer (6) through Ethernet bidirectional communication; the host computer (1) controls a lifting platform motor (8) and a chassis motor (9) through a CAN analyzer (7); and the host computer (1) is connected to a visual system (10) through USB bidirectional communication.
2. A control system for a robot adapted for autonomous handling according to claim 1, characterized in that: The sensor (2) comprises an ultrasonic sensor (201), an IMU sensor (202), and a radar (203); the steering gear drive circuit (3) is connected to the mechanical arm gripper (204); the auditory system (4) is connected to the iFlytek module (205); the ultrasonic sensor (201), the radar (203), and the IMU sensor (202) are used to identify and judge the surrounding environment and the posture of the fuselage; when the posture of the fuselage is incorrect, feedback can be given to the host computer, and timely control and adjustment can be performed through the host computer; the mechanical arm gripper can cooperate with the mechanical arm to complete the handling task; and the iFlytek voice module can provide offline human-computer voice interaction.
3. A control system for a robot adapted for autonomous handling according to claim 1 or 2, characterized in that: The WiFi module (5) is connected to a user control terminal (101) and an autonomous charging pile (102) via a local area network (11); the lower computer (6) controls the movement of a mechanical arm (103) via a network cable; the lifting platform motor (8) controls the lifting platform (104) to rise and fall; the chassis motor (9) controls the movement of a mobile robot (105); and the visual system (10) acquires image information via a D435i (106).
4. A control method implemented by the control system of the robot adapted for autonomous handling as claimed in claim 1, characterized in that: The following steps are involved: 1) The system powers on and self-checks and waits for instructions; 2) Optimal path planning for the starting floor; 3) Execute autonomous handling procedures; 4) Complete the elevator ride task; 5) Optimal path planning to the target floor; 6) Execute the object placement procedure; 7) Return to the starting point and recharge autonomously.
5. The control method according to claim 4, characterized in that: In the step 1), when the system has an error, a corresponding error code is output. When the system self-check passes, the mechanical device returns to the initial state and the program is initialized, and the system enters a standby state, waiting for the online user control terminal (101) to issue a corresponding instruction, which is synchronized to the host computer (1) through the data forwarding local area network (11), or the host computer (1) is directly given a corresponding instruction offline; one of the methods is selected to complete the system power-on self-check and wait for instructions.
6. The control method according to claim 4 or 5, characterized in that: In the step 2), the upper computer (1) outputs a signal after receiving the cargo transport instruction on the starting floor, disconnects from the autonomous charging pile (102), and identifies and judges the surrounding environment and the posture of the fuselage through the ultrasonic sensor (201), radar sensor (202) and IMU sensor (203) of the sensor (2), thereby establishing a local map of the transport floor and completing the optimal transport path planning for the transport floor.
7. The control method according to claim 4 or 5, characterized in that: In the step 3), the upper computer (1) sends a CAN signal to the CAN analyzer (7) to control the chassis motor (9) to operate, drive the robot (105) to run to a reasonable position in front of the handling location according to the designated path, and send a CAN signal to the CAN analyzer (7) to control the lifting platform motor, thereby driving the camera (106) on the lifting platform (104) to accurately identify the target object. At the same time, the robot (105) performs vehicle-arm coordinated control to adjust its own position to the working space that the mechanical arm (103) can grasp; then the upper computer controls the lower computer (6) and the steering gear drive circuit (3) through Ethernet and serial communication to control the gripper (204) on the mechanical arm (103) to grasp the object, and adjusts the vehicle arm posture after placing the object in the specified position, completing the execution of the autonomous handling program.
8. The control method according to claim 4 or 5, characterized in that: In step 4), the robot (105) moves to a reasonable position in front of the elevator button according to the planned path as described in step 7. The host computer (1) determines whether the up button or the down button should be pressed based on the comparison between the command floor and the starting floor, so that the camera (106) extracts the pixel depth information of the required button and starts the vehicle-arm coordination system. When the elevator button is within the working space of the robot arm (103), the host computer (1) completes the robot arm (103) to execute the action of pressing the elevator button through compliant control. After that, the robot (105) is controlled to move to the elevator door to wait for the elevator to arrive; After entering the elevator, the above-mentioned elevator button pressing process is repeated, except that the corresponding identification button information target floor number is added. The robot (105) drives out of the elevator after reaching the target floor, thereby completing the elevator riding task.
9. The control method according to claim 4 or 5, characterized in that: In the step 5), after the robot (105) reaches the target floor, it switches the global address and uses the ultrasonic sensor (201), the IMU sensor (202) and the radar sensor (203) to identify the surrounding environment and the body posture, thereby establishing a local map of the target floor and completing the optimal path planning for the target floor.
10. The control method according to claim 9, characterized in that: In step 6), according to the planned path, the host computer (1) sends a CAN command to the chassis to make the robot (105) move to the placement location; through the coordinated work of the mechanical arm (103), the camera (106) and the lifting platform motor (8), the camera (106) recognizes the object to be grasped according to the command. The mechanical arm (103) places the grasped object at the target point through posture calculation in coordination with the lifting platform (104) and the mechanical arm gripper (204), thereby completing the object placement program; In the step 7), a series of reverse actions are planned to complete the return to the original route in combination with the process to the target point; when the robot (105) returns to the vicinity of the charging pile (102), the radar (203) scans the contour of the charging pile (102) at this moment, so that the positive and negative poles of the robot are aligned with the charging pile (102), thereby completing the return to the starting point along the original route and completing autonomous charging, so as to prepare for the next elevator handling task.
Citation Information
Patent Citations
Modular hotel carrying robot system
CN107421544A
Automatic elevator taking robot for goods distribution and work method of automatic elevator taking robot
CN111730575A
Intelligent service robot system capable of automatically opening door
CN114473998A
Intelligent service robot for autonomously operating box type elevator
CN114505840A
Control system suitable for fruit and vegetable picking robot and control method thereof
CN114859923A
