Stope rescue robot and detection troubleshooting method
By using lift protection devices and multiple groups of sensing devices in mining rescue robots, three-dimensional environmental perception and action path planning are realized, and the problem that robots in the prior art is difficult to accurately identify the tunnel environment, improving the problem that robots in the prior art are difficult to accurately identify the tunnel environment. Rescue efficiency and safety.
Patent Information
- Application Number
- CN202410945045.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-15
- Publication Date
- 2024-11-29
AI Technical Summary
Existing mining rescue robots are difficult to achieve three-dimensional environmental perception, which leads to the robots being prone to collision with walls or collapsed rock layers when working in the tunnel, affecting rescue efficiency and safety.
A mining field rescue robot was designed, using lift protection device and multiple groups of sensing devices (obstacle avoidance sensors, cameras, laser ranging sensors) combined with contact anti-collision mechanisms and strain gauge sensors to build a three-dimensional spatial environment model, and through lifting and lowering perception The system and posture adjustment device realize the robot's precise identification of the environment and the planning of the action path.
It effectively avoids collision between the robot and the inner wall or obstacles of the tunnel, improves the operation safety and accuracy of the rescue robot in complex environments, and ensures the normal operation and safety of the robot.
Smart Images

Figure CN119036403A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of mining rescue equipment, and in particular to a mine rescue robot and a detection and troubleshooting method. Background Art
[0002] At present, underground mining basically uses tunnels as passages between different mining areas. When these tunnels are opened, they basically need to be reinforced with different strengths according to the strength of the rock formation. However, due to the variability of underground rock formations, especially the high instability of rock formations in the mining area, newly opened tunnels are not reinforced in time or even after reinforcement, they are prone to collapse to varying degrees due to geological movements, which can easily cause safety accidents. After a tunnel collapse accident occurs, due to the instability of the rock formation and the instability of the tunnel, in order to avoid another safety accident, rescue workers generally use rescue robots to enter the rescue area for rescue.
[0003] For example, patent CN112276901A-A large-load emergency rescue robot for complex environments, this patent has search and rescue functions, strong emergency rescue capabilities, multiple functions, large load, high communication capabilities and high intelligent functions. However, in this technical solution, the perception of the entire rescue robot only relies on the camera installed on the power chassis to identify the environment in the forward direction, and fails to realize the three-dimensional environmental perception and recognition of the robot's position in an overall and all-round manner. This easily causes the mechanical arm on the power chassis to collide with the inner wall of the tunnel during work, or there is not enough room for movement, which is not conducive to the staff to remotely control the mechanical arm movement to achieve rescue. In response to such a situation, CN107891423A-An intelligent exploration robot based on multi-sensor fusion detection and its detection method, this patent uses a variety of different types of sensors, and uses a multi-core function support vector machine fusion algorithm to optimize the robot's travel path, so that the robot can achieve no-dead-angle detection in a complex and variable working environment. However, this patent still only relies on multiple different types of sensors on both sides of the support to achieve low-altitude spatial detection. Due to the use of long-distance non-contact detection, there is a certain magnetic field inside the rock layer. These magnetic fields are easy to interfere with the above-mentioned sensors, resulting in inaccurate measurement data. It is still unable to effectively solve the problem of accurate perception and identification of three-dimensional environment. In the later stage of troubleshooting, the manipulator is prone to motion interference with the inner wall of the tunnel or collapsed rock layer, which seriously hinders the normal operation and safety of the manipulator. Summary of the invention
[0004] In order to overcome one of the deficiencies of the prior art, an object of the present invention is to provide a mine rescue robot and a detection and troubleshooting method. The mine rescue robot can realize three-dimensional environment perception and recognition, which is conducive to remote control operation by staff.
[0005] To solve the above problems, the technical solution adopted by the present invention is as follows:
[0006] A mine rescue robot comprises a walking chassis, a tool library, a manipulator system, a lifting and sensing system and a control device, wherein the walking chassis can walk and turn; the tool library is arranged on the walking chassis; the manipulator system is installed on the walking chassis, and the manipulator system can take and put different tools from the tool library; the lifting and sensing system comprises a lifting protection device and a sensing device, wherein the lifting protection device is installed on the walking chassis, and the sensing device is installed on the top of the lifting protection device, and the sensing device is used to detect the surrounding space environment parameters of the walking chassis, and the lifting protection device can be lifted and lowered to drive the sensing device to lift and lower synchronously; the control device is installed on the walking chassis, and the control device is used to receive instructions from a control terminal and control the movement of the walking chassis, the manipulator system and the lifting and protecting device.
[0007] Furthermore, the lifting protection device includes a lifting electric cylinder, a shock-absorbing seat and a contact anti-collision mechanism, the lifting electric cylinder is installed on a walking chassis, the shock-absorbing seat is installed on the lifting electric cylinder, the contact anti-collision mechanism is installed on the shock-absorbing seat, the sensing device is installed on the shock-absorbing seat, the shock-absorbing seat can be compressed along the extension and contraction direction of the lifting electric cylinder, the contact anti-collision mechanism can be deformed, the lifting electric cylinder and the contact anti-collision mechanism are both electrically connected to a control device, and the control device can control the extension and contraction amount of the lifting electric cylinder according to the deformation amount of the contact anti-collision mechanism.
[0008] Furthermore, the contact anti-collision mechanism includes a seat body, a deformation rod, a mounting head and a plurality of elastic rods arranged on the outer periphery of the mounting head, the mounting head is mounted on one end of the deformation rod, the other end of the deformation rod is connected to the seat body, and the seat body is mounted on a shock-absorbing seat, and all of the elastic rods are provided with an elastic part at one end close to the mounting head, and the other end of the elastic rod can perform spatial deformation around the elastic part; the deformation rod and the elastic part can both be reset, the height of the deformation rod is higher than the top of the sensing device, and a plurality of strain gauge sensors are provided on the deformation rod, all of the strain gauge sensors are electrically connected to the control device, and the control device can control the extension and retraction amount of the lifting electric cylinder according to the detection result of any of the strain gauge sensors.
[0009] Furthermore, the outward ends of all the elastic rods are arranged to be inclined downward.
[0010] Furthermore, the projection of the outer periphery of the mounting head on the horizontal plane can completely cover the sensing device.
[0011] Furthermore, the shock absorbing seat includes an upper plate and a lower plate, the upper plate is provided with a plurality of guide columns, all of the guide columns are movably inserted on the lower plate, all of the guide columns are movably fitted with shock absorbing springs, the two ends of the shock absorbing springs are respectively abutted against the upper plate and the lower plate, the lower plate is installed on the telescopic end of the lifting electric cylinder, and the sensing device and the contact-type anti-collision mechanism are both installed on the upper plate.
[0012] Furthermore, at least three groups of the sensing devices are provided, and all of the sensing devices are installed in a ring shape on the lifting end of the lifting protection device; each group of the sensing devices includes an obstacle avoidance sensor, a camera and a laser ranging sensor, and the obstacle avoidance sensor, camera and laser ranging sensor are all electrically connected to the control device, and the obstacle avoidance sensor is used to detect obstacles on the corresponding side of the walking chassis; the camera is used to collect image information in front of the corresponding side of the walking chassis.
[0013] Furthermore, the lifting sensing system also includes a gyroscope and a posture adjustment device, both of which are installed on the walking chassis, and the lifting protection device is arranged on the adjustment end of the posture adjustment device. The gyroscope and the posture adjustment device are both electrically connected to the control device, and the control device can control the action of the posture adjustment device according to the measurement data of the gyroscope.
[0014] Furthermore, the posture adjustment device includes a base rotatably mounted on the walking chassis, a mounting seat hinged to the base on one side, and an adjusting electric cylinder for driving the mounting seat and the chassis to open and close, the lifting protection device is mounted on the mounting seat, and a rotating motor for driving the base to rotate is provided on the walking chassis, and the rotating motor and the adjusting electric cylinder are both electrically connected to the control device.
[0015] A method for detecting and troubleshooting obstacles by a mine rescue robot comprises the following steps:
[0016] Step S100, adjust the robot's forward direction, set the forward starting point, and observe the environment in the forward direction;
[0017] Step S200: The control device controls the lifting electric cylinder to drive the sensing device to rise until the extension amount of the lifting electric cylinder reaches a preset amount, and the control device controls the walking chassis to move forward;
[0018] Step S300: All obstacle avoidance sensors, cameras and laser ranging sensors collect environmental data according to preset requirements and transmit the collected data to the control device;
[0019] Step S400: the control device performs algorithm fusion processing according to the received data to construct a three-dimensional space environment model. The control device calculates the optimal forward path according to the three-dimensional space environment model and controls the walking chassis to move forward along the optimal path. During the forward movement, the control device corrects the three-dimensional space environment model according to the data collected in the same period of time, and modifies the optimal path at the same time.
[0020] Step S500, when an unavoidable obstacle appears in front of the optimal path, the control device controls the walking chassis to stop moving forward and plans the primary motion path of the manipulator system according to the environmental three-dimensional space data of the three-dimensional space environment model; the lifting electric cylinder is raised until any strain gauge sensor of the deformation rod is triggered, and the control device controls the walking chassis to perform a tentative movement along either side of the forward direction; the control device controls the posture adjustment device to drive the lifting electric cylinder to tilt along the forward direction, and at the same time controls the lifting electric cylinder to reciprocate and extend and retract until all strain gauge sensors are not triggered, and the control device corrects the three-dimensional space environment model according to the extension amount of the lifting electric cylinder when the last strain gauge sensor changes from the triggered state to the untriggered state and the inclination data of the walking chassis collected by the gyroscope; after completing the detection of one side of the forward direction of the walking chassis, repeat the above-mentioned measurement operation to detect the other side of the forward direction of the walking chassis, and correct the three-dimensional space environment model;
[0021] Step S600: After both sides of the traveling chassis are inspected, the control device controls the lifting electric cylinder and the posture adjustment device to reset; the control device controls the manipulator system to replace the corresponding tools from the tool box and carry or remove obstacles in the traveling direction according to the latest revised three-dimensional space environment model until the obstacles that cannot be avoided are completely removed;
[0022] Step S700: The control device controls the walking chassis to move forward until an unavoidable obstacle is encountered on the optimal route, and steps S500 to S600 are repeated until the robot reaches a preset target area or is controlled to stop by the control terminal.
[0023] Compared with the prior art, the present invention has the following beneficial effects:
[0024] A mine rescue robot and a detection and troubleshooting method of the present invention are designed with a lifting protection device on the basis of an existing rescue robot, and the lifting protection device is used to adjust the height of the sensing device relative to the walking chassis, which is beneficial for the sensing device to perform three-dimensional spatial recognition of the robot's environment from above the walking chassis, and is beneficial for the control device to simulate a three-dimensional spatial model of the area where the robot is located, which greatly facilitates the subsequent operations of the staff. The setting of the lifting protection device can effectively protect the sensing device under normal circumstances, and can also serve as a height measuring tool for the entire robot, so that it can quickly determine whether the height of the area where the robot is located meets the motion space requirements of the manipulator system, and can protect the manipulator system to a certain extent. In addition, the design of the tool library is beneficial for the staff to select different tools according to different working conditions, thereby improving the convenience of rescue.
[0025] The present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. BRIEF DESCRIPTION OF THE DRAWINGS
[0026] Figure 1 is a schematic diagram of the structure in the storage state of an embodiment of the present invention;
[0027] Figure 2 is a schematic diagram of the structure in an expanded state in an embodiment of the present invention;
[0028] Figure 3 is a schematic structural diagram of a lifting protection device in an embodiment of the present invention;
[0029] Figure 4 is a control principle diagram in an embodiment of the present invention;
[0030] Figure 5 is a schematic diagram of the structure in an unfolded state in another embodiment of the present invention;
[0031] Figure 6 It is a structural schematic diagram of a posture adjustment device in an embodiment of the present invention.
[0032] Description of Figure Numbers:
[0033] Walking chassis 100, searchlight 110, tool library 200, manipulator system 300, lifting protection device 400, lifting electric cylinder 410, shock-absorbing seat 420, upper plate 421, lower plate 422, guide column 423, shock-absorbing spring 424, contact anti-collision mechanism 430, seat body 431, deformation rod 432, mounting head 433, elastic rod 434, elastic part 435, strain gauge sensor 436, sensing device 500, obstacle avoidance sensor 510, camera 520, laser ranging sensor 530, control device 600, posture adjustment device 700, base 710, mounting seat 720, adjustment electric cylinder 730, rotating motor 740, gyroscope 800 DETAILED DESCRIPTION
[0034] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention 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 invention and are not used to limit the present invention.
[0035] See also Figures 1 to 6 The present application provides a mine rescue robot, comprising a walking chassis 100, a tool library 200, a manipulator system 300, a lifting and sensing system and a control device 600, wherein the walking chassis 100 is capable of walking and turning; the tool library 200 is arranged on the walking chassis 100; the manipulator system 300 is installed on the walking chassis 100, and the manipulator system 300 is capable of taking and placing different tools from the tool library 200; the lifting and sensing system comprises a lifting protection device 400 and a sensing device 500, and the lifting protection device 40 0 is installed on the walking chassis 100, the sensing device 500 is installed on the top of the lifting protection device 400, the sensing device 500 is used to detect the surrounding space environment parameters of the walking chassis 100, and the lifting protection device 400 can be lifted and lowered to drive the sensing device 500 to be lifted and lowered synchronously; the control device 600 is installed on the walking chassis 100, and the control device 600 is used to receive the command of the control terminal to control the movement of the walking chassis 100, the manipulator system 300 and the lifting protection device 400.
[0036] Among them, the walking chassis 100 can be a conventional multi-wheeled vehicle chassis, such as the structural design in CN 215922395 U-a kind of Ackerman chassis; it can also be a conventional crawler-type structural design, such as CN 216986153U-a kind of rescue robot; therefore, this application does not describe this technology in detail here. The walking chassis 100 of this application is preferably a crawler-type structural design, the main purpose of which is to increase the force-bearing area, and at the same time it is conducive to achieving the working requirements of turning around or steering. It should be particularly noted that in this application, a protective shell is also provided on the walking chassis 100, the main purpose of which is to protect electronic components and improve the protection.
[0037] In addition, in the present application, the tool library 200 is similar to the tool library in machining, which includes tools such as drill bits, clamps, detection rods, impact crushing heads, etc. Its main purpose is to cooperate with the manipulator system 300 to clear obstacles in the forward direction. It should be noted that in the collapsed tunnel, the obstacles are generally stones. The manipulator system 300 in the present application is mainly to adapt to the removal of obstacles at different positions, and a multi-axis flexible manipulator can be used, so that demolition work at different angles and positions can be achieved.
[0038] See also Figures 1 to 4 In order to adapt to the lifting requirements of different heights and to facilitate the sensing device 500 to realize the construction of a three-dimensional space environment model in different usage environments, in one embodiment of the present application, the lifting protection device 400 includes a lifting electric cylinder 410, a shock absorbing seat 420 and a contact anti-collision mechanism 430, the lifting electric cylinder 410 is installed on the walking chassis 100, the shock absorbing seat 420 is installed on the lifting electric cylinder 410, the contact anti-collision mechanism 430 is installed on the shock absorbing seat 420, the sensing device 500 is installed on the shock absorbing seat 420, the shock absorbing seat 420 can be compressed along the extension direction of the lifting electric cylinder 410, the contact anti-collision mechanism 430 can be deformed, the lifting electric cylinder 410 and the contact anti-collision mechanism 430 are both electrically connected to the control device 600, and the control device 600 can control the extension amount of the lifting electric cylinder 410 according to the deformation amount of the contact anti-collision mechanism 430. Among them, the main purpose of the contact-type anti-collision mechanism 430 is to achieve hard contact with the inner wall of the tunnel, which is conducive to measuring the real internal data of the tunnel. Although the sensing device 500 can add a sensor to measure its distance from the top of the tunnel in the actual process, when walking in the collapsed area, the unstable top of the tunnel is prone to falling rock debris. Therefore, the contact-type anti-collision mechanism 430 can effectively protect the sensing device 500, and can also prevent the problem of partial rock stratum shedding and damaging the sensing device 500 due to contact with the inner wall of the tunnel during the measurement process. At the same time, the contact-type measurement method is used to construct a real three-dimensional space environment model, which is conducive to the control device 600 to control the manipulator system 300 to move according to the constructed three-dimensional space environment model, and avoid the manipulator system 300 from being damaged by motion interference with obstacles or the inner wall of the tunnel during the operation in the tunnel of the collapsed area. It should be noted that in the above-mentioned embodiment, the contact anti-collision mechanism 430 is a structure similar to a protective cover, and it also has a measuring function, on which some measuring sensors are installed to measure the deformation of the contact anti-collision mechanism 430 itself to determine whether it is in contact with the inner wall of the lane or an obstacle. Compared with the traditional measurement method of directly contacting the inner wall of the lane or an obstacle through a contact sensor, the contact sensor is protected to the greatest extent possible and the loss of the contact sensor is reduced.
[0039] See also Figure 3 to Figure 4In one embodiment of the present application, the contact anti-collision mechanism 430 includes a seat body 431, a deformation rod 432, a mounting head 433, and a plurality of elastic rods 434 arranged on the periphery of the mounting head 433, wherein the mounting head 433 is mounted on one end of the deformation rod 432, and the other end of the deformation rod 432 is connected to the seat body 431, and the seat body 431 is mounted on the shock absorbing seat 420, and all the elastic rods 434 are provided with an elastic portion 435 at one end close to the mounting head 433, and the elastic portion 435 is provided at one end of the elastic rod 434. The other end of the deformable rod 434 can be spatially deformed around the elastic part 435; the deformable rod 432 and the elastic part 435 can both be reset, the height of the deformable rod 432 is higher than the top of the sensing device 500, and a plurality of strain gauge sensors 436 are arranged on the deformable rod 432, all of which are electrically connected to the control device 600, and the control device 600 can control the extension and retraction amount of the lifting cylinder 410 according to the detection result of any strain gauge sensor 436.
[0040] In this embodiment, the main purpose of the elastic rod 434 is to play a protective role to a certain extent, especially to avoid the robot from colliding with the inner wall of the tunnel during its forward walking process. At the same time, even if the elastic rod 434 contacts the inner wall of the tunnel during the walking process, the design of its elastic part 435 prevents it from having a hard contact with the inner wall of the tunnel, and plays a buffering role to a certain extent. It should be noted that the deflection of the elastic part 435 is much smaller than the deflection of the deformation rod 432. The main purpose of such a design is to avoid the bending of the elastic part 435 causing the deformation of the deformation rod 432, which is easy to cause misjudgment. The top of the mounting head 433 is a pointed roof structure, which is mainly for the convenience of later measurement. It should be noted that a rotating wheel is provided on the pointed roof structure, wherein the pointed roof structure can rotate by itself. Such a structural design is mainly to avoid the pointed roof structure from colliding with the inside of the top of the tunnel and then being inserted into the rock mass and unable to move.
[0041] Furthermore, in an improved embodiment, in order to facilitate the contact between the pointed top structure and the rock formation and to prevent the outward end of the elastic rod 434 from excessively colliding with the rock formation, the outward ends of all the elastic rods 434 are arranged to be inclined downward.
[0042] Furthermore, in the above-mentioned embodiment, in order to protect the sensing device 500 and prevent the rock layer on the inner wall of the tunnel from falling off during the advancement, the projection of the outer periphery of the mounting head 433 on the horizontal plane can completely cover the sensing device 500.
[0043] See also Figure 3 and Figure 4In the above-mentioned embodiment, since the pointed roof structure actively contacts the rock layer at the top of the tunnel, there is a secondary collapse or surface rock layer falling off in the collapsed area. In order to achieve active shock absorption and protect the sensing device 500, and avoid the impact of larger rock layers on the entire lifting protection device 400, in one embodiment of the present application, the shock absorbing seat 420 includes an upper plate 421 and a lower plate 422, and a plurality of guide columns 423 are arranged on the upper plate 421, and all of the guide columns 423 are movably inserted on the lower plate 422, and all of the guide columns 423 are movably mounted with shock absorbing springs 424, and the two ends of the shock absorbing springs 424 are respectively abutted against the upper plate 421 and the lower plate 422, and the lower plate 422 is installed on the telescopic end of the lifting electric cylinder 410, and the sensing device 500 and the contact anti-collision mechanism 430 are both installed on the upper plate 421. It should be noted that the elasticity of the shock absorbing spring 424 is much greater than the deformation capacity of the deformation rod 432. The main purpose of this is to prevent the deformation rod 432 from transmitting the force of contact with the rock formation to the upper plate 421, and the force is insufficient to cause all the shock absorbing springs 424 to deform and compress. In fact, in the normal contact measurement process, the pointed top structure is slightly in contact with the inner wall of the rock formation, and the shock absorbing seat 420 can be regarded as a rigid structure. Only when it is hit by a large rock block, when the deformation of the deformation rod 432 is not enough to achieve buffering, the shock absorbing seat 420 can be regarded as a flexible structure.
[0044] See also Figures 2 to 4In order to realize the full-space perception of the robot and enhance the accuracy of the detected data, the sensing device 500 is provided with at least three groups, preferably four groups in this application, respectively in the front, back, left, and right directions of the robot, and all the sensing devices 500 are installed in a ring shape on the lifting end of the lifting protection device 400; each group of the sensing device 500 includes an obstacle avoidance sensor 510, a camera 520 and a laser ranging sensor 530, and the obstacle avoidance sensor 510, the camera 520 and the laser ranging sensor 530 are all electrically connected to the control device 600, and the obstacle avoidance sensor 510 is used to detect obstacles on the corresponding side of the walking chassis 100; the camera 520 is used to collect image information in front of the corresponding side of the walking chassis 100. In fact, in the collapsed lane, due to the complex environment, the collapsed stones easily block the accuracy of the actual measurement data of the obstacle avoidance sensor 510, the camera 520 and the laser ranging sensor 530. Moreover, because the drainage equipment or drainage structure in the tunnel has failed, the internal humidity is high, or there is continuous dripping or even gushing of water. Therefore, in actual measurements, the measurement accuracy of the obstacle avoidance sensor 510, the camera 520 and the laser ranging sensor 530 is not high, which seriously leads to the three-dimensional space environment model constructed by the control device 600 not being completely consistent with the situation in the tunnel collapse area. This will cause the control device 600 to control the manipulator system 300 to clear obstacles, which may easily cause motion interference with obstacles or the inner wall of the tunnel, seriously affecting normal rescue operations. Therefore, the present application also needs to perform secondary contact measurements through the contact anti-collision mechanism 430 in the later stage to correct the three-dimensional space environment model.
[0045] In the above embodiment, in order to improve the shooting quality of the camera 520 and facilitate the staff to view the specific situation in the forward direction of the robot through the control terminal, a number of searchlights 110 are arranged on the surrounding sides of the lifting protection device 400 and the walking chassis 100, and the walking chassis 100 also drags electric wires or network cables.
[0046] See also Figures 4 to 6If some dangerous areas are encountered during the normal process of clearing collapsed rock formations, after the above-mentioned sensing device 500 performs detection, the staff still cannot confirm whether the area allows the robot to continue to move forward after confirming through the background control terminal. At this time, the lifting sensing system needs to move forward for spatial confirmation, which is conducive to correcting the three-dimensional space environment model constructed by the control device 600, which can be conducive to protecting the entire robot. In one embodiment of the present application, the lifting sensing system also includes a gyroscope 800 and a posture adjustment device 700, and the gyroscope 800 and the posture adjustment device 700 are both installed on the walking chassis 100, and the lifting protection device 400 is arranged on the adjustment end of the posture adjustment device 700, and the gyroscope 800 and the posture adjustment device 700 are both electrically connected to the control device 600, and the control device 600 can control the action of the posture adjustment device 700 according to the measurement data of the gyroscope 800. Among them, the main purpose of the posture adjustment device 700 is to adjust the inclination angle of the lifting protection device 400, which is conducive to the contact between the top of the pointed structure and the inner wall of the tunnel or the outer wall of the obstacle, and to assist in correcting the three-dimensional space environment model constructed by the detection data of the sensing device 500, so as to improve the accuracy of the entire three-dimensional space environment model, and to facilitate the control device 600 to control the action path of the manipulator system 300. The main purpose of the gyroscope 800 is to detect the inclination angle between the walking chassis 100 itself and the ground, because the control device 600 corrects the data detected by the lifting protection device 400.
[0047] See also Figure 5 and Figure 6 In the above-mentioned embodiment, in order to achieve tilting in various directions, in an improved embodiment of the present application, the posture adjustment device 700 includes a base 710 rotatably mounted on the walking chassis 100, a mounting seat 720 hinged to the base 710 on one side, and an adjusting electric cylinder 730 for driving the mounting seat 720 to open and close with the chassis, the lifting protection device 400 is mounted on the mounting seat 720, and the walking chassis 100 is provided with a rotating motor 740 for driving the base 710 to rotate, and the rotating motor 740 and the adjusting electric cylinder 730 are both electrically connected to the control device 600. When it is necessary to adjust the tilting direction of the lifting protection device 400, it is only necessary to control the rotation angle of the rotating motor 740, and in order to improve the control effect of the rotating motor 740, the rotating motor 740 adopts a servo motor. When it is necessary to adjust the tilting angle of the lifting protection device 400, it is only necessary to control the extension length of the adjusting electric cylinder 730.
[0048] See also Figures 1 to 6 The present invention also provides a method for detecting and troubleshooting obstacles using a mine rescue robot, comprising the following steps:
[0049] Step S100, adjust the robot's forward direction, set the forward starting point, and observe the environment in the forward direction;
[0050] Step S200, the control device 600 controls the lifting electric cylinder 410 to drive the sensing device 500 to rise, until the extension amount of the lifting electric cylinder 410 reaches a preset amount, and the control device 600 controls the walking chassis to move forward;
[0051] Step S300, all obstacle avoidance sensors 510, cameras 520 and laser ranging sensors 530 collect environmental data according to preset requirements, and transmit the collected data to the control device 600;
[0052] Step S400: The control device 600 performs algorithm fusion processing according to the received data to construct a three-dimensional space environment model. The control device 600 calculates the optimal forward path according to the three-dimensional space environment model and controls the walking chassis to move forward along the optimal path. During the forward process, the control device 600 corrects the three-dimensional space environment model according to the data collected in the same period of time, and modifies the optimal path at the same time.
[0053] Step S500: When an unavoidable obstacle appears in front of the optimal path, the control device 600 controls the walking chassis to stop moving forward and plans the primary motion path of the manipulator system 300 according to the three-dimensional space data of the three-dimensional space environment model; the lifting cylinder 410 is raised until any strain gauge sensor 436 of the deformation rod 432 is triggered, and the control device 600 controls the walking chassis to perform a tentative movement along either side of the forward direction; the control device 600 controls the posture adjustment device 700 to drive the lifting cylinder 410 to tilt along the forward direction, and at the same time, the control device 600 controls the lifting electric cylinder 410 to reciprocate and extend and retract until all the strain gauge sensors 436 are not triggered. The control device 600 corrects the three-dimensional space environment model according to the extension amount of the lifting electric cylinder 410 when the last strain gauge sensor 436 changes from the triggered state to the untriggered state and the inclination data of the walking chassis 100 collected by the gyroscope 800; after completing the detection of one side of the forward direction of the walking chassis 100, repeat the above-mentioned measurement operation to detect the other side of the forward direction of the walking chassis, and correct the three-dimensional space environment model;
[0054] Step S600: After both sides of the forward direction of the walking chassis 100 are detected, the control device 600 controls the lifting cylinder 410 and the posture adjustment device 700 to reset; the control device 600 controls the manipulator system 300 to replace the corresponding tools from the tool box 200 and to carry or remove obstacles in the forward direction according to the latest revised three-dimensional space environment model until the obstacles that cannot be avoided are completely removed;
[0055] In step S700, the control device 600 controls the walking chassis 100 to move forward until an obstacle that cannot be avoided is encountered on the optimal route, and steps S500 to S600 are repeated until the robot reaches a preset target area or is controlled to stop by the control terminal.
[0056] In the above-mentioned embodiment, the environmental conditions in the direction of advance are observed manually by the staff in step S100, and its main purpose is to facilitate the preliminary confirmation of the direction of advance. The main purpose of setting the starting point for advance is to facilitate the staff to measure the distance from the collapse area to the starting point later, and provide data support for the later manual rescue access. In step S200, the extension amount of the lifting cylinder 410 is actually the estimated amount estimated by the staff themselves according to the specific conditions of the lane; in step S400, the algorithm fusion processing is a conventional technical means, which is not described in detail in this application. Patent CN113077159B-Data processing method and data processing device can be used; or the technical solution in patent CN115980741A-Multi-data source three-dimensional data fusion algorithm. Of course, the processing method adopted in this application can be simply described as follows: first, the received data is classified and processed; then, the multi-information fusion algorithm of the multi-kernel function support vector machine is adopted, mainly using linear kernel function, polynomial kernel function and radial basis kernel function method to perform support vector machine analysis on the sound, force and light signals in the operation process of the robot, obtain the global optimal solution, obtain the optimal kernel function, and send it to the fusion rule center to obtain the fusion rule set; according to the fusion rule set, the expected risk value is obtained, if the expected risk value is the minimum expected risk value, then proceed to the next step; if not, return to the first step; finally, n groups of judgment rules are obtained by solving the minimum expected risk function, that is, the output feature set, and the multi-information fusion processing is completed to select the optimal path; this statement only shows a feasible path, and the functions and expected values involved are all specific embodiments, and whether they are disclosed does not affect the results of the algorithm fusion processing in this application, so this application will not be described in detail here.
[0057] The above-mentioned embodiments are only preferred embodiments of the present invention and cannot be used to limit the scope of protection of the present invention. Any non-substantial changes and substitutions made by technicians in this field on the basis of the present invention shall fall within the scope of protection required by the present invention.
Claims
1. A mine rescue robot, characterized in that: include; A walking chassis capable of walking and turning; A tool library, which is arranged on the walking chassis; A manipulator system, which is mounted on the walking chassis, and the manipulator system can take and place different tools from the tool library; A lifting sensing system, comprising a lifting protection device and a sensing device, wherein the lifting protection device is mounted on the walking chassis, the sensing device is mounted on the top of the lifting protection device, the sensing device is used to detect the surrounding space environment parameters of the walking chassis, and the lifting protection device can be raised and lowered to drive the sensing device to rise and fall synchronously; The control device is installed on the walking chassis, and is used to receive instructions from the control terminal to control the movement of the walking chassis, the manipulator system and the lifting protection device.
2. A mine rescue robot according to claim 1, characterized in that: The lifting protection device includes a lifting electric cylinder, a shock-absorbing seat and a contact anti-collision mechanism. The lifting electric cylinder is installed on a walking chassis, the shock-absorbing seat is installed on the lifting electric cylinder, the contact anti-collision mechanism is installed on the shock-absorbing seat, and the sensing device is installed on the shock-absorbing seat. The shock-absorbing seat can be compressed along the extension and contraction direction of the lifting electric cylinder, and the contact anti-collision mechanism can be deformed. The lifting electric cylinder and the contact anti-collision mechanism are both electrically connected to a control device, and the control device can control the extension and contraction amount of the lifting electric cylinder according to the deformation amount of the contact anti-collision mechanism.
3. A mine rescue robot according to claim 2, characterized in that: The contact anti-collision mechanism includes a seat body, a deformation rod, a mounting head and a plurality of elastic rods arranged on the outer periphery of the mounting head, the mounting head is installed on one end of the deformation rod, the other end of the deformation rod is connected to the seat body, and the seat body is installed on a shock-absorbing seat, all of the elastic rods are provided with an elastic part at one end close to the mounting head, and the other end of the elastic rod can perform spatial deformation around the elastic part; the deformation rod and the elastic part can both be reset, the height of the deformation rod is higher than the top of the sensing device, and a plurality of strain gauge sensors are provided on the deformation rod, all of the strain gauge sensors are electrically connected to the control device, and the control device can control the extension and retraction amount of the lifting cylinder according to the detection result of any of the strain gauge sensors.
4. A mine rescue robot according to claim 3, characterized in that: The outward ends of all the elastic rods are arranged to be inclined downward.
5. A mine rescue robot according to claim 3, characterized in that: The projection of the outer periphery of the mounting head on the horizontal plane can completely cover the sensing device.
6. A mine rescue robot according to claim 2, characterized in that: The shock-absorbing seat includes an upper plate and a lower plate, and a plurality of guide columns are arranged on the upper plate, and all the guide columns are movably inserted on the lower plate, and shock-absorbing springs are movably mounted on all the guide columns, and the two ends of the shock-absorbing springs are respectively abutted against the upper plate and the lower plate, and the lower plate is installed on the telescopic end of the lifting electric cylinder, and the sensing device and the contact anti-collision mechanism are both installed on the upper plate.
7. A mine rescue robot according to claim 1, characterized in that: The sensing devices are provided with at least three groups, all of which are installed in a ring shape on the lifting end of the lifting protection device; each group of the sensing devices includes an obstacle avoidance sensor, a camera and a laser ranging sensor, and the obstacle avoidance sensor, the camera and the laser ranging sensor are all electrically connected to the control device, and the obstacle avoidance sensor is used to detect obstacles on the corresponding side of the walking chassis; The camera is used to collect image information in front of a corresponding side of the walking chassis.
8. A mine rescue robot according to any one of claims 1 to 7, characterized in that: The lifting sensing system also includes a gyroscope and a posture adjustment device, both of which are installed on the walking chassis, and the lifting protection device is arranged on the adjustment end of the posture adjustment device. The gyroscope and the posture adjustment device are both electrically connected to the control device, and the control device can control the action of the posture adjustment device according to the measurement data of the gyroscope.
9. A mine rescue robot according to claim 8, characterized in that: The posture adjustment device includes a base rotatably mounted on the walking chassis, a mounting seat hinged to the base on one side, and an adjusting electric cylinder for driving the mounting seat and the chassis to open and close. The lifting protection device is mounted on the mounting seat. A rotating motor for driving the base to rotate is provided on the walking chassis. The rotating motor and the adjusting electric cylinder are both electrically connected to the control device.
10. A method for detecting and clearing obstacles using a mine rescue robot, characterized in that: The following steps are involved: Step S100, adjust the robot's forward direction, set the forward starting point, and observe the environment in the forward direction; Step S200: The control device controls the lifting electric cylinder to drive the sensing device to rise until the extension amount of the lifting electric cylinder reaches a preset amount, and the control device controls the walking chassis to move forward; Step S300: All obstacle avoidance sensors, cameras and laser ranging sensors collect environmental data according to preset requirements and transmit the collected data to the control device; Step S400: the control device performs algorithm fusion processing according to the received data to construct a three-dimensional space environment model. The control device calculates the optimal forward path according to the three-dimensional space environment model and controls the walking chassis to move forward along the optimal path. During the forward movement, the control device corrects the three-dimensional spatial environment model based on the data collected in the same period and modifies the optimal path; Step S500, when an unavoidable obstacle appears in front of the optimal path, the control device controls the walking chassis to stop moving forward and plans the primary motion path of the manipulator system according to the environmental three-dimensional space data of the three-dimensional space environment model; the lifting electric cylinder is raised until any strain gauge sensor of the deformation rod is triggered, and the control device controls the walking chassis to perform a tentative movement along either side of the forward direction; the control device controls the posture adjustment device to drive the lifting electric cylinder to tilt along the forward direction, and at the same time controls the lifting electric cylinder to reciprocate and extend and retract until all strain gauge sensors are not triggered, and the control device corrects the three-dimensional space environment model according to the extension amount of the lifting electric cylinder when the last strain gauge sensor changes from the triggered state to the untriggered state and the inclination data of the walking chassis collected by the gyroscope; after completing the detection of one side of the forward direction of the walking chassis, repeat the above-mentioned measurement operation to detect the other side of the forward direction of the walking chassis, and correct the three-dimensional space environment model; Step S600: After both sides of the traveling chassis are inspected, the control device controls the lifting electric cylinder and the posture adjustment device to reset; the control device controls the manipulator system to replace the corresponding tools from the tool box and carry or remove obstacles in the traveling direction according to the latest revised three-dimensional space environment model until the obstacles that cannot be avoided are completely removed; Step S700: The control device controls the walking chassis to move forward until an unavoidable obstacle is encountered on the optimal route, and steps S500 to S600 are repeated until the robot reaches a preset target area or is controlled to stop by the control terminal.
Citation Information
Cited By
Crawler-type intelligent transfer robot capable of self-adapting to damaged environment and control method of crawler-type intelligent transfer robot
CN120483010A
