CN108267796A - A kind of exploratory heading automatic detection vehicle - Google Patents
A kind of exploratory heading automatic detection vehicle Download PDFInfo
- Publication number
- CN108267796A CN108267796A CN201611261183.8A CN201611261183A CN108267796A CN 108267796 A CN108267796 A CN 108267796A CN 201611261183 A CN201611261183 A CN 201611261183A CN 108267796 A CN108267796 A CN 108267796A
- Authority
- CN
- China
- Prior art keywords
- exploratory heading
- detection
- interface
- point
- exploratory
- 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.)
- Withdrawn
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
- G01B21/02—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness
- G01B21/04—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness by measuring coordinates of points
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
- G01B21/10—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring diameters
- G01B21/14—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring diameters internal diameters
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V11/00—Prospecting or detecting by methods combining techniques covered by two or more of main groups G01V1/00 - G01V9/00
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geophysics (AREA)
- Traffic Control Systems (AREA)
Abstract
The present invention relates to a kind of exploratory heading automatic detection vehicles；Including exploratory heading detection device, vehicle, positioning device, vehicle controller, operation hole；The exploratory heading detection device cooperation fixed setting is onboard.The exploratory heading detection device, including pedestal, ground detection, detection controller；The ground detection is used to obtain the measurement data and/or photographed data on detection zone ground.The ground detection includes range unit, and the range unit is wireless distance finding device or laser ranging system, and the range unit cooperation is fixed on two dimension or multidimensional or two axis or multiaxial motion platform；The two dimension or multidimensional or two axis or the cooperation of multiaxial motion platform are fixed on pedestal.The present invention provides a kind of exploratory heading automatic detection vehicles, can detect the position of exploratory heading and/or the diameter of exploratory heading, conveniently moving automatically, improve the working efficiency of exploratory heading detection.
Description
Technical field
The present invention relates to electronics and machinery equipment field, especially exploratory heading automatic detection vehicle.
Background technology
In some constructions, many exploratory headings are made, but exploratory heading backfill does not often backfill not in time, even；Existing management because
Element, economic factor also have certain relationship with lacking exploratory heading cleaning equipment.
When carrying out exploratory heading cleaning, backfill when work, if there is a kind of automation equipment, exploratory heading can be detected automatically
Position and/or the diameter of exploratory heading, are conducive to accelerate the speed of exploratory heading cleaning, backfill, and conveniently moving reduces road and occupies.
Invention content
Technical problem：
In view of the defects existing in the prior art, the present invention proposes a kind of exploratory heading automatic detection vehicle；It can detect spy automatically
The position in hole and/or the diameter of exploratory heading, conveniently moving are conducive to accelerate the speed of exploratory heading cleaning, backfill, improve exploratory heading detection
Working efficiency.
Technical solution：
To achieve the above object, the present invention proposes a kind of exploratory heading automatic detection vehicle, including the exploratory heading detection device, vehicle,
Positioning device, vehicle controller, operation hole；
The exploratory heading detection device is used to obtain position and/or the diameter of the exploratory heading of detection zone；
The exploratory heading detection device cooperation fixed setting is onboard；
The positioning device cooperation fixed setting is onboard；
The vehicle controller cooperation is fixedly mounted onboard；
The operation hole is located on vehicle, and the exploratory heading detection device is coordinated to set；The exploratory heading detection device passes through described
Detect exploratory heading in operation hole；
The vehicle controller mating connection exploratory heading detection device, positioning device；
The vehicle controller is computer control；
The positioning device is used for determining the position of vehicle.
Further, the exploratory heading detection device, including pedestal, ground detection, detection controller；The detection control
Device processed is computer control；The ground detection is fixedly installed with the base engagement；The detection controller and institute
State base engagement fixed setting；The ground detection is connected with the detection controller；The ground detection
For obtaining the measurement data on detection zone ground and/or photographed data.
Further, the ground detection includes range unit, and the range unit is wireless distance finding device or swashs
Optical range finding apparatus, the range unit cooperation are fixed on two dimension or multidimensional or two axis or multiaxial motion platform；Described two
Dimension or multidimensional or the cooperation of two axis or multiaxial motion platform are fixed on pedestal.
Further, the detection controller further includes input interface；The input interface includes starting interface and/or stop
Only interface；The startup interface and/or stopping interface of the input interface are connection and/or communication connection.The input connects
Mouth is connection and/or communication connection.
Further, the detection controller at least further includes one of following interfaces：
Interface one：Communication interface；The communication interface includes one of the following：Digital wireless communication interface, mobile number are logical
Believe interface, near field communication interface, wired communication interface；
Interface two：Video interface；The video interface can at least connect a video monitoring apparatus；The video interface
It is analog interface or digital interface；
Interface three：Audio interface；The audio interface can at least connect a sound pick-up；The audio interface is simulation
Interface or digital interface.
Further, the vehicle drives vehicle for drone's vehicle or Intelligent unattended.
Further, the positioning device is the combination of satellite positioning device, inertial positioning device, base station location device.
Further, the exploratory heading automatic detection vehicle further includes monitor camera；It is installed on the exploratory heading automatic detection vehicle
Monitor the monitor camera of search coverage；The monitor camera mating connection monitor；The monitor, which includes being located at, to be driven
The monitor of room and/or monitor positioned at vehicle-mounted manipulation position and/or remote controler and/or remote monitor and/or mobile phone.
The present invention proposes a kind of exploratory heading detection method, it is characterised in that：The exploratory heading detection method is used to detect detection zone
The position of exploratory heading in domain and/or diameter, including following processing steps：
S1) block-by-blocks traversal detection zone；One angle in self-test region starts, every time one detection subregion of detection, institute
State the detection length of subregion, width is set greater than exploratory heading diameter, make a detection subregion that can only be visited there are one complete
Hole；Adjacent two detection subregion overlapping at least half of exploratory heading diameter, 2 rows overlapping at least half of exploratory heading diameter in row；In row
Two adjacent row detection subregion overlapping at least half of exploratory heading diameter；After one detection subregion detection, it is moved in row
Next detection subregion；After a line detects, next line is detected；
S2) measures the distance data matrix for obtaining detection subregion；It detects in subregion and is detected at one, according to
The ranks spacing (be smaller than exploratory heading diameter 1/5th) of pre-set test point determines the inspection in detection zone
The position of measuring point；Each test point is measured to the distance of ground detection, obtains the distance data matrix of detection zone；
S3) detects exploratory heading edge point, the label exploratory heading edge point in exploratory heading candidate edge point marks matrix A；Including as follows
Subprocessing：
S3.1) removes label (the exploratory heading candidate edge point label square of exploratory heading candidate edge point label matrix A all elements
The line number of battle array A, columns are consistent with distance data matrix)；
S3.2) calculates the distance between all row or column consecutive points in distance data matrix difference one by one；
S3.3) finds out candidate exploratory heading edge point：Judge whether the absolute value of the distance difference is more than or more than or equal to setting
Fixed threshold value if it is, thinking that the corresponding test point of 2 points in a pair of consecutive points is candidate exploratory heading edge point, is being visited
The position of correspondence this 2 points in hole candidate edge point label matrix A makes marks；
S4) looks for exploratory heading, and exploratory heading set is recorded in the exploratory heading found out in exploratory heading candidate edge point marks matrix A
In；Including following subprocessing：
S4.1) replicates exploratory heading candidate edge point and marks matrix A to exploratory heading edge point traversal label matrix B；
S4.2) removes the label (row of exploratory heading edge point label Matrix C of exploratory heading edge point label Matrix C all elements
Number, columns are as exploratory heading candidate edge point label matrix A)；
S4.3) looks for first edge point of exploratory heading：In exploratory heading edge point traverses label matrix B, looked for by row or column traversal
First markd element (being denoted as P)；It finds, it is believed that find an edge point of doubtful exploratory heading, point traverses at exploratory heading edge
Remove the corresponding labels of point P in label matrix B, the corresponding labels of mark point P in exploratory heading edge point marks Matrix C；It does not find,
Think there is no exploratory heading in the region, go to step S5；
S4.4) looks for the adjacent side of exploratory heading along point：In exploratory heading edge point traverses label matrix B, centered on point P, row
Or column distance point P distances search next markd element (being denoted as P2) in the range of a points of x (presetting)；It finds,
Remove the corresponding labels of point P2 in exploratory heading edge point traverses label matrix B, the mark point P in exploratory heading edge point marks Matrix C
Corresponding label, record P are equal to P2, go to step S4.4；It does not find, goes to step S4.5；
Whether the exploratory heading that S4.5) judgements are found is complete：Exploratory heading candidate edge point mark matrix A in, using point P in
The heart, row or column range points P searches next markd element in the range of x point；It finds, it is believed that find complete
Exploratory heading goes to step S4.6；It does not find, it is believed that is found is incomplete exploratory heading, goes to step S4.2 and looks for next exploratory heading；
S4.6) calculates diameter, the center point coordinate of exploratory heading：Calculating successively in exploratory heading edge point label Matrix C has label
Any point, to the maximum distance (being denoted as L) between remaining markd point and corresponding 2 points of maximum distance (be denoted as P1,
P3)；
Whether within the preset range to judge L, if, it is believed that find exploratory heading, it is believed that the central point of exploratory heading is in point
The midpoint of P1, P3 line calculates the position of exploratory heading central point；If not, go to step S4.2；
S4.7) the location information of the exploratory heading is recorded in exploratory heading set；
S5) coordinate transforms:According to the coordinate of exploratory heading detection device, coordinate transform is carried out to exploratory heading center point coordinate, is obtained
Exploratory heading central point relative to exploratory heading detection device origin coordinate：
S6) coordinate transforms two:According to the coordinate for the exploratory heading automatic detection vehicle that vehicle carried pick device obtains, to exploratory heading center
Point coordinates or exploratory heading central point carry out coordinate transform relative to the coordinate of exploratory heading detection device origin, and it is opposite to obtain exploratory heading central point
In the coordinate of exploratory heading automatic detection vehicle origin.
Further, the processing step S3.3 is replaced by：
S3.4) determines that the point is located in hole, outside hole according to the positive and negative of the difference；If the difference is just, is subtracted
The corresponding test point of number is located in hole；If the difference is negative, the corresponding test point of subtrahend is located in hole；
The test point being located in hole in a pair of of consecutive points of selection and/or the test point outside hole, on exploratory heading candidate side
It makes marks along the corresponding position in point label matrix A.
Further, the processing step S4.6 is replaced by：
S4.10) traversals calculate diameter, the center point coordinate of exploratory heading：It calculates successively in exploratory heading edge point label Matrix C
The distance between all the points of tape label obtain maximum distance (being denoted as L) and maximum distance corresponding 2 between markd point
A point (being denoted as P1, P3)；
Whether within the preset range to judge L, if, it is believed that find exploratory heading, it is believed that the central point of exploratory heading is in point
The midpoint of P1, P3 line calculates the position of exploratory heading central point；If not, go to step S4.2.
Further, the processing step S4.6 is replaced by：
S4.11) maximum widths, height method traversal calculate diameter, the center point coordinate of exploratory heading：Exploratory heading edge is calculated successively
Line-spacing, row between all the points of tape label in point label Matrix C away from, find maximum line-spacing, row away from and its endpoint；
Using big value away among of maximum line-spacing, row or small value or its average value as exploratory heading diameter (being denoted as L)；
Whether within the preset range to judge L, if, it is believed that exploratory heading is found, with maximum line-spacing, row away from correspondence
Line crosspoint be exploratory heading central point or using maximum line-spacing or row the midpoint away from corresponding line as exploratory heading central point；
If not, go to step S4.2.
Advantageous effect
Exploratory heading automatic detection vehicle proposed by the present invention can detect the position of exploratory heading and/or the diameter of exploratory heading automatically, mobile
It is convenient, improve the working efficiency of exploratory heading detection.
Description of the drawings
Fig. 1 is a kind of structure diagram of embodiment of the exploratory heading detection device of the present invention：
11. pedestal, 12. ground detections, 13. connecting lines, 14. detection controllers.
Fig. 2 is the structure diagram of another embodiment of the exploratory heading detection device of the present invention：
11. pedestal, 15. motion platforms, 16. laser ranging systems, 13. connecting lines, 14. detection controllers.
Fig. 3 is a kind of structure diagram of embodiment of the exploratory heading automatic detection vehicle of the present invention：
31. vehicle, 32. exploratory heading detection devices, 33. positioning devices, 34. connecting lines, 35. vehicle controllers, 36. operation holes.
Fig. 4 is a kind of main flow chart of embodiment of the exploratory heading detection method of the present invention.
Fig. 5 is the sub-process figure of the processing step S3 of the embodiment illustrated in fig. 5 of the exploratory heading detection method of the present invention.
Fig. 6 is the sub-process figure of the processing step S4 of the embodiment illustrated in fig. 5 of the exploratory heading detection method of the present invention.
Fig. 7 is the sub-process figure of the processing step S3 of another embodiment of the exploratory heading detection method of the present invention.
Fig. 8 is the sub-process figure of the processing step S4 of another embodiment of the exploratory heading detection method of the present invention.
Fig. 9 is the sub-process figure of the processing step S4 of another embodiment of the exploratory heading detection method of the present invention.
Specific embodiment
In order to make the purpose , technical scheme and advantage of the present invention be clearer, with reference to the accompanying drawings and embodiments, it is right
The present invention is described in further detail.It should be appreciated that the specific embodiments described herein are merely illustrative of the present invention,
It is not intended to limit the present invention.
Implement use-case one
As shown in Figure 1, it is a kind of a kind of structure diagram of embodiment of exploratory heading detection device of the present invention, including pedestal
11st, ground detection 12, connecting line 13, detection controller 14.
For the pedestal 11 for fixing, protecting other component, shape preferably includes bottom surface.
The cooperation of ground detection 12 fixed setting is on the pedestal 11；
The detection controller 14 is fixedly installed with the cooperation of pedestal 11；
The detection controller 14 is computer control, is the prior art.
The ground detection 12 is connected by connecting line 13 and the detection controller 14；
The connecting line 13 is connected with pedestal 11, ground detection 12, detection controller 14.
The exploratory heading detection device is used to obtain position and/or the diameter of the exploratory heading of detection zone.
The ground detection 12 includes image acquisition device or radar or range unit；Preferably image collection fills
It puts；The ground detection 12 is used to obtain the measurement data and/or photographed data on detection zone ground.
The image acquisition device includes one of DV or digital camera, preferably digital camera；Shadow
Controller 14 is detected as harvester is transferred to the image information of acquisition, detection controller 14 analyzes image, obtains
Exploratory heading position coordinates in the picture and/or exploratory heading diameter；Optionally, further according to image acquisition device with respect to 11 origin of pedestal
Coordinate obtains coordinate of the exploratory heading with respect to 11 origin of pedestal.
Optionally, the exploratory heading detection device further includes input interface, and the input interface coordinates with detection controller 14
Connection；The input interface is used to receive external input signal；Preferably, including input interface；
The input interface includes starting interface and/or stops interface, preferred to include starting interface and stop interface；Institute
It is connection and/or communication connection, preferably connection to state input interface；
After the detection controller 14 receives the enabling signal that startup interface transmits, start to work；The detection control
After device 14 receives the stop signal that stopping interface transmitting, it is stopped.
Optionally, the exploratory heading detection device further includes signal output apparatus；Preferably include signal output apparatus.
The signal output apparatus is connected with detection controller 15, coordinates fixed setting；The signal output apparatus
For exporting the information such as testing result and/or working condition.
The signal output apparatus is wireless communication device of the prior art or wire communication device；The wireless communication
Device includes at least one of ZigBee transport protocols, WiFi transport protocols, Bluetooth transmission protocol, GPRS communication protocols；It is described to have
Line communication device includes at least one of circuit output device, serial ports wire communication device, Parallel Interface Communication device；The wire communication
Device, wireless communication device are the prior arts.Preferably use serial ports wire communication device.
Optionally, the detection controller at least further includes one of following interfaces：
Interface one：Communication interface；The communication interface includes one of the following：Digital wireless communication interface, mobile number are logical
Believe interface, near field communication interface, wired communication interface；Preferably, mobile digital communication interface；
Interface two：Video interface；The video interface can at least connect a video monitoring apparatus；The video interface
It is analog interface or digital interface；Preferably digital interface；
Interface three：Audio interface；The audio interface can at least connect a sound pick-up；The audio interface is simulation
Interface or digital interface.
Preferably, the detection controller further includes communication interface, video interface, audio interface.
All electrical equipments are by installing means of power on the pedestal 11；The supply unit, be generator and/or
Storage battery power supply system and/or generator combine electric power system and/or externally fed interface arrangement with accumulator；Preferably store
Battery power supply system.
Implement use-case two
As shown in Fig. 2, it is a kind of structure diagram of exploratory heading detection device another kind embodiment of the present invention, including pedestal
11st, motion platform 15, laser ranging system 16, detection controller 14, connecting line 13.
Implementing use-case two, the difference lies in implementing the ground detection 12 that use-case two uses is with implementing use-case one
Laser ranging system 16；The cooperation of laser ranging system 16 is fixed on motion platform 15；The motion platform 15 is matched
Close fixed setting on the pedestal 11；
The laser ranging system 16 is wireless distance finding device or laser ranging system；The wireless distance finding device, laser
Range unit is the prior art；Preferably laser ranging system；
The laser ranging system 16 is connected by connecting line 13 and detects controller 14；
The motion platform 15 is two dimension or multidimensional or two axis or multiaxial motion platform；Two dimension or multidimensional or two axis or multiaxis
Motion platform is the prior art；Being connected by connecting line 13 for the motion platform 15 detects controller 14；Preferably
Two axis motion platforms；Under the control of detection controller 14, motion platform 15 drives laser ranging system 16 to measure detection zone
Each measurement point in domain is to the distance of laser ranging system 16；Each measurement point in detection zone controls in advance in detection
It sets on device, is determined in region preferably through line space, the column pitch between the setting measurement point on detection controller
The position of measurement point.Line space, column pitch between measurement point should be set smaller than 1/3rd of exploratory heading diameter, preferably
1/10th.
Implement use-case three
As shown in figure 3, be a kind of a kind of structure diagram of embodiment of exploratory heading automatic detection vehicle of the present invention, including：
Vehicle 31, exploratory heading detection device 32, positioning device 33, connecting line 34, vehicle controller 35, operation hole 36.
The exploratory heading detection device 32 is one of exploratory heading detection device of the present invention or other exploratory heading detection devices；
Preferably implement the exploratory heading detection device 32 described in use-case two.
The cooperation of exploratory heading detection device 32 is fixedly mounted on vehicle 31；
The cooperation of positioning device 33 is fixedly mounted on vehicle 31；
The cooperation of vehicle controller 35 is fixedly mounted on vehicle 31；
The cooperation of connecting line 34 is fixedly mounted on vehicle 31.
The operation hole 36 is located on vehicle 31, and the exploratory heading detection device 32 is coordinated to set；The exploratory heading detection device 32
Exploratory heading is detected by the operation hole 36；
The vehicle controller 35 is connected with connecting line 34；
The vehicle controller 35 is computer control；
The connecting line 34 is the computer control system connecting line coordinated with vehicle controller 35；
The vehicle controller 35 passes through 34 mating connection exploratory heading detection device 32 of connecting line, positioning device 33.
The positioning device 33 is used for determining the position of vehicle 31；The positioning device 33 is that satellite positioning device, inertia are fixed
The combination of position device, base station location device；The preferably double source positioning device of satellite positioning device combination inertial positioning device.
The detection controller 14 of the exploratory heading detection device 32 is connected by its communication interface and/or connecting line 13 to be connected
Wiring 33 and/or vehicle controller 34；
The exploratory heading detection device 32 mobile detection under the drive of vehicle 31.
Vehicle 31 is provided with the window that the work of exploratory heading detection device 32 uses, and is detected outside vehicle 31 for exploratory heading detection device 32
Situation.
Optionally, the monitor camera of monitoring search coverage is installed on the exploratory heading automatic detection vehicle；The monitoring camera
Machine mating connection monitor；The monitor includes the monitor positioned at driver's cabin and/or the monitor positioned at vehicle-mounted manipulation position
And/or remote controler and/or remote monitor and/or mobile phone.Preferably, monitor camera is installed, the monitor is positioned at driving
Sail the monitor of room.Optionally, during the work time, the image of record monitor camera shooting.
Optionally, the vehicle drives vehicle, preferably drone's vehicle for drone's vehicle or Intelligent unattended.
Implement use-case four
As shown in figure 4, it is that (Fig. 5 is Fig. 4 institutes for the main flow chart of a kind of embodiment of exploratory heading detection method of the present invention a kind of
Show the sub-process figure of the processing step S3 of flow chart, Fig. 6 is the sub-process figure of the processing step S4 of flow chart shown in Fig. 4), it is visiting
Operation includes the program of exploratory heading detection method in the detection controller of hole detection device, and the exploratory heading detection method is examined for detecting
Position and/or the diameter of the exploratory heading in region are surveyed, including following processing steps：
S1) block-by-blocks traversal detection zone；One angle in self-test region starts, every time one detection subregion of detection, institute
State the detection length of subregion, width is set greater than exploratory heading diameter, make a detection subregion that can only be visited there are one complete
Hole；Adjacent two detection subregion overlapping at least half of exploratory heading diameter, 2 rows overlapping at least half of exploratory heading diameter in row；In row
Two adjacent row detection subregion overlapping at least half of exploratory heading diameter；After one detection subregion detection, it is moved in row
Next detection subregion；After a line detects, next line is detected；Preferably, the length of subregion is detected, width is set as
1.5 times of (citings of exploratory heading diameter：When exploratory heading is 50 millimeters a diameter of, the length of subregion is detected, width is set as 75 millimeters)；
Preferably, two adjacent in row detection subregions are overlapped 0.7 exploratory heading diameter, and 2 rows are overlapped 0.7 exploratory heading diameter；To next
When row is mobile, when the height of remaining non-detection zone is less than 0.7 exploratory heading diameter, it is moved to regional edge edge；To next
When row are mobile, during 0.7 exploratory heading diameter of short of width of remaining non-detection zone, be moved to regional edge along；
S2) measures the distance data matrix for obtaining detection subregion；It detects in subregion and is detected at one, according to
The ranks spacing (be smaller than exploratory heading diameter 1/5th) of pre-set test point determines the inspection in detection zone
The position of measuring point；Each test point is measured to the distance of ground detection, obtains the distance data matrix of detection zone；It is excellent
Choosing, the ranks spacing of test point is set as 2 millimeters；
S3) detects exploratory heading edge point, the label exploratory heading edge point in exploratory heading candidate edge point marks matrix A；Including as follows
Subprocessing：
S3.1) removes label (the exploratory heading candidate edge point label square of exploratory heading candidate edge point label matrix A all elements
The line number of battle array A, columns are consistent with distance data matrix)；
S3.2) calculates the distance between all row or column consecutive points in distance data matrix difference one by one；
S3.3) finds out candidate exploratory heading edge point：Judge whether the absolute value of the distance difference is more than or more than or equal to setting
Fixed threshold value (preferred, to be set as 10 millimeters), if it is, thinking the corresponding test point of 2 points in a pair of consecutive points
For candidate exploratory heading edge point, the position of correspondence this 2 points in exploratory heading candidate edge point marks matrix A makes marks；
S4) looks for exploratory heading, and exploratory heading set is recorded in the exploratory heading found out in exploratory heading candidate edge point marks matrix A
In；Including following subprocessing：
S4.1) replicates exploratory heading candidate edge point and marks matrix A to exploratory heading edge point traversal label matrix B；
S4.2) removes the label (row of exploratory heading edge point label Matrix C of exploratory heading edge point label Matrix C all elements
Number, columns are as exploratory heading candidate edge point label matrix A)；
S4.3) looks for first edge point of exploratory heading：In exploratory heading edge point traverses label matrix B, looked for by row or column traversal
First markd element (being denoted as P)；It finds, it is believed that find an edge point of doubtful exploratory heading, point traverses at exploratory heading edge
Remove the corresponding labels of point P in label matrix B, the corresponding labels of mark point P in exploratory heading edge point marks Matrix C；It does not find,
Think there is no exploratory heading in the region, go to step S5；
S4.4) looks for the adjacent side of exploratory heading along point：In exploratory heading edge point traverses label matrix B, centered on point P, row
Or column distance point P distances search next markd element in the range of x (presetting, it is preferred that x=3) a point
(being denoted as P2)；It finds, removes the corresponding labels of point P2 in exploratory heading edge point traverses label matrix B, point marks at exploratory heading edge
The corresponding labels of mark point P in Matrix C, record P are equal to P2, go to step S4.4；It does not find, goes to step S4.5；
Whether the exploratory heading that S4.5) judgements are found is complete：Exploratory heading candidate edge point mark matrix A in, using point P in
The heart, row or column range points P searches next markd element in the range of x point；It finds, it is believed that find complete
Exploratory heading；It does not find, it is believed that is found is incomplete exploratory heading, goes to step S4.2 and looks for next exploratory heading；
S4.6) calculates diameter, the center point coordinate of exploratory heading：Calculating successively in exploratory heading edge point label Matrix C has label
Any point, to the maximum distance (being denoted as L) between remaining markd point and corresponding 2 points of maximum distance (be denoted as P1,
P3)；
L is judged whether in preset range (preferably, with the error of exploratory heading diameter within 10%), if
, it is believed that find exploratory heading, it is believed that the central point of exploratory heading is in the midpoint of point P1, P3 line, the position of calculating exploratory heading central point；If
Do not exist, go to step S4.2；
S4.7) the location information of the exploratory heading is recorded in exploratory heading set；
S5) coordinate transforms:According to the coordinate of exploratory heading detection device, coordinate transform is carried out to exploratory heading center point coordinate, is obtained
Exploratory heading central point relative to exploratory heading detection device origin coordinate；
S6) coordinate transforms two:According to the coordinate for the exploratory heading automatic detection vehicle that vehicle carried pick device obtains, to exploratory heading center
Point coordinates or exploratory heading central point carry out coordinate transform relative to the coordinate of exploratory heading detection device origin, and it is opposite to obtain exploratory heading central point
In the coordinate of exploratory heading automatic detection vehicle origin.
In the detection controller 14 of exploratory heading detection device 32 or carry the equipment of exploratory heading detection device 32 and examined with exploratory heading
Have in the detection controller of communication connection between survey device 32, operation includes the program of exploratory heading detection method.
Implement use-case five
As shown in fig. 7, it is the subflow of the processing step S3 of another embodiment of exploratory heading detection method of the present invention a kind of
Cheng Tu.
Implementing use-case five, difference lies in processing step S3.3 is replaced by with implementing use-case four：
S3.4) finds out candidate exploratory heading edge point：
Positive and negative according to the difference determines that the point is located in hole, outside hole；If the difference is just, minuend corresponds to
Test point be located in hole；If the difference is negative, the corresponding test point of subtrahend is located in hole；
The test point being located in hole in a pair of of consecutive points of selection and/or the test point outside hole, on exploratory heading candidate side
It makes marks along the corresponding position in point label matrix A.
Implement use-case six
As shown in figure 8, it is the subflow of the processing step S4 of another embodiment of exploratory heading detection method of the present invention a kind of
Cheng Tu.
Implementing use-case six, difference lies in processing step S4.6 is replaced by with implementing use-case four, five：
S4.10) traversals calculate diameter, the center point coordinate of exploratory heading：It calculates successively in exploratory heading edge point label Matrix C
The distance between all the points of tape label obtain maximum distance (being denoted as L) and maximum distance corresponding 2 between markd point
A point (being denoted as P1, P3)；
L is judged whether in preset range (preferably, with the error of exploratory heading diameter within 10%), if
, it is believed that find exploratory heading, it is believed that the central point of exploratory heading is in the midpoint of point P1, P3 line, the position of calculating exploratory heading central point；If
Do not exist, go to step S4.2.
Implement use-case seven
As shown in figure 9, it is the subflow of the processing step S4 of another embodiment of exploratory heading detection method of the present invention a kind of
Cheng Tu.
Implementing use-case seven, difference lies in the processing step S4.6 is replaced by with implementing use-case four, five：
S4.11) maximum widths, height method traversal calculate diameter, the center point coordinate of exploratory heading：Exploratory heading edge is calculated successively
Line-spacing, row between all the points of tape label in point label Matrix C away from, find maximum line-spacing, row away from and its endpoint；
Using big value away among of maximum line-spacing, row or small value or its average value as exploratory heading diameter (being denoted as L)；
L is judged whether in preset range (preferably, with the error of exploratory heading diameter within 10%), if
, it is believed that exploratory heading is found, using maximum line-spacing, crosspoint of the row away from corresponding line as exploratory heading central point or with maximum row
Away from or row the midpoint away from corresponding line be exploratory heading central point；
If not, go to step S4.2.
It should be noted that shown in the flowchart of the accompanying drawings can be in such as one group of calculating that can perform computer instruction
It is performed in machine system, although also, show the logical order of processing in flow charts, it in some cases, can be with
Shown or described processing is performed different from processing sequence herein.
The present invention provides a kind of exploratory heading automatic detection vehicles, can detect the position of exploratory heading and/or the diameter of exploratory heading automatically,
Be conducive to accelerate the speed of exploratory heading cleaning, backfill, conveniently moving improves the working efficiency that exploratory heading detects.
The foregoing is merely illustrative of the preferred embodiments of the present invention, is not intended to limit the invention, all essences in the present invention
All any modification, equivalent and improvement made within refreshing and principle etc., should all be included in the protection scope of the present invention.
Claims (10)
1. a kind of exploratory heading automatic detection vehicle, it is characterised in that：Including exploratory heading detection device, vehicle, positioning device, vehicle controller, work
Industry hole；
The exploratory heading detection device cooperation fixed setting is onboard；
The positioning device cooperation fixed setting is onboard；
The vehicle controller cooperation is fixedly mounted onboard；
The operation hole is located on vehicle, and the exploratory heading detection device is coordinated to set；The exploratory heading detection device passes through the operation
Detect exploratory heading in hole；
The vehicle controller mating connection exploratory heading detection device, positioning device；
The exploratory heading detection device is used to obtain position and/or the diameter of the exploratory heading of detection zone；
The vehicle controller is computer control；
The positioning device is used for determining the position of vehicle.
2. exploratory heading automatic detection vehicle according to claim 1, it is characterised in that：The exploratory heading detection device, including pedestal,
Ground detection, detection controller；The detection controller is computer control；The ground detection and the bottom
Seat cooperation fixed setting；The detection controller is fixedly installed with the base engagement；The ground detection is used to obtain
The measurement data and/or photographed data on detection zone ground.
3. exploratory heading automatic detection vehicle according to claim 2, it is characterised in that：The ground detection is filled including ranging
It puts；The range unit is wireless distance finding device or laser ranging system；Range unit cooperation be fixed at two dimension or
In multidimensional or two axis or multiaxial motion platform；The two dimension or multidimensional or two axis or the cooperation of multiaxial motion platform are fixed at bottom
On seat.
4. exploratory heading automatic detection vehicle according to claim 3, it is characterised in that：The vehicle is drone's vehicle or intelligence
It can automatic driving car.
5. the exploratory heading automatic detection vehicle according to claim 1-4, it is characterised in that：The detection controller further includes input
Interface；The input interface includes starting interface and/or stops interface；The startup interface of the input interface and/or stopping connect
Mouth is connection and/or communication connection.The input interface is connection and/or communication connection.
6. the exploratory heading automatic detection vehicle according to claim 1-4, it is characterised in that：The detection controller at least further includes
One of following interfaces：
Interface one：Communication interface；The communication interface includes one of the following：Digital wireless communication interface, mobile digital communication connect
Mouth, near field communication interface, wired communication interface；
Interface two：Video interface；The video interface can at least connect a video monitoring apparatus；The video interface is mould
Intend interface or digital interface；
Interface three：Audio interface；The audio interface can at least connect a sound pick-up；The audio interface is analog interface
Or digital interface.
7. exploratory heading automatic detection vehicle according to claim 4, it is characterised in that：The detection controller at least further includes down
State one of interface：
Interface one：Communication interface；The communication interface includes one of the following：Digital wireless communication interface, mobile digital communication connect
Mouth, near field communication interface, wired communication interface；
Interface two：Video interface；The video interface can at least connect a video monitoring apparatus；The video interface is mould
Intend interface or digital interface；
Interface three：Audio interface；The audio interface can at least connect a sound pick-up；The audio interface is analog interface
Or digital interface.
8. exploratory heading automatic detection vehicle according to claim 1, it is characterised in that：The positioning device is satellite positioning dress
It puts, the combination of inertial positioning device, base station location device.
9. exploratory heading automatic detection vehicle according to claim 1, it is characterised in that：Further include monitor camera；The exploratory heading
The monitor camera of installation monitoring search coverage on automatic detection vehicle；The monitor camera mating connection monitor；The prison
Visual organ is included positioned at the monitor of driver's cabin and/or the monitor positioned at vehicle-mounted manipulation position and/or remote controler and/or remotely monitor
Device and/or mobile phone.
10. a kind of exploratory heading detection method, it is characterised in that：The exploratory heading detection method is used to detect the exploratory heading in detection zone
Position and/or diameter, including following processing steps：
S1) block-by-blocks traversal detection zone；One angle in self-test region starts, every time one detection subregion of detection, the inspection
The length of survey subregion, width are set greater than exploratory heading diameter, make a detection subregion can only be there are one complete exploratory heading；Row
Interior two adjacent detection subregion overlapping at least half of exploratory heading diameters, 2 rows overlapping at least half of exploratory heading diameter；It is adjacent in row
Two row detection subregion overlapping at least half of exploratory heading diameter；After one detection subregion detection, it is moved to next in row
Detect subregion；After a line detects, next line is detected；
S2) measures the distance data matrix for obtaining detection subregion；It detects in subregion and is detected at one, according to advance
The ranks spacing (be smaller than exploratory heading diameter 1/5th) of the test point of setting determines the test point in detection zone
Position；Each test point is measured to the distance of ground detection, obtains the distance data matrix of detection zone；
S3) detects exploratory heading edge point, the label exploratory heading edge point in exploratory heading candidate edge point marks matrix A；At following son
Reason：
S3.1) (exploratory heading candidate edge point marks matrix A to the label of removal exploratory heading candidates edge point label matrix A all elements
Line number, columns are consistent with distance data matrix)；
S3.2) calculates the distance between all row or column consecutive points in distance data matrix difference one by one；
S3.3) finds out candidate exploratory heading edge point：Judge whether the absolute value of the distance difference is more than or more than or equal to setting
Threshold value if it is, thinking that the corresponding test point of 2 points in a pair of consecutive points is candidate exploratory heading edge point, is waited in exploratory heading
The position of correspondence this 2 points in edge point label matrix A is selected to make marks；
S4) looks for exploratory heading, and the exploratory heading found out is recorded in exploratory heading set in exploratory heading candidate edge point marks matrix A；Packet
Include following subprocessing：
S4.1) replicates exploratory heading candidate edge point and marks matrix A to exploratory heading edge point traversal label matrix B；
S4.2) removes label (line number of exploratory heading edge point label Matrix C, the row of exploratory heading edge point label Matrix C all elements
Number is as exploratory heading candidate edge point label matrix A)；
S4.3) looks for first edge point of exploratory heading：In exploratory heading edge point traverses label matrix B, first is looked for by row or column traversal
A markd element (being denoted as P)；It finds, it is believed that find an edge point of doubtful exploratory heading, the point traversal label at exploratory heading edge
Remove the corresponding labels of point P in matrix B, the corresponding labels of mark point P in exploratory heading edge point marks Matrix C；It does not find, it is believed that
There is no exploratory heading in the region, go to step S5；
S4.4) looks for the adjacent side of exploratory heading along point：In exploratory heading edge point traverses label matrix B, centered on point P, row or column
Range points P distances search next markd element (being denoted as P2) in the range of a points of x (presetting)；It finds, is visiting
Remove the corresponding labels of point P2 in hole edge point traversal label matrix B, mark point P is corresponded in exploratory heading edge point marks Matrix C
Label, record P be equal to P2, go to step S4.4；It does not find, goes to step S4.5；
Whether the exploratory heading that S4.5) judgements are found is complete：In exploratory heading candidate edge point marks matrix A, centered on point P,
Row or column range points P searches next markd element in the range of x point；It finds, it is believed that complete exploratory heading is found,
Go to step S4.6；It does not find, it is believed that is found is incomplete exploratory heading, goes to step S4.2 and looks for next exploratory heading；
S4.6) calculates diameter, the center point coordinate of exploratory heading：Markd in exploratory heading edge point label Matrix C is calculated successively
It anticipates a bit, to the maximum distance (being denoted as L) between remaining markd point and corresponding 2 points (being denoted as P1, P3) of maximum distance；
Whether within the preset range to judge L, if, it is believed that find exploratory heading, it is believed that the central point of exploratory heading is in point P1, P3
The midpoint of line calculates the position of exploratory heading central point；If not, go to step S4.2；
S4.7) the location information of the exploratory heading is recorded in exploratory heading set；
S5) coordinate transforms:According to the coordinate of exploratory heading detection device, coordinate transform is carried out to exploratory heading center point coordinate, obtains exploratory heading
Central point relative to exploratory heading detection device origin coordinate；
S6) coordinate transforms two:According to the coordinate for the exploratory heading automatic detection vehicle that vehicle carried pick device obtains, exploratory heading central point is sat
Mark or exploratory heading central point carry out coordinate transform relative to the coordinate of exploratory heading detection device origin, obtain exploratory heading central point relative to spy
The coordinate of hole automatic detection vehicle origin.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201611261183.8A CN108267796A (en) | 2016-12-30 | 2016-12-30 | A kind of exploratory heading automatic detection vehicle |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201611261183.8A CN108267796A (en) | 2016-12-30 | 2016-12-30 | A kind of exploratory heading automatic detection vehicle |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN108267796A true CN108267796A (en) | 2018-07-10 |
Family
ID=62754915
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201611261183.8A Withdrawn CN108267796A (en) | 2016-12-30 | 2016-12-30 | A kind of exploratory heading automatic detection vehicle |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN108267796A (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109271724A (en) * | 2018-09-28 | 2019-01-25 | 安徽芯核防务装备技术股份有限公司 | A kind of inflammable volatile substance of bus dynamic monitors sensor arrangement method |
-
2016
- 2016-12-30 CN CN201611261183.8A patent/CN108267796A/en not_active Withdrawn
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109271724A (en) * | 2018-09-28 | 2019-01-25 | 安徽芯核防务装备技术股份有限公司 | A kind of inflammable volatile substance of bus dynamic monitors sensor arrangement method |
| CN109271724B (en) * | 2018-09-28 | 2022-10-14 | 安徽芯核防务装备技术股份有限公司 | Bus dynamic inflammable volatile substance monitoring sensor arrangement method |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107390676B (en) | Tunnel inspection robot and tunnel inspection system | |
| CN106774318B (en) | Multi-agent interactive environment perception and path planning motion system | |
| CN108549370A (en) | Collecting method and harvester | |
| KR20180125943A (en) | A method for performing a power supply process between at least one power supply and a plurality of vehicles to be powered | |
| CN210310341U (en) | Railway traffic rolling stock inspection robot | |
| EP4137832A1 (en) | Method and apparatus for establishing effective magnetic connection | |
| CN111487964A (en) | Robot trolley and autonomous obstacle avoidance method and device thereof | |
| CN112519800A (en) | Self-checking system for unmanned vehicle | |
| CN115599103A (en) | Explosion-proof intelligent inspection robot system for petrochemical field | |
| CN204575561U (en) | A kind of machine vision surface detection apparatus | |
| CN112720443A (en) | Inspection robot and control device and inspection method thereof | |
| CN111325944A (en) | Vehicle parking flameout detection system | |
| CN108267796A (en) | A kind of exploratory heading automatic detection vehicle | |
| CN209888849U (en) | Auxiliary device for rail transit rolling stock inspection | |
| CN108267788A (en) | A kind of exploratory heading detections of radar vehicle | |
| CN108267794A (en) | A kind of exploratory heading Image detection aircraft | |
| CN206818887U (en) | A kind of exploratory heading detections of radar car | |
| CN108267080A (en) | A kind of exploratory heading Image detection vehicle | |
| CN115188091B (en) | Unmanned aerial vehicle gridding inspection system and method integrating power transmission and transformation equipment | |
| CN111800992A (en) | Refrigeration equipment control method, device, equipment and computer readable storage medium | |
| CN108267079A (en) | A kind of automatic sense aircraft of exploratory heading | |
| CN108267732A (en) | A kind of exploratory heading detections of radar aircraft | |
| CN108267120A (en) | A kind of exploratory heading photography detection device | |
| CN108267793A (en) | A kind of exploratory heading automatic detection device | |
| CN115256398A (en) | Indoor multifunctional operation robot of transformer substation |
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 | ||
| WW01 | Invention patent application withdrawn after publication |
Application publication date: 20180710 |
|
| WW01 | Invention patent application withdrawn after publication |