Multifunctional recycling robot and its control method based on multi-sensor information fusion
By designing a multi-functional recycling robot with multi-sensing information fusion in the shooting sports field, the efficient shell recycling is achieved using visual recognition, navigation and cleaning devices, and the problem of low shell recycling efficiency in complex outdoor environments is solved. It is suitable for civil and police fields. .
Patent Information
- Application Number
- CN202410773213.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-06-17
- Publication Date
- 2024-11-01
- Estimated Expiration
- 2044-06-17
AI Technical Summary
In the shooting sports field, due to the ground such as soil and weeds, the shells are scattered irregularly and have a large range, resulting in low manual recycling efficiency and a waste of manpower and material resources. The existing recycling robots are not suitable for complex outdoor environments.
Design a multi-functional recycling robot based on multi-sensing information fusion, including visual recognition module, navigation module, picking mechanism, cleaning device and control module. By real-time identification of the position of the shell, planning navigation path, picking and cleaning, using the robotic arm, Magnetic units and circulating water tanks achieve efficient recycling.
Improve the efficient operation and slewing utilization capabilities of the shooting range, and is suitable for civil and police fields, realizes terrain passage, rapid identification and positioning of targets, large-area pickup and cleaning, solves the problem of low manual recycling efficiency, and has wireless communication and operation. Complete the identification function.
Smart Images

Figure CN118357893B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of intelligent robots, and in particular to a multifunctional recycling robot based on multi-sensor information fusion and a control method thereof. Background Art
[0002] Shooting has gradually become a popular sport. With the improvement of people's living standards, more and more people are participating in shooting sports, and the construction of shooting ranges is becoming more and more abundant. However, during the shooting process, there will be a large number of bullet shells scattered around the shooters, and the shooting range must clean up the bullet shells in time.
[0003] The shooting range ground is full of obstacles such as mud and weeds, and the shells are scattered irregularly and over a large area. Therefore, relying on manual recovery will waste a lot of manpower and material resources. In addition, manual recovery requires cleaning and counting, which requires a lot of time and energy, greatly reducing work efficiency.
[0004] At present, different garbage recycling robots, tableware recycling robots, and plastic bottle recycling robots have been developed for specific application scenarios, but these recycling robots are not suitable for shell recycling operations in shooting ranges in complex outdoor environments. Summary of the invention
[0005] The technical problem to be solved by the present invention is to provide a multifunctional recovery robot based on multi-sensor information fusion and a control method thereof, which can effectively improve the efficient operation and rotation utilization capabilities of a shooting range.
[0006] In order to solve the above technical problems, the present invention provides a multifunctional recovery robot based on multi-sensor information fusion, comprising: a robot body, a walking mechanism arranged at the bottom of the robot body, a visual recognition module, a navigation module, a picking mechanism, a cleaning device, a box, a power module and a control module; the visual recognition module identifies the position of the cartridge case in real time, and sends the position of the cartridge case to the navigation module through the control module; the navigation module plans a navigation path according to the position of the cartridge case, and sends the navigation path to the control module; the control module drives the walking mechanism to move to the position of the cartridge case according to the navigation path, drives the picking mechanism to pick up the cartridge case, and drives the cleaning device to clean the picked up cartridge case; the box stores the cleaned cartridge case; the power module supplies power to the walking mechanism, the visual recognition module, the navigation module, the picking mechanism, the cleaning device and the control module respectively.
[0007] As an improvement of the above-mentioned scheme, the picking mechanism includes at least one execution unit, and the execution unit includes a mechanical arm, a magnetic unit and a picking weight sensor. One end of the mechanical arm is connected to the robot body, and the other end is connected to the magnetic unit; the robot body is provided with a cavity for accommodating the execution unit. When picking up a cartridge case, the mechanical arm extends out of the cavity to drive the magnetic unit to pick up the cartridge case. After completing the picking, the mechanical arm retracts into the cavity; the picking weight sensor is arranged on the magnetic unit, for detecting the picking weight of the cartridge case picked up by the magnetic unit in real time and sending the picking weight of the cartridge case to the control module. When the picking weight of the picked up cartridge case is greater than the preset picking weight, the mechanical arm transfers the cartridge case picked up by the magnetic unit to the cleaning device.
[0008] As an improvement of the above scheme, the cleaning device includes a circulating water tank and a cartridge case remover. The circulating water tank is provided with a cartridge case inlet, a cartridge case outlet and a water outlet. The cartridge case remover is arranged at the cartridge case inlet. The picking mechanism extends the picked-up cartridge case into the circulating water tank along the cartridge case inlet, and the cartridge case remover scrapes the cartridge case off the picking mechanism so that the cartridge case falls into the circulating water tank for circulating filtration.
[0009] As an improvement of the above scheme, a visual sensor, a rolling trajectory, a diverter plate and a water spray head group are also provided in the circulating water tank, and the visual sensor corresponds to the rolling trajectory, the diverter plate and the water spray head group one by one; the diverter plate is provided at the entrance of the corresponding rolling trajectory, and is used to control the opening and closing state of the rolling trajectory to divert the cartridge cases in the circulating water tank; the water spray head group is provided at the corresponding rolling trajectory, and is used to flush the cartridge cases in the rolling trajectory; the visual sensor detects the cartridge case information in the corresponding rolling trajectory in real time, and sends the cartridge case information to the control module, and when there is a cartridge case in the rolling trajectory, the corresponding water spray head group is started to flush the cartridge case in the rolling trajectory.
[0010] As an improvement of the above solution, a storage entrance is provided on the box body, and a hair dryer for drying the cartridge cases is provided at the storage entrance.
[0011] As an improvement of the above scheme, a storage weight sensor is also provided in the box body; the storage weight sensor detects the storage weight of the cartridge cases in the box body in real time, and sends the storage weight of the cartridge cases to the control module, and the control module calculates the number of cartridge cases in the box body according to the storage weight of the cartridge cases.
[0012] As an improvement of the above solution, the multifunctional recycling robot based on multi-sensor information fusion also includes a communication module connected to the control module, and signal transmission is performed between the control module and the external terminal device through the communication module.
[0013] As an improvement of the above solution, the multifunctional recycling robot based on multi-sensor information fusion also includes an identification module connected to the control module, and the identification module is provided with identification powder; the control module drives the identification module to release the identification powder synchronously with the movement of the walking mechanism.
[0014] Correspondingly, the present invention also provides a control method for a multifunctional recycling robot, comprising: the control module initializes the working state of the multifunctional recycling robot; the control module starts the multifunctional recycling robot, wherein: the control module obtains the position of the cartridge case collected by the visual recognition module, and sends the position of the cartridge case to the navigation module, so that the navigation module plans a navigation path according to the position of the cartridge case; the control module obtains the navigation path sent by the navigation module, and drives the walking mechanism to move to the position of the cartridge case according to the navigation path; the control module drives the picking mechanism to pick up the cartridge case; the control module obtains the picking weight of the cartridge case collected by the picking mechanism, and drives the picking mechanism to transfer the picked up cartridge case to the cleaning device according to the picking weight of the cartridge case, and drives the cleaning device to clean the picked up cartridge case.
[0015] As an improvement of the above-mentioned scheme, the step of the control module starting the multifunctional recovery robot also includes: the control module obtains the storage weight of the shells collected by the box, and calculates the number of shells in the box according to the storage weight of the shells; the control module obtains the water level information of the cleaning device, and adjusts the water level state in the cleaning device according to the water level information; the control module obtains the power information of the power module, and adjusts the power supply mode of the power module according to the power information; the control module obtains the identification information collected by the visual recognition module, and sends the identification information to the navigation module, so that the navigation module plans the navigation path according to the shell position and identification information.
[0016] The implementation of the present invention has the following beneficial effects:
[0017] The present invention adopts the fusion of multiple sensor information and has the functions of strong terrain passability, rapid target identification and positioning, large-area target picking, cleaning, etc. It solves the problems of low efficiency and high labor workload in manual picking of shell casings in existing field shooting ranges, is beneficial to improving the efficient operation and rotation utilization capabilities of the shooting range, and is suitable for civilian and police fields.
[0018] Furthermore, the present invention also has functions such as wireless communication, points, and job completion marking, and is more diversified in functions and more reliable in performance. BRIEF DESCRIPTION OF THE DRAWINGS
[0019] Figure 1It is a structural schematic diagram of a first embodiment of a multifunctional recycling robot based on multi-sensor information fusion of the present invention;
[0020] Figure 2 is a structural schematic diagram of another perspective of the first embodiment of the multifunctional recycling robot based on multi-sensor information fusion of the present invention;
[0021] Figure 3 It is a schematic diagram of the structure of an embodiment of the picking mechanism in the present invention;
[0022] Figure 4 It is a schematic diagram of the structure of an embodiment of the cleaning device of the present invention;
[0023] Figure 5 It is a flow chart of an embodiment of the control method based on the multifunctional recycling robot of the present invention. DETAILED DESCRIPTION
[0024] In order to make the purpose, technical solution and advantages of the present invention clearer, the present invention will be further described in detail with reference to the accompanying drawings. It is hereby stated that the directional terms such as up, down, left, right, front, back, inside, outside, etc. that appear or will appear in the text of the present invention are only based on the accompanying drawings of the present invention, and are not specific limitations of the present invention.
[0025] See also Figure 1~Figure 2 , Figure 1~Figure 2 The first embodiment of the multifunctional recycling robot based on multi-sensor information fusion of the present invention is shown, which includes a robot body 1, a walking mechanism 2 arranged at the bottom of the robot body 1, a visual recognition module 3 arranged on the robot body 1, a navigation module, a picking mechanism, a cleaning device 6, a box 7, a power module 8 and a control module 9.
[0026] During operation, the visual recognition module 3 identifies the position of the cartridge case in real time, and sends the position of the cartridge case to the navigation module through the control module 9; the navigation module plans a navigation path according to the position of the cartridge case, and sends the navigation path to the control module 9; the control module 9 drives the walking mechanism 2 to move to the position of the cartridge case according to the navigation path, and drives the picking mechanism to pick up the cartridge case; after picking up a cartridge case of a certain weight, the control module 9 drives the picking mechanism to transfer the picked up cartridge case to the cleaning device 6, and drives the cleaning device 6 to clean the picked up cartridge case; the cleaned cartridge case enters the box 7 for storage; at the same time, the power module 8 supplies power to the walking mechanism 2, the visual recognition module 3, the navigation module, the picking mechanism, the cleaning device 6 and the control module 9 respectively.
[0027] The walking mechanism 2, the visual recognition module 3, the navigation module, the picking mechanism, the cleaning device 6, the box 7, the power module 8 and the control module 9 are described in detail below:
[0028] 1. Walking mechanism 2
[0029] like Figure 1 As shown, the walking mechanism 2 is an armored crawler structure, which is mainly composed of a motor, wheels (driving wheel 21, driven wheel 22, multiple track rollers 23, oblique guide wheels 24, and external cams 25) and an adjustable crawler 26 sleeved on the outside of the wheels. Among them, the motor drives the driving wheel 21, and the driving wheel 21 and the driven wheel 22 are arranged on the same horizontal plane. The surfaces of the driving wheel 21 and the driven wheel 22 are evenly distributed with multiple grooves 27, and the grooves 27 form a good match with the external cam 25; each track roller 23 is composed of a roller 231, a rubber sleeve 232 sleeved on the outside of the roller 231, and a rotating shaft 233 arranged on the inside of the roller 231, and the rubber sleeve 232 can reduce the friction between the track roller 23 and the crawler 26, thereby increasing the life and reliability of the system; the oblique guide wheel 24 is arranged between the track roller 23 and the driven wheel 22, so that the crawler 26 is always in a taut state, ensuring the stability of the recovery robot.
[0030] Furthermore, a baffle 28 may be provided between the walking mechanism 2 and the robot body 1 to protect the connection portion between the walking mechanism 2 and the robot body 1 .
[0031] Accordingly, the width of the walking mechanism 2 is about 1.2 to 1.6 meters, the height is about 0.6 meters, the carrying capacity is 1 to 2 tons, and the climbing ability is 0 to 45 degrees, which can achieve barrier-free travel on muddy and sandy terrain in the field shooting range.
[0032] 2. Visual Recognition Module 3
[0033] The visual recognition module 3 includes three recognition units respectively installed at the front end and both sides of the robot body 1; each recognition unit includes a high-performance visual camera and an embedded deep vision processor, which are used to realize the recognition and positioning of the shells, and transmit the relevant shell positions to the control module 9 to guide the multifunctional recovery robot to pick up the shells.
[0034] 3. Navigation Module
[0035] The navigation module can navigate the working area according to the feedback from the visual recognition module 3 .
[0036] 4. Pick-up mechanism
[0037] like Figure 3 As shown, the picking mechanism includes a front-end execution unit 51 installed at the front end of the robot body 1, a left-side execution unit 52 and a right-side execution unit 53 installed at both sides of the robot body 1;
[0038] Each execution unit includes a foldable mechanical arm 54, a magnetic unit 55 and a picking weight sensor 56. One end of the mechanical arm 44 is connected to the robot body 1, and the other end is connected to the magnetic unit 55. The robot body 1 is provided with a cavity for accommodating the execution unit. When picking up a shell, the mechanical arm 54 extends out of the cavity to drive the magnetic unit 55 to pick up the shell. After the picking is completed, the mechanical arm 54 retracts into the cavity. The picking weight sensor 56 is arranged on the magnetic unit 55, which is used to detect the picking weight of the shell picked up by the magnetic unit 55 in real time and send the picking weight of the shell to the control module 9. When the picking weight of the picked shell is greater than the preset picking weight, the mechanical arm 54 transfers the shell picked up by the magnetic unit 55 to the cleaning device 6.
[0039] The magnetic unit 55 is composed of a cloth bag filled with a certain amount of magnetic powder, and is roughly circular in shape; when the magnetic unit 55 rotates and sweeps on the ground, it can absorb the shells scattered on the ground.
[0040] The mechanical arm 54 is composed of a hinge 541, a plurality of connecting rods (a first connecting rod 542, a second connecting rod 543 and a third connecting rod 544), and a locking mechanism. The first connecting rod 542, the second connecting rod 543 and the third connecting rod 544 are hinged in sequence. Specifically:
[0041] (1) When the picking mechanism performs the task of picking up the shell, the robot arm extends the second connecting rod 543 and the third connecting rod 544 outward from the inside of the cavity. At the same time, the third connecting rod 544 drives the magnetic unit 55 to realize the full-position movement in the plane space (i.e., 360° rotation movement), thereby absorbing the shells scattered on the ground to the maximum extent.
[0042] (2) When the picking mechanism is not working, the robot arm 54 is folded and retracted into the cavity.
[0043] (3) When the magnetic unit 55 is full of cartridge cases (i.e., the cartridge case pickup weight is greater than the preset pickup weight), the mechanical arm 54 transfers the cartridge cases to the cleaning device 6. It should be noted that when the pickup weight sensor 56 detects that the cartridge case pickup weight reaches the preset pickup weight, it sends a signal to the control module 9, and the control module 9 sends a cartridge case return instruction to the pickup mechanism according to the signal, and the third connecting rod 544 and the second connecting rod 543 randomly drive the magnetic unit 55 to return the cartridge case to the entrance of the cleaning device 6.
[0044] 5. Cleaning device 6
[0045] like Figure 4 As shown, the cleaning device 6 includes a circulating water tank 61 with a circulating filtering function and a wiper-type cartridge case remover 62. The circulating water tank 61 is provided with a cartridge case inlet 6a, a cartridge case outlet 6b and a water outlet. The cartridge case remover 62 is arranged at the cartridge case inlet 6a.
[0046] When the picking mechanism extends the picked-up shells into the circulating water tank 61 along the shell inlet 6a, the shell remover 62 scrapes off the shells adsorbed on the picking mechanism, so that the shells fall into the circulating water tank 61 for circulation filtration.
[0047] Furthermore, a visual sensor, a rolling trajectory 64, a diverter plate 65 and a water spray head group 66 are also provided in the circulating water tank 61. The visual sensor corresponds to the rolling trajectory 64, the diverter plate 65 and the water spray head group 66 one by one. The water spray head group 66 includes at least one high-pressure water spray head.
[0048] The diverter plate 65 is arranged at the entrance of the corresponding rolling trajectory 64, and is used to control the opening and closing state of the rolling trajectory 64 to divert the cartridge cases in the circulating water tank 61; when there are many cartridge cases, the diverter plate 65 is opened to open the corresponding rolling trajectory 64, thereby diverting the cartridge cases in the circulating water tank 61 through the rolling trajectory 64.
[0049] The water spray head group 66 is arranged at the corresponding rolling ballistic trajectory 64, and is used to perform high-pressure water flow flushing on the shells in the rolling ballistic trajectory 64;
[0050] The visual sensor detects the cartridge case information in the corresponding rolling trajectory 64 in real time and sends the cartridge case information to the control module 9 ; when there is a cartridge case in the rolling trajectory 64 , the water spray head group 66 corresponding to the rolling trajectory 64 is started to flush the cartridge case in the rolling trajectory 64 .
[0051] More preferably, a water level sensor is further provided in the circulating water tank 61 , and the water level sensor detects the water level information of the circulating water tank 61 in real time and sends the water level information to the control module 9 .
[0052] 6. Box 7
[0053] A storage entrance is provided on the box body 7, and a hair dryer for drying the cartridge cases is provided at the storage entrance.
[0054] After the cartridge case is cleaned by the cleaning device 6, it can be transported to the storage inlet of the box body 7 along the cartridge case outlet 6b. At this time, the blower at the storage inlet will dry the input cartridge case in time.
[0055] Furthermore, a storage weight sensor is provided at the bottom of the box 7;
[0056] The storage weight sensor detects the storage weight of the cartridge cases in the box 7 in real time, and sends the storage weight of the cartridge cases to the control module 9. The control module 9 calculates the number of cartridge cases in the box 7 according to the storage weight of the cartridge cases, and displays it in real time through the human-computer interaction interface.
[0057] 7. Power module 8
[0058] The power module 8 includes a rechargeable mobile power source and a solar power source; when working, the rechargeable mobile power source is used mainly, and the solar power source is used as a supplement.
[0059] The solar receiving panels of the solar power source are installed on the front, top and both sides of the robot body 1, so as to maximize the cruising range of the multifunctional recycling robot.
[0060] 8. Control module 9
[0061] The control module 9 includes a central processing unit, an embedded motion control card, an information processor and a data storage device. Specifically:
[0062] The central processor communicates with the walking mechanism 2, the visual recognition module 3, the navigation module, the picking mechanism, the cleaning device 6, the power module 8, etc., and displays the relevant information on the external terminal device;
[0063] The motion control card sends motion signals to the actuator (eg, the walking mechanism 2, the picking mechanism) according to the instructions of the central processor, and the motion control card is provided with a wireless communication interface.
[0064] The information processor mainly processes the signals received by the visual sensor, the pickup weight sensor and the storage weight sensor, and converts the shell weight into the number of shells.
[0065] See also Figure 1 and Figure 2 The multifunctional recycling robot based on multi-sensor information fusion of the present invention further includes a communication module 10 and a plurality of identification modules 11 connected to the control module 9; in application, the communication module 10 and the identification module 11 can be added separately or simultaneously according to actual conditions. Specifically:
[0066] The control module 9 and the external terminal device transmit signals through the communication module 10. The communication module 10 can realize remote operation (start, stop, turn, obstacle avoidance and retraction and extension of the folding and unfolding mechanism, etc.) of the multifunctional recycling robot, which is mainly composed of an embedded information processor and a communication interface.
[0067] Accordingly, the identification module 11 is used to mark the area where the shell has been picked up to avoid the robot from repeating work. The identification module 11 is respectively arranged at the four corners of the robot body 1, which is a box structure with a powder outlet at the bottom, and the box is loaded with identification powder of different colors.
[0068] For example, the box body can be divided into multiple independent areas, and a color of marking powder can be placed in each area. Before the multifunctional recycling robot moves, a marking powder can be selected as the target marking powder through the external terminal device, and transmitted to the control module 9 through the communication module 10. The control module 9 drives the marking module 11 to release the target marking powder synchronously with the movement of the walking mechanism 2, so that the target marking powder is scattered on the ground, which is convenient for the navigation module to navigate the operation area according to the feedback of the visual recognition module 3, avoiding confusion during the next picking operation.
[0069] Therefore, when the picking mechanism performs the picking operation, the visual recognition module 3 will transmit the recognized shell image and obstacle area image to the control module 9, and the control module 9 will generate instructions to drive the multifunctional recovery robot to the relevant area for operation. During the operation, the identification module 11 will distribute identification color powder to implement the identification function of the completed operation; at the same time, the number of picked shells and the working status of each functional unit in the multifunctional recovery robot will be displayed in real time on the external terminal device; if an obstacle is encountered on the way forward, the multifunctional recovery robot will stop moving and adjust the path according to the instructions of the navigation module.
[0070] From the above, it can be seen that the multifunctional recovery robot based on multi-sensor information fusion of the present invention has a relatively strong terrain passing ability; at the same time, the present invention also has the functions of automatic target recognition and positioning, picking, cleaning, counting, and operation completion marking, so as to solve the problem that the existing shell recovery device has a single technical means and cannot realize multifunctional, automated, intelligent, and unmanned operation. It is conducive to executing recovery tasks in complex outdoor environments and is suitable for civilian and other fields.
[0071] See also Figure 5 , Figure 5 The flowchart of an embodiment of the control method of the multifunctional recycling robot according to the present invention is shown, which includes:
[0072] S101, the control module initializes the working state of the multifunctional recycling robot;
[0073] When the control module initializes the working state of the multifunctional recycling robot, it needs to check whether the working state of each functional unit meets the requirements;
[0074] For example, whether the magnetic unit is damaged, whether the water level in the circulating water tank meets the requirements, and whether the wireless communication is smooth;
[0075] S102, the control module starts the multifunctional recycling robot.
[0076] After installing the three magnetic units, start the multifunctional recycling robot and debug the picking mechanism; at the same time, turn on all sensors of the multifunctional recycling robot (pickup weight sensor, storage weight sensor, visual sensor), and check whether the sensors are working properly, whether the sensor signals are transmitted normally, and whether the sensor signals are updated in real time through external terminal devices, so as to facilitate detection and debugging;
[0077] Specifically, after the control module starts the multifunctional recycling robot, the multifunctional recycling robot performs the following operations:
[0078] (1) The control module obtains the position of the cartridge case collected by the visual recognition module and sends the position of the cartridge case to the navigation module so that the navigation module plans a navigation path according to the position of the cartridge case;
[0079] The visual signal (casing image) detected by the high-performance visual camera in the visual recognition module is transmitted to the embedded deep vision processor for real-time data processing and sent to the control module to guide the robot operation;
[0080] (2) The control module obtains the navigation path sent by the navigation module and drives the walking mechanism to move to the shell position according to the navigation path;
[0081] The navigation module conducts comprehensive analysis based on the visual signals collected by the visual recognition module to guide the robot's operating direction without causing the robot to perform repeated operations.
[0082] After the robot works normally, the control module controls the motor speed through the output end, and the motor drives the multifunctional recycling robot to perform recycling operations under the guidance of the visual recognition module. At the same time, the photoelectric encoder installed on the motor sends the measured motor angle and speed signals to the motion control board. The motion control board processes the signal in real time and feeds it back to the photoelectric encoder interface of the motion control board to form a closed-loop speed feedback control to ensure that the motor speed meets the task requirements.
[0083] (3) The control module drives the picking mechanism to pick up the cartridge case;
[0084] (4) The control module obtains the weight of the cartridge case picked up by the picking mechanism, drives the picking mechanism to transfer the picked up cartridge case to the cleaning device according to the weight of the cartridge case picked up, and drives the cleaning device to clean the picked up cartridge case.
[0085] The weight sensor transmits the shell pickup weight measured from the magnetic unit back to the control module in real time. When the shell pickup weight reaches the designed peak value (preset pickup weight), the pickup mechanism sends a bullet delivery instruction, and the pickup mechanism immediately stops the picking action and returns the adsorbed shell to the entrance of the cleaning device.
[0086] Furthermore, the step of the control module starting the multifunctional recycling robot also includes:
[0087] (1) The control module obtains the storage weight of the cartridge cases collected by the box, and calculates the number of cartridge cases in the box based on the storage weight of the cartridge cases;
[0088] The storage weight sensor transmits the shell storage weight to the control module in real time and displays it on the external terminal device through the communication module;
[0089] At the same time, the control module converts the storage weight of the incoming shells into the number of shells in real time and displays it in real time on the external terminal device; accordingly, when the storage weight of the shells reaches the designed peak value, the multifunctional recovery robot is controlled to stop working.
[0090] (2) The control module obtains water level information of the cleaning device and adjusts the water level state in the cleaning device according to the water level information;
[0091] The water level sensor in the circulating water tank transmits the water level information to the control module for real-time data processing and displays it in real time through the external terminal device; when the water level information is lower than the working requirement and the shell cannot be cleaned, the control module sends a warning signal to the external terminal device to remind the management personnel to handle it.
[0092] (3) The control module obtains the power information of the power module and adjusts the power supply mode of the power module according to the power information;
[0093] When the power of the rechargeable mobile power source is insufficient, the control module drives the solar power source to ensure that the multifunctional recycling robot continues to perform operations.
[0094] (4) The control module obtains the identification information collected by the visual recognition module and sends the identification information to the navigation module so that the navigation module plans a navigation path according to the shell position and the identification information.
[0095] The visual recognition module sprinkles identification powder according to the operating speed of the multifunctional recycling robot and the set color to form an identification belt. The width of the identification belt plus the width of the track and the maximum working length of the robotic arms on the left and right sides is the final completed operating area.
[0096] At this time, the visual signals (shell images and work area images) monitored in real time by the high-performance visual camera in the visual recognition module are transmitted to the embedded deep vision processor for real-time data processing and sent to the control module to guide the robot operation;
[0097] Therefore, the present invention transmits the measurement data of multiple sensors back to the control module in real time, and processes, calculates and analyzes the measurement data through the control module, and sends corresponding control signals to each functional unit, so as to realize the start, stop and steering control of the walking mechanism, the sweeping and return control of the picking mechanism, the start and stop control of the cleaning device, the counting and display of the counting module, the signal transmission of the visual recognition system, the mode switching of the multi-source power system, the signal feedback of the intelligent navigation system, etc., thereby realizing the precise execution of the recovery robot in complex outdoor environments.
[0098] The above is a preferred embodiment of the present invention. It should be pointed out that a person skilled in the art can make several improvements and modifications without departing from the principle of the present invention. These improvements and modifications are also considered to be within the scope of protection of the present invention.
Claims
1. A multifunctional recycling robot based on multi-sensor information fusion, characterized in that: It includes a robot body, a walking mechanism arranged at the bottom of the robot body, a visual recognition module, a navigation module, a picking mechanism, a cleaning device, a box, a power module and a control module arranged on the robot body; The visual recognition module recognizes the position of the cartridge case in real time, and sends the position of the cartridge case to the navigation module through the control module; The navigation module plans a navigation path according to the position of the cartridge case and sends the navigation path to the control module; The control module drives the walking mechanism to move to the shell position according to the navigation path, drives the picking mechanism to pick up the shell, and drives the cleaning device to clean the picked shell; The box stores cleaned cartridge cases; The power module supplies power to the walking mechanism, visual recognition module, navigation module, picking mechanism, cleaning device and control module respectively; The cleaning device comprises a circulating water tank and a shell shedder, wherein the circulating water tank is provided with a shell inlet, a shell outlet and a water outlet, and the shell shedder is arranged at the shell inlet; the picking mechanism extends the picked-up shells into the circulating water tank along the shell inlet, and the shell shedder scrapes the shells off the picking mechanism, so that the shells fall into the circulating water tank for circulating filtration; The circulating water tank is also provided with a visual sensor, a rolling trajectory, a diverter plate and a water spray head group, and the visual sensor corresponds to the rolling trajectory, the diverter plate and the water spray head group one by one; the diverter plate is arranged at the entrance of the corresponding rolling trajectory, and is used to control the opening and closing state of the rolling trajectory to divert the cartridge cases in the circulating water tank; the water spray head group is arranged at the corresponding rolling trajectory, and is used to flush the cartridge cases in the rolling trajectory; the visual sensor detects the cartridge case information in the corresponding rolling trajectory in real time, and sends the cartridge case information to the control module, and when there is a cartridge case in the rolling trajectory, the corresponding water spray head group is started to flush the cartridge case in the rolling trajectory.
2. The multifunctional recycling robot based on multi-sensor information fusion as claimed in claim 1, characterized in that: The picking mechanism comprises at least one execution unit, the execution unit comprises a mechanical arm, a magnetic unit and a picking weight sensor, one end of the mechanical arm is connected to the robot body, and the other end is connected to the magnetic unit; The robot body is provided with a cavity for accommodating the execution unit. When picking up a cartridge case, the mechanical arm extends out of the cavity to drive the magnetic unit to pick up the cartridge case. After the picking is completed, the mechanical arm retracts into the cavity. The picking weight sensor is arranged on the magnetic unit, and is used for detecting the picking weight of the shell picked up by the magnetic unit in real time and sending the picking weight of the shell to the control module. When the picking weight of the shell is greater than the preset picking weight, the robotic arm transfers the shell picked up by the magnetic unit to the cleaning device.
3. The multifunctional recycling robot based on multi-sensor information fusion as claimed in claim 1, characterized in that: A storage entrance is provided on the box body, and a blower for drying the cartridge cases is provided at the storage entrance.
4. The multifunctional recycling robot based on multi-sensor information fusion as claimed in claim 3, characterized in that: The box body is also provided with a storage weight sensor; The storage weight sensor detects the storage weight of the cartridge cases in the box in real time and sends the storage weight of the cartridge cases to the control module, and the control module calculates the number of cartridge cases in the box according to the storage weight of the cartridge cases.
5. The multifunctional recycling robot based on multi-sensor information fusion as claimed in claim 1, characterized in that: It also includes a communication module connected to the control module, and signal transmission is performed between the control module and an external terminal device through the communication module.
6. The multifunctional recycling robot based on multi-sensor information fusion as claimed in claim 1, characterized in that: It also includes an identification module connected to the control module, wherein the identification module is provided with identification powder; The control module drives the marking module to release the marking powder synchronously with the movement of the walking mechanism.
7. A control method for the multifunctional recycling robot according to any one of claims 1 to 6, characterized in that: include: The control module initializes the working state of the multifunctional recycling robot; The control module starts the multifunctional recycling robot, wherein: The control module acquires the position of the cartridge case collected by the visual recognition module, and sends the position of the cartridge case to the navigation module, so that the navigation module plans a navigation path according to the position of the cartridge case; The control module acquires the navigation path sent by the navigation module, and drives the walking mechanism to move to the shell position according to the navigation path; The control module drives the picking mechanism to pick up the shell; The control module obtains the cartridge case picking weight collected by the picking mechanism, drives the picking mechanism to transfer the picked cartridge case to the cleaning device according to the cartridge case picking weight, and drives the cleaning device to clean the picked cartridge case.
8. The control method of the multifunctional recycling robot according to claim 7, characterized in that: The step of the control module starting the multifunctional recycling robot further includes: The control module obtains the storage weight of the cartridge cases collected by the box, and calculates the number of cartridge cases in the box according to the storage weight of the cartridge cases; The control module obtains water level information of the cleaning device and adjusts the water level state in the cleaning device according to the water level information; The control module obtains the power information of the power module and adjusts the power supply mode of the power module according to the power information; The control module obtains the identification information collected by the visual recognition module, and sends the identification information to the navigation module, so that the navigation module plans a navigation path according to the shell position and the identification information.
Citation Information
Patent Citations
Ball picking-up robot
CN107932526A
Intelligent cartridge case clearing robot for indoor shooting range
CN109955265A
Collection device capable of achieving cleaning of cartridge case
CN111473693A
Cartridge case collecting device
CN214892890U
Rubbish picking and classifying robot with steering engines independently suspended
CN220561541U
