CN112092929A - Survey car - Google Patents
Survey car Download PDFInfo
- Publication number
- CN112092929A CN112092929A CN202011087238.4A CN202011087238A CN112092929A CN 112092929 A CN112092929 A CN 112092929A CN 202011087238 A CN202011087238 A CN 202011087238A CN 112092929 A CN112092929 A CN 112092929A
- Authority
- CN
- China
- Prior art keywords
- main body
- move
- mechanical legs
- width
- control instruction
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 230000007246 mechanism Effects 0.000 claims abstract description 22
- 238000001514 detection method Methods 0.000 claims abstract description 20
- 230000033001 locomotion Effects 0.000 claims description 19
- 238000000034 method Methods 0.000 claims description 15
- 230000005540 biological transmission Effects 0.000 claims description 12
- 230000004044 response Effects 0.000 claims description 8
- 230000007613 environmental effect Effects 0.000 claims description 7
- 238000004891 communication Methods 0.000 claims description 5
- 238000005286 illumination Methods 0.000 claims description 4
- 230000006870 function Effects 0.000 abstract description 10
- 230000008901 benefit Effects 0.000 abstract description 6
- 238000005265 energy consumption Methods 0.000 abstract description 4
- 210000002414 leg Anatomy 0.000 description 48
- 239000011664 nicotinic acid Substances 0.000 description 4
- 238000012360 testing method Methods 0.000 description 4
- 238000012937 correction Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 230000005021 gait Effects 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000005855 radiation Effects 0.000 description 2
- 238000001931 thermography Methods 0.000 description 2
- 101100400452 Caenorhabditis elegans map-2 gene Proteins 0.000 description 1
- 101150064138 MAP1 gene Proteins 0.000 description 1
- 241000270295 Serpentes Species 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 230000003321 amplification Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- QVFWZNCVPCJQOP-UHFFFAOYSA-N chloralodol Chemical compound CC(O)(C)CC(C)OC(O)C(Cl)(Cl)Cl QVFWZNCVPCJQOP-UHFFFAOYSA-N 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000005034 decoration Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 210000000689 upper leg Anatomy 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D55/00—Endless track vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
- B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
The invention provides a survey vehicle, comprising: the crawler-type driving mechanism comprises a main body, a sensor, a controller, at least two mechanical legs and a crawler-type driving mechanism, wherein the sensor and the controller are arranged on the main body, the sensor is used for detecting, and the controller is used for obtaining a detection result so as to send a first control instruction or a second control instruction; the at least two mechanical legs are connected to the main body and used for receiving a first control command to drive the main body to move; the crawler-type driving mechanism is connected to the main body and used for receiving a second control command to drive the main body to move. Through setting up two at least mechanical legs and crawler-type actuating mechanism simultaneously on the main part, so, survey car moves with different modes under the road conditions environment of difference to it all has great advantage in the aspect of speed, energy consumption still stability to make survey car, and then promotes search and rescue ability and search and rescue efficiency of survey car, makes it realize functions such as ruins, cave search and rescue, ruins surface search and rescue.
Description
Technical Field
The invention relates to the technical field of search and rescue robots, in particular to a survey vehicle.
Background
In recent years, earthquakes occur many times, so that not only property hazards but also personal hazards are brought by the earthquakes, and more importantly, earthquake death people account for 52 percent of the death people caused by natural disasters, so people should pay more attention to the point of rescue after the earthquake.
However, in the current market, this technology is still in its infancy. For example, the most advanced infrared thermal imaging life detector, low-frequency electromagnetic detector, snake eye and other instruments at present all need rescue workers to hold equipment and personally visit a site for detection. Due to the complex terrain environment after the earthquake, the method is not only low in efficiency and difficult to lock the positions of the trapped people in time, but also threatens lives of rescue workers, and in addition, a large amount of manpower and material resources are consumed.
Disclosure of Invention
The invention aims to solve the problems that a search and rescue robot in the prior art is low in efficiency and consumes large manpower and material resources, and provides a survey vehicle.
In order to achieve the above purpose, the invention provides the following technical scheme:
a survey vehicle, the survey vehicle comprising:
a main body;
the sensor and the controller are arranged on the main body, the sensor is used for detecting, and the controller is used for obtaining the detection result to send out a first control instruction or a second control instruction;
the at least two mechanical legs are connected to the main body and used for receiving the first control instruction to drive the main body to move; and
and the crawler-type driving mechanism is connected to the main body and used for receiving the second control instruction to drive the main body to move.
Optionally, the sensor includes a distance sensor, the distance sensor is disposed on the main body and is configured to detect a width of the ground and send the width of the ground to the controller, and the controller receives the width of the ground and selectively uses the at least two mechanical legs or the crawler-type driving mechanism to drive the main body to move according to a correspondence between the width and the first control instruction and the second control instruction.
Optionally, the number of the mechanical legs is six, the six mechanical legs are arranged at the periphery of the main body at intervals, the six mechanical legs are divided into two groups which are alternately arranged and move synchronously, and the controller controls the two groups of the mechanical legs to move alternately when receiving the first control instruction.
Optionally, survey the car including binocular camera, first display and wireless transmission module, binocular camera set up in the main part for gather the environment image, and will the environment image sends to first display, first display is received the environment image shows, wireless transmission module be used for with binocular camera with first display wireless communication connects.
Optionally, the sensor includes an infrared sensor, the survey car includes a second display, the infrared sensor is used for gathering the environment image, and will the environment image sends to the second display, the second display receives the environment image and shows.
Optionally, the reconnaissance car includes unmanned aerial vehicle, camera and third display, the camera set up in on the unmanned aerial vehicle, the camera is used for gathering the environment image, and will the environment image sends to the third display, the third display is received the environment image and is shown.
Optionally, the survey vehicle includes a light and a power source, the light is disposed in the main body, the power source is disposed in the main body for powering the survey vehicle.
In order to achieve the above purpose, the invention provides the following technical scheme:
a movement control method of a survey vehicle, the movement control method comprising:
controlling a sensor to detect the width of the ground;
generating a first control command or a second control command in response to the width of the ground;
responding to the first control instruction, controlling the at least two mechanical legs to move so as to drive the main body to move; or responding to the second control instruction, and controlling the crawler-type driving mechanism to move so as to drive the main body to move.
Optionally, the step of generating a first control instruction or a second control instruction in response to the width of the ground surface comprises:
receiving the width of the ground detected by the sensor;
and selecting and generating the first control instruction or the second control instruction according to the corresponding relation between the width and the first control instruction and the second control instruction.
Optionally, the step of controlling the at least two mechanical legs to move to drive the main body to move includes:
controlling one group of the mechanical legs to support the main body to move forwards and controlling the other group of the mechanical legs to be fixed in place;
controlling the other set of the mechanical legs to support the main body to move forwards and controlling the one set of the mechanical legs to be fixed in place.
Compared with the prior art, the invention has the beneficial effects that:
according to the crawler-type robot, the at least two mechanical legs and the crawler-type driving mechanism are arranged on the main body at the same time, when the sensor detects that the space is narrow, the detection result can be sent to the controller, and the controller sends a first control instruction after receiving the detection result, so that the at least two mechanical legs are driven to drive the main body to move, and therefore the narrow space can be conveniently passed; when the sensor detects that the space is large, the detection result can be sent to the controller, the controller sends a second control instruction after receiving the detection result, and then the crawler-type driving mechanism is driven to drive the main body to move so as to pass through the wide space, therefore, the exploration vehicle moves in different modes under different road conditions, so that the exploration vehicle has great advantages in speed, energy consumption and stability, the search and rescue capacity and the search and rescue efficiency of the exploration vehicle are improved, and the functions of ruins, cave search and rescue, ruins surface search and rescue and the like are achieved.
Drawings
FIG. 1 is a perspective view of a survey vehicle provided herein;
FIG. 2 is a schematic diagram of the motion of the six machine feet of FIG. 1;
FIG. 3 is a control schematic of the survey vehicle of FIG. 1;
FIG. 4 is a schematic flow chart of a method for controlling the movement of a survey vehicle in an embodiment of the present application;
FIG. 5 is a flowchart of step S102 in FIG. 4;
fig. 6 is a flowchart illustrating step S103 in fig. 4.
Detailed Description
The following detailed description of the present invention is given for the purpose of better understanding technical solutions of the present invention by those skilled in the art, and the present description is only exemplary and explanatory and should not be construed as limiting the scope of the present invention in any way.
It should be noted that: like reference numbers and letters refer to like items in the following figures, and thus, once an item is defined in one figure, it need not be further defined and explained in subsequent figures.
It is to be understood that the terms "center," "upper," "lower," "left," "right," "vertical," "horizontal," "inner," "outer," and the like are used in a generic and descriptive sense only and not for purposes of limitation, the terms "center," "upper," "lower," "left," "right," "vertical," "horizontal," "inner," "outer," and the like are used in the generic and descriptive sense only and not for purposes of limitation, as the term is used in the generic and descriptive sense, and not for purposes of limitation, unless otherwise specified or implied, and the specific reference to a device or element is intended to be a reference to a particular element, structure, or component. Furthermore, the terms "first," "second," "third," and the like are used solely to distinguish one from another and are not to be construed as indicating or implying relative importance.
Furthermore, the terms "horizontal", "vertical", "overhang" and the like do not imply that the components are required to be absolutely horizontal or overhang, but may be slightly inclined. For example, "horizontal" merely means that the direction is more horizontal than "vertical" and does not mean that the structure must be perfectly horizontal, but may be slightly inclined.
In the description of the present invention, it should also be noted that, unless otherwise explicitly specified or limited, the terms "disposed," "mounted," "connected," and "connected" are to be construed broadly and may, for example, be fixedly connected, detachably connected, or integrally connected; can be mechanically or electrically connected; they may be connected directly or indirectly through intervening media, or they may be interconnected between two elements. The specific meaning of the above terms in the present invention can be understood in specific cases to those skilled in the art.
The earthquake search and rescue technology in China is in the stage of learning and starting, and the functions, speed and reliability of the rescue robot in China have a great distance from the actual requirements and the actual application for more than ten years.
At present, robots for earthquake rescue mainly comprise crawler robots and bionic robots.
Among them, the tracked robot can change its shape and size according to the size of the search space, but limited by the driving mode, the tracked robot cannot be made small in volume, and is generally used for searching a large space.
The bionic robot is various bionic robots with smaller volumes developed by people according to the ecological principle, and the snake-shaped robot is an important type of the bionic robot and is generally used for searching narrow spaces.
Accordingly, the present invention provides a survey vehicle 100, and referring to fig. 1, fig. 1 is a schematic perspective view of the survey vehicle provided herein. Survey vehicle 100 includes a body 10, sensors (not shown), a controller (not shown), at least two robotic legs 20, and a tracked drive mechanism 30.
The sensor and the controller are both arranged on the main body 10, the sensor is used for detecting, and the controller is used for obtaining a detection result to send out a first control instruction or a second control instruction; at least two mechanical legs 20 are connected to the main body 10, and are used for receiving a first control command to drive the main body 10 to move; the crawler-type driving mechanism 30 is connected to the main body 10 and is configured to receive a second control command to move the main body 10.
Thus, according to the crawler-type driving mechanism, the at least two mechanical legs 20 and the crawler-type driving mechanism 30 are arranged on the main body 10 at the same time, when the sensor detects that the space is narrow, the detection result can be sent to the controller, and the controller sends a first control instruction after receiving the detection result, so that the at least two mechanical legs 20 are driven to drive the main body 10 to move, and the narrow space is convenient to pass; when the sensor detects that the space is large, the detection result can be sent to the controller, the controller sends a second control instruction after receiving the detection result, and then drives the crawler-type driving mechanism 30 to drive the main body 10 to move so as to pass through a wide space, so that the surveying vehicle 100 moves in different modes under different road conditions, so that the surveying vehicle 100 has great advantages in speed, energy consumption and stability, and further search and rescue capacity and search and rescue efficiency of the surveying vehicle 100 are improved, and functions of ruins, cave search and rescue, ruins surface search and rescue and the like are achieved.
The sensor comprises a distance sensor, the distance sensor is arranged on the main body 10 and used for detecting the width of the ground and sending the width of the ground to the controller, and the controller receives the width of the ground and selectively drives the main body 10 to move by using at least two mechanical legs 20 or the crawler-type driving mechanism 30 according to the corresponding relation between the width and the first control instruction and the second control instruction.
It is understood that the detection of the width of the ground by the distance sensor means in particular the detection of the width of the area through which the survey vehicle 100 can pass by the distance sensor. For example, when the ground is wide but the defined passing size between obstacles on the ground is small, the width of the ground detected by the distance sensor refers to the defined passing size between obstacles on the ground. When the traffic size defined between obstacles on the ground is large but there is a collapse on the ground, the width of the ground detected by the distance sensor refers to the width of the ground after the collapse.
Specifically, when the main body 10 drives the distance sensor to move, the distance sensor continuously detects the width of the ground, when the distance sensor detects that the width of the ground is narrow, the detection result can be sent to the controller, the controller sends a first control instruction after receiving the detection result, and then drives the at least two mechanical legs 20 to drive the main body 10 to move, so that the main body 10 can be driven to move through the narrow ground by using the at least two mechanical legs 20, when the width of the ground is wide, the detection result can be sent to the controller, the controller sends a second control instruction after receiving the detection result, and then drives the track type driving mechanism 30 to drive the main body 10 to move through the wide ground, so that the motion stability of the main body 10 can be improved, and the moving speed of the surveying vehicle 100 can be improved, thereby improving the search and rescue efficiency.
As shown in fig. 1, the number of the mechanical legs 20 is six, six mechanical legs 20 are arranged at intervals on the periphery of the main body 10, the six mechanical legs 20 are divided into two groups which are alternately arranged and move synchronously, and the controller controls the two groups of mechanical legs 20 to move alternately when receiving a first control command.
Specifically, the six mechanical legs 20 travel in a "3 + 3" triangular gait, with the three pairs of feet divided into two groups, advancing alternately in a triangular frame configuration. The six mechanical legs 20 adopt an insect-imitating structure, the six mechanical legs 20 are distributed on two sides of the main body 10, the front, rear and right middle feet on the left side of the main body 10 are in one group, the front, rear and left middle feet on the right side of the main body are in the other group, two triangular supports are respectively formed, the supporting and swinging processes are realized by means of the front and rear movement of thighs, and in the process that one group of mechanical legs 20 supports the main body 10 to move forwards, the other group of mechanical legs 20 are in an original position and are not moved, namely a typical triangular gait walking method, as shown in fig. 2. Moreover, since the driving structure of the six mechanical legs 20 is adopted, the center of gravity of the main body 10 is low when the survey vehicle 100 walks, and the survey vehicle has the characteristic of high stability and can adapt to rugged terrain after earthquake quickly.
As shown in fig. 3, the controller may be, for example, a stm32f103 controller, which is connected to the 24-way steering engine control board through a UART communication interface, and controls 18 motion steering engines disposed on the six mechanical legs 20. There are 24 steering engine control signals on the steering engine control board, and only 18 ways are used herein. The stm32f103 controller controls 18 steering engines to rotate to a specific angle by sending serial port instructions, so that basic motions such as front-back left-right motion and rotation of the six mechanical legs 20 are realized.
Further, as shown in fig. 3, the survey vehicle 100 includes a binocular camera and a first display (not shown) provided in the ground station. The binocular camera is arranged on the main body 10 and used for collecting the environment image and sending the environment image to the first displayer, and the first displayer receives the environment image and displays the environment image.
Specifically, the binocular camera is connected with the first display in a communication manner, the binocular camera is arranged on the main body 10 and moves along with the main body 10 so as to collect an environment image where the exploration vehicle 100 is located, and the environment image is sent to the first display, and the first display displays the environment image so as to facilitate the rescue workers to perform depth ranging and position the trapped person through the environment image displayed by the first display.
Because there is almost no image plane with completely coplanar rows aligned with the binocular camera, in this embodiment, the image plane acquired by the binocular camera needs to be remapped by using the Bouguet algorithm based on OpenCv, so that the two images are located on the completely same plane, and the image rows are completely aligned to the forward parallel configuration.
Specifically, the operating principle is substantially as follows:
1. firstly, a calibration item is calculated, and a Bouguet algorithm in Opencv is applied. The algorithm is realized by a stereoRectify () function, the reprojection change of each image is minimized according to parameters of binocular calibration output, and the common view of the view is maximized.
2. And performing stereo correction item, pre-calculating left and right correction lookup maps of left and right camera views by using independent calling of a function initUnderportRectifyMap (), and generating mapping tables map1 and map 2.
The stereo matching is to match three-dimensional points to corresponding positions of the binocular cameras, thereby obtaining a disparity map. Opencv provides two stereo matching algorithms: block matching algorithms (BMs) and semi-global block matching algorithms (SGBMs). The BM is selected because we need to calculate the speed of motion in real time, which is better for SGBM processing than for processing time. The basic mechanism of the BM algorithm is to calibrate and align the images so that only the rows are compared, and then the algorithm difference is performed on the two images to match the pixel groups, and the implementation function is StereoBM (), which has three main steps.
(1) Pre-filtering to normalize image intensities and enhance texture.
(2) The appropriate SAD is selected and a match search is performed along the horizontal epipolar line.
(3) Post filtering to eliminate bad correspondence matches.
After the disparity is calculated, the distance can be calculated.
3. And calling a function remap (), and using the mapping from the left side to the right side to obtain a new left and right stereo image for correction each time.
Further, the controller may also control a pan tilt motor connected between the main body 10 and the binocular cameras by transmitting a serial port instruction to the binocular cameras, thereby driving the binocular cameras to rotate, implementing a multi-angular photographing ruin environment, and increasing the surveying ability of the surveying vehicle 100.
Further, in this embodiment, the survey vehicle 100 includes a wireless transmission module for wirelessly communicatively coupling the binocular camera with the first display. The wireless transmission module can be a lora module, a high-frequency ad hoc network technology is applied, information within the range of 5 kilometers at most after an earthquake can be transmitted in real time, rescue workers can find the positions of trapped persons and rescue the trapped persons in time conveniently, and search and rescue efficiency is greatly improved.
It can be understood that the wireless transmission module may also be a 5.8G image transmission module, and the 5.8G image transmission module performs wireless image transmission between the binocular camera and the first display. The 5.8G image transmission modules are also used in pairs, one for transmitting and one for receiving. The 5.8G sending submodule is carried on the surveying vehicle 100 and is mutually connected with a video output port of the binocular camera through a micro usb interface; the 5.8G receiving submodule is connected with the first display through a video line, and an environment image shot by the binocular camera can be directly seen through the first display, so that the real-time transmission of the surrounding environment is realized, and the position of the trapped person is searched in time.
Further, the sensors may also include infrared sensors, and the survey vehicle 100 includes a second display, which is disposed in the ground station. The infrared sensor is used for collecting the environment image and sending the environment image to the second display, and the second display receives and displays the environment image.
Specifically, infrared radiation of an object is projected onto the infrared sensor through the thermal imaging lens, the infrared sensor converts radiation signals with different intensities into corresponding electric signals, a video image which can be observed by human eyes is formed through amplification and video processing, and the second display is used for displaying the video image. By using infrared thermographic surveying, the following advantages can be achieved: 1. all-weather work and strong light resistance. 2. The temperature detection capability is provided, and the preparation of intelligent analysis is improved more favorably compared with visible light. 3. The target in a scene range of 5-6 m can be observed at the same time.
Further, as shown in fig. 3, the survey vehicle 100 further comprises a drone, a camera (not shown in the figure) and a third display. The camera sets up on unmanned aerial vehicle, and the camera is used for gathering the environment image to send the environment image to the third display, the third display sets up in ground satellite station, is used for receiving the environment image and shows.
Particularly, unmanned aerial vehicle is mutually independent with the main part 10 of surveying car 100, the in-process of surveying is removed to main part 10 at survey car 100, unmanned aerial vehicle also can drive the camera and remove, thereby can remove in the top of surveying car 100's main part 10, the camera can be followed a perpendicular angle of looking down and gathered the image, and then cooperate with the binocular camera that sets up on main part 10, realize land, search and rescue simultaneously in the air, not only increase the dimension in search and rescue space like this, can obtain more comprehensive environmental image, in order to do benefit to the position that helps search and rescue personnel further analysis quilt person, and can promote the precision of surveying, promote search and rescue efficiency.
Typically, the height of the drone relative to the main body 10 may be adjusted according to the accuracy of the image to be investigated, for example, when image data with a resolution of less than 0.05m is required, the drone may be typically positioned 250m-260m above the main body 10.
Further, as shown in fig. 3, the survey vehicle 100 may further include an illumination lamp disposed on the main body 10 for emitting light during the movement of the main body 10, on one hand, the light may be used to remind the trapped person, and on the other hand, the illumination lamp may also be used for illumination, so as to facilitate the camera to collect the environment image.
Further, the survey vehicle 100 further comprises a power source disposed at the main body 10 for supplying power to the survey vehicle 100 so that the at least two robotic legs 20, the tracked drives 30, the sensors, and the controller disposed at the main body 10 can all function properly.
Based on the survey vehicle 100, another aspect of the present application further provides a method for controlling movement of a survey vehicle, as shown in fig. 4, where fig. 4 is a flow chart of the method for controlling movement of a survey vehicle in the embodiment of the present application. The mobile control method comprises the following steps:
step S101: the control sensor detects the width of the ground.
Specifically, the controller controls the sensor to detect the width of the ground. The sensor may be, for example, a distance sensor, and the distance sensor continuously detects the width of the ground when the main body 10 drives the distance sensor to move.
Step S102: the first control command or the second control command is generated in response to the width of the ground.
Specifically, the controller receives the width of the ground detected by the sensor, and generates a first control command or a second control command according to the corresponding relation between the width of the ground and the first control command and the second control command.
Step S103: in response to a first control instruction, controlling at least two mechanical legs 20 to move so as to drive the main body 10 to move; or in response to a second control command, controlling the crawler-type driving mechanism 30 to move so as to drive the main body 10 to move.
Specifically, the controller controls the at least two mechanical legs 20 to move the main body 10 when generating the first control command. When the controller generates the second control instruction, the crawler-type driving mechanism 30 is controlled to move to drive the main body 10 to move, so that the exploration vehicle 100 can adapt to different road conditions, and can move in different modes under different road condition environments, so that the exploration vehicle 100 has great advantages in speed, energy consumption and stability, the search and rescue capacity and the search and rescue efficiency of the exploration vehicle 100 are improved, and the functions of ruins, cave search and rescue, ruin surface search and rescue and the like are realized.
Further, as shown in fig. 5, fig. 5 is a flowchart of step S102 in fig. 4. The step of generating a first control command or a second control command in response to the width of the ground surface comprises:
step S201: the width of the ground detected by the sensor is received.
Specifically, the controller receives the width of the ground detected by the sensor. The controller can be connected with the sensor by adopting a cable, or the controller can also be connected with the sensor in a wireless communication mode, so that the situation that the cable is wound around obstacles in the ruins and cannot pass through the obstacles is avoided.
Step S202: and selecting to generate the first control instruction or the second control instruction according to the corresponding relation between the width and the first control instruction and the second control instruction.
Specifically, the controller selects and generates the first control instruction or the second control instruction according to the corresponding relation between the width and the first control instruction and the second control instruction.
For example, when the sensor detects that the width on ground is narrower, can send the testing result to the controller, send first control command after the controller receives the testing result, and then drive two at least mechanical legs 20 and drive main part 10 and remove, thus, can utilize two at least mechanical legs 20 to drive main part 10 and remove through narrower ground, when the distance sensor detects the width broad on ground, can send the testing result to the controller, send second control command after the controller receives the testing result, and then drive crawler-type actuating mechanism 30 and drive main part 10 and remove through the ground of broad, so, can promote the motion stationarity of main part 10, and can promote the moving speed of survey car 100, and then promote search and rescue efficiency.
Further, as shown in fig. 6, fig. 6 is a flowchart of step S103 in fig. 4. The step of controlling the at least two mechanical legs 20 to move the main body 10 includes:
step S301: one set of the robot legs 20 is controlled to move the support body 10 forward and the other set of the robot legs 20 is controlled to be stationary in place.
Step S302: the other set of robot legs 20 is controlled to move the support body 10 forward and the one set of robot legs 20 is controlled to be stationary in place.
Specifically, at least two robot legs 20 may be divided into two groups moving synchronously, wherein one group of robot legs 20 is stationary during the forward movement of the main body 10 supported by the other group of robot legs 20, and one group of robot legs 20 is stationary during the forward movement of the other group of robot legs 20, so that the main body 10 is driven to move in a reciprocating cycle.
The principles and embodiments of the present invention are explained herein using specific examples, which are presented only to assist in understanding the method and its core concepts of the present invention. It should be noted that there are no specific structures but a few objective structures due to the limited character expressions, and that those skilled in the art may make various improvements, decorations or changes without departing from the principle of the invention or may combine the above technical features in a suitable manner; such modifications, variations, combinations, or adaptations of the invention using its spirit and scope, as defined by the claims, may be directed to other uses and embodiments.
Claims (10)
1. A survey vehicle, the survey vehicle comprising:
a main body;
the sensor and the controller are arranged on the main body, the sensor is used for detecting, and the controller is used for obtaining the detection result so as to send out a first control instruction or a second control instruction;
the at least two mechanical legs are connected to the main body and used for receiving the first control instruction to drive the main body to move; and
and the crawler-type driving mechanism is connected to the main body and used for receiving the second control command to drive the main body to move.
2. The survey vehicle of claim 1 wherein the sensors comprise distance sensors disposed on the body for detecting a width of the ground and sending the width of the ground to the controller, the controller receiving the width of the ground and selectively driving the body to move using the at least two robotic legs or the tracked drive depending on the correspondence of the width to the first control command and the second control command.
3. The vehicle according to claim 1, wherein the number of the mechanical legs is six, the six mechanical legs are arranged at intervals on the periphery of the main body, the six mechanical legs are divided into two groups which are alternately arranged and move synchronously, and the controller controls the two groups of the mechanical legs to move alternately when receiving the first control command.
4. The survey vehicle of claim 1, characterized in that the survey vehicle comprises a binocular camera, a first display and a wireless transmission module, the binocular camera is arranged on the main body and used for collecting an environmental image and sending the environmental image to the first display, the first display receives and displays the environmental image, and the wireless transmission module is used for connecting the binocular camera with the first display in a wireless communication manner.
5. The survey vehicle of claim 1 wherein the sensors comprise infrared sensors and the survey vehicle comprises a second display, the infrared sensors being configured to acquire and transmit an image of the environment to the second display, the second display receiving and displaying the image of the environment.
6. The survey vehicle of claim 1, wherein the survey vehicle comprises a drone, a camera and a third display, the camera is disposed on the drone, the camera is configured to capture an environmental image and send the environmental image to the third display, and the third display receives and displays the environmental image.
7. A survey vehicle according to any one of claims 1 to 6, comprising illumination lamps arranged in the main body and a power supply arranged in the main body for powering the survey vehicle.
8. A movement control method of a survey vehicle, characterized by comprising:
controlling a sensor to detect the width of the ground;
generating a first control command or a second control command in response to the width of the ground;
responding to the first control instruction, controlling the at least two mechanical legs to move so as to drive the main body to move; or responding to the second control instruction, and controlling the crawler-type driving mechanism to move so as to drive the main body to move.
9. The movement control method of claim 8, wherein the step of generating a first control command or a second control command in response to the width of the terrain comprises:
receiving the width of the ground detected by the sensor;
and selecting and generating the first control instruction or the second control instruction according to the corresponding relation between the width and the first control instruction and the second control instruction.
10. The movement control method according to claim 8, wherein the step of controlling the at least two mechanical legs to move the main body comprises:
controlling one group of the mechanical legs to support the main body to move forwards and controlling the other group of the mechanical legs to be fixed in place;
controlling the other set of the mechanical legs to support the main body to move forwards and controlling the one set of the mechanical legs to be fixed in place.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011087238.4A CN112092929A (en) | 2020-10-12 | 2020-10-12 | Survey car |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011087238.4A CN112092929A (en) | 2020-10-12 | 2020-10-12 | Survey car |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN112092929A true CN112092929A (en) | 2020-12-18 |
Family
ID=73783208
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011087238.4A Pending CN112092929A (en) | 2020-10-12 | 2020-10-12 | Survey car |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112092929A (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114067197A (en) * | 2021-11-17 | 2022-02-18 | 河南大学 | Pipeline defect identification and positioning method based on target detection and binocular vision |
-
2020
- 2020-10-12 CN CN202011087238.4A patent/CN112092929A/en active Pending
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114067197A (en) * | 2021-11-17 | 2022-02-18 | 河南大学 | Pipeline defect identification and positioning method based on target detection and binocular vision |
| CN114067197B (en) * | 2021-11-17 | 2022-11-18 | 河南大学 | Pipeline defect identification and positioning method based on target detection and binocular vision |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| WO2021068846A1 (en) | Multi-arm robot for tunnel lining detection and disease diagnosis in operating period | |
| WO2021068848A1 (en) | Tunnel structure disease multi-scale measurement and intelligent diagnosis system and method | |
| CN104217439B (en) | Indoor visual positioning system and method | |
| CN106802658B (en) | Method for rapidly positioning in a kind of full-automatic high precision room | |
| CN1238691C (en) | Combined stereovision, color 3D digitizing and motion capture system | |
| CN104932001B (en) | A kind of 3D nuclear radiation environments in real time rebuild monitoring system | |
| JP5618840B2 (en) | Aircraft flight control system | |
| CN107067436B (en) | Pose estimation device and vacuum cleaner system | |
| CN108536145A (en) | A kind of robot system intelligently followed using machine vision and operation method | |
| US20120092460A1 (en) | System And Method For Alerting Visually Impaired Users Of Nearby Objects | |
| CN106527426A (en) | Indoor multi-target track planning system and method | |
| CN102785719B (en) | Method for shooting water gage images of ship | |
| CN207488823U (en) | A kind of mobile electronic device | |
| CN108897342B (en) | Positioning and tracking method and system for fast-moving civil multi-rotor unmanned aerial vehicle | |
| JP2008517320A (en) | Linear aberration correcting mirror and video system including the same | |
| CN112819943B (en) | Active vision SLAM system based on panoramic camera | |
| CN108000561A (en) | Intelligent robot and its anticollision prevent falling device | |
| JP2016177640A (en) | Video monitoring system | |
| CN112173103B (en) | Detection device and method for tunnel working face constructed by drilling and blasting method | |
| CN105955279A (en) | Mobile robot path planning method and device based on image vision | |
| CN106264536A (en) | A kind of 3D anthropometric scanning apparatus and method | |
| CN111398309A (en) | Apparent detection system of tunnel lining disease comprehensive detection vehicle | |
| JP2019050007A (en) | Method and device for determining position of mobile body and computer readable medium | |
| CN204863196U (en) | Three -dimensional human scanning device | |
| CN206399422U (en) | Multifunctional vision sensor and mobile robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination |