CN105644455B - A kind of full-automatic wheeled manned device with environment sensing ability - Google Patents
A kind of full-automatic wheeled manned device with environment sensing ability Download PDFInfo
- Publication number
- CN105644455B CN105644455B CN201610089156.0A CN201610089156A CN105644455B CN 105644455 B CN105644455 B CN 105644455B CN 201610089156 A CN201610089156 A CN 201610089156A CN 105644455 B CN105644455 B CN 105644455B
- Authority
- CN
- China
- Prior art keywords
- radar
- millimetre
- wave radar
- target
- wave
- 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.)
- Expired - Fee Related
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
- B60R11/00—Arrangements for holding or mounting articles, not otherwise provided for
- B60R11/02—Arrangements for holding or mounting articles, not otherwise provided for for radio sets, television sets, telephones, or the like; Arrangement of controls thereof
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
- B60R11/00—Arrangements for holding or mounting articles, not otherwise provided for
- B60R2011/0042—Arrangements for holding or mounting articles, not otherwise provided for characterised by mounting means
- B60R2011/008—Adjustable or movable supports
- B60R2011/0092—Adjustable or movable supports with motorization
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Mechanical Engineering (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
The invention discloses a kind of full-automatic wheeled manned devices with environment sensing ability, including man carrier and the millimetre-wave radar three-dimensional environment sensory perceptual system on man carrier；Millimetre-wave radar three-dimensional environment sensory perceptual system includes millimetre-wave radar, rotation mechanism, control unit and data processing unit；Rotation mechanism includes the first rotary shaft, rotating disk and the second rotary shaft.This full-automatic wheeled manned device is simple and practical in structure, can realize that front is scanned without dead angle and cover, and has many advantages, such as that control is accurate, setting accuracy is high, real-time is good.
Description
Technical field
The present invention relates to carrying fields, and in particular to a kind of full-automatic wheeled manned device with environment sensing ability.
Background technology
Broad street has driven urban development, is provided a convenient for the trip of people, with the development of science and technology, traffic intelligence
The concept of energyization is suggested, also more and more to the research of intelligent vehicle.
The major function of intelligent vehicle context aware systems is to obtain vehicle and environmental information by sensor, specially
Lane line and the recognition and tracking on lane side edge in the pose and state information acquisition of vehicle, structuring highway, traffic sign and
The recognition and tracking of traffic signals, the recognition and tracking of vehicle periphery barrier are (including dynamic and static-obstacle thing, such as row
People, obstacle vehicle etc.) and vehicle running surface traffic analysis etc..
Manned device refers mainly to man carrier as a kind of mobility service equipment, intelligent vehicle environment sense is arranged on it
It is current inevitable development trend to know system to improve the comprehensive performances such as its safety, multifunction.But present environment sensing
Often there is the problems such as perception dimension is insufficient, computational accuracy is not high, real-time is not strong in system.
Invention content
In view of the above-mentioned problems, the present invention provides a kind of full-automatic wheeled manned device with environment sensing ability.
The purpose of the present invention is realized using following technical scheme：
A kind of full-automatic wheeled manned device with environment sensing ability, including man carrier and on man carrier
Millimetre-wave radar three-dimensional environment sensory perceptual system；Millimetre-wave radar three-dimensional environment sensory perceptual system includes millimetre-wave radar, rotating machinery
Device, control unit and data processing unit；Rotation mechanism includes the first rotary shaft, rotating disk and the second rotary shaft, the
One rotary shaft vertically arrangement and it is affixed with the center of rotating disk, first rotary shaft pass through the first stepper motor driving rotation；
It is sleeved in bearing block by the second rotation axis horizontal of the second stepper motor driving rotation, the bearing block passes through 2 vertical cloth
The support shaft set is affixed on the rotating pan；The midpoint of second rotary shaft is provided with interconnecting piece, the interconnecting piece perpendicular to
It second rotary shaft and is integrally formed with the second rotary shaft, millimetre-wave radar is vertical with interconnecting piece affixed；The millimetre-wave radar
Itself intrinsic plane of scanning motion is perpendicular to plane where rotating disk, and scanning range angle is ± 30 °；The rotating disk is supported in arrangement
There is notch in the side of axis, and the straight line parallel where notch is in the straight line where the second rotary shaft, and any support shaft and notch institute
It is less than 50mm in the distance of straight line；First stepper motor and the second stepper motor are controlled by microcontroller, microcontroller
For receiving control command, and signal is sent to motor in order to control by control command conversion, while according to the initial position of device
The goniometer turned over two stepper motors calculates the current location of rotation mechanism, and by the present bit of rotation mechanism
Feedback of status is set to data processing unit；Before the rotation mechanism is integrally under the drive of the first stepper motor towards vehicle
Do the period back and forth movement of 180 ° of level into direction, at the same millimetre-wave radar under the drive of the second stepper motor towards vehicle before
Vertical 180 ° of period back and forth movement is done into direction；
Data processing unit includes data acquisition unit, delay revise subelemen and coordinate output subelement；Data are adopted
Collection subelement receives the distance value ρ of itself and target that millimetre-wave radar measurement obtains, while receiving the vertical rotation of microcontroller transmission
Itself scan angle theta of corner α and horizontal rotation angle beta and millimetre-wave radar；If millimetre-wave radar is to the reading of a certain target
(ρ, α, β, θ), and define：α=0 ° when radar is horizontal, when radar is horizontal top, α values are just thunder
It is negative up to α values when being horizontal lower section, radar is worked as in β=0 ° when the second rotary shaft is vertical with direction immediately ahead of man carrier
β is positive value when positioned at the right side of β=0 °, and when radar is located at the left side of β=0 °, β is negative value；When itself sweeping for millimetre-wave radar
θ=0 ° when plane where retouching direction and millimetre-wave radar is vertical, when itself scanning direction is located at the top of θ=0 °, θ is positive value,
When itself scanning direction is located at the lower section of θ=0 °, θ is negative value；
Preferably, delay revise subelemen includes range measurement correcting module, horizontal sweep correcting module and vertical scanning
Correcting module：Range measurement correcting module, the measured value for the value ρ that adjusts the distance, which be directed in detections of radar wave two-way process, to be prolonged
The amendment of Shi Xiaoying, the modifying factor exported are：
When | α1+θ1| ＞ | α2+θ2| and | β1| ＞ | β2| when, above formula takes positive sign, otherwise takes negative sign；
Vertical scanning correcting module, for vertical rotary angle α imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | α1| ＞ | α2| when, above formula takes positive sign, otherwise takes
Negative sign；
Horizontal sweep correcting module, for rotating horizontally angle beta imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | β1| ＞ | β2| when, above formula takes positive sign, otherwise
Take negative sign；
Wherein m is the maximum detectable range of millimetre-wave radar, and ρ≤m；For reaction detection target and millimeter wave thunder
Influence of the distance to delay effect between reaching, target be then delayed closer to radar it is smaller, otherwise delay it is bigger；t1For to the target
The time that detections of radar wave is sent out, t2The time returned for detections of radar wave；|t1-t2| it represents detections of radar wave and travels to and fro between mesh
Time needed between mark and radar；T1For the horizontal rotation period of millimetre-wave radar, T2For the vertical revolution of millimetre-wave radar
Phase；α1For t1When α values, α2For t2When α values；β1For t1When β value, β2For t2When β value；θ1For t1When θ values, θ2For t2When
θ values；T1=2s, T2The sampling interval of=2.4s, millimetre-wave radar are 2 °/s；
Coordinate exports subelement：The object space coordinate exported after being delayed revise subelemen amendment is：
Wherein,
Data processing unit further includes that target RCS fluctuation characteristics measure subelement, for the RCS sequence variations system to target
Number measures：
For being in the complex target of optical region, it is assumed that be made of N number of scattering center, then multi-scattering centers targets
RCS is expressed as the function of azimuth of target：
Wherein, σiIndicate that i-th of scattering center RCS, α+θ indicates target with respect to the azimuth of millimetre-wave radar, RiIndicate the
I scattering center is with respect to radar center distance；λ is the parameter being manually set；
Then RCS sequence variations coefficient is expressed as：Wherein σ (k) indicates kth time detection
The RCS values of target, RCS serial means
This manned device's has the beneficial effect that：New millimetre-wave radar three-dimensional environment sensory perceptual system is devised, to realize
180 ° of front horizontal and being scanned without dead angle for 180 ° of vertical direction cover, and economy and durability simple in structure, strong antijamming capability；Profit
Other components are coordinated to realize Automatic Control function with step-by-step motor, it is easy to control accurate；For new-type rotating radar system
The characteristics of system and delay effect devise range measurement correcting module, horizontal sweep correcting module, vertical scanning correcting module
Equal correcting modules so that the coordinate setting function of radar is more accurate, and real-time is stronger；Give accurate coordinate calculating side
Method provides the foundation to automatically control with control errors；For the Novel rotary mechanical device, uses new RCS and play volt
Property measuring device so that the measurement of the RCS coefficient of variation is more accurate, more advantageous to target identification；The components such as rotating disk, rotary shaft
Size can flexibly choose as the case may be, the applicability for various different size of manned devices provides condition；With milli
Metre wave radar replaces traditional light wave radar, and decaying when being propagated using atmospheric window is small, is influenced by natural light and infrared source
It is small, road pavement effectively identification and avoiding barrier can be carried out under atrocious weather situation, reliable guarantor is provided for safety traffic
Barrier has the superiority such as high resolution, high-precision, miniature antenna bore.
Description of the drawings
Using attached drawing, the invention will be further described, but the embodiment in attached drawing does not constitute any limit to the present invention
System, for those of ordinary skill in the art, without creative efforts, can also obtain according to the following drawings
Other attached drawings.
Fig. 1 is a kind of structure diagram of the full-automatic wheeled manned device with environment sensing ability；
Fig. 2 is the structural schematic diagram of rotation mechanism；
Fig. 3 is millimetre-wave radar itself scanning schematic diagram；
Schematic diagram when Fig. 4 is detections of radar target；
Fig. 5 is the structure diagram of data processing unit.
Reference numeral：Millimetre-wave radar -1；Rotating disk -2；First rotary shaft -3；Second rotary shaft -4；Bearing block -5；Branch
Support axis -6；Interconnecting piece -7；First stepper motor -8；Second stepper motor -9；Rotation mechanism -10；Control unit -11；Number
According to processing unit -12；Data acquisition unit 13；Be delayed revise subelemen -14；Coordinate exports subelement -15；Notch -16；Mesh
Mark -17；Vehicle forward direction -18.
Specific implementation mode
The invention will be further described with the following Examples.
Embodiment 1：
A kind of full-automatic wheeled manned device with environment sensing ability as shown in Figs 1-4, including man carrier and peace
Millimetre-wave radar three-dimensional environment sensory perceptual system on man carrier；Millimetre-wave radar three-dimensional environment sensory perceptual system includes millimeter wave
Radar 1, rotation mechanism 10, control unit 11 and data processing unit 12；Rotation mechanism packet 10 includes the first rotary shaft
3, rotating disk 2 and the second rotary shaft 4, arrangement and, first rotation affixed with the center of rotating disk 2 vertically of the first rotary shaft 3
Axis 3 is driven by the first stepper motor 8 to be rotated；By 4 horizontal set of the second rotary shaft of the second stepper motor 9 driving rotation in axis
In bearing 5, the bearing block 5 is fixed in by 2 support shafts arranged vertically 6 in rotating disk 2；Second rotary shaft 4
Midpoint is provided with interconnecting piece 7, and the interconnecting piece 7 is integrally formed perpendicular to the second rotary shaft 4 and with the second rotary shaft 4, millimeter
Wave radar 1 is vertical with interconnecting piece 7 affixed；Itself intrinsic plane of scanning motion of the millimetre-wave radar 1 is flat where rotating disk 2
Face, and scanning range angle is ± 30 °；The rotating disk 2 has notch 16 in the side of arrangement support shaft 6, straight where notch 16
Line is parallel to the straight line where the second rotary shaft 4, and any support shaft 6 is less than 50mm at a distance from 16 place straight line of notch；Institute
It states the first stepper motor 8 and the second stepper motor 9 is controlled by microcontroller, microcontroller is used to receive control command, and will
Signal is sent to motor, while the angle turned over according to the initial position of device and two stepper motors in order to control for control command conversion
Degree calculates the current location of rotation mechanism, and the current position state of rotation mechanism 10 is fed back to data processing
Unit 12；The rotation mechanism 10 is whole to do level under the drive of the first stepper motor 8 towards vehicle forward direction 18
180 ° of period back and forth movement, while millimetre-wave radar 1 is done under the drive of the second stepper motor 9 towards vehicle forward direction 20
Vertical 180 ° of period back and forth movement；
As shown in figure 5, data processing unit 12 includes that data acquisition unit 13, delay revise subelemen 14 and coordinate are defeated
Go out subelement 15, data acquisition unit 13 receives the distance value ρ that millimetre-wave radar 1 measures obtained itself and target, connects simultaneously
The vertical rotary angle α and rotate horizontally angle beta and millimetre-wave radar 1 scan angle theta of itself that microcontroller is sent are received, to obtain
The position of complete millimetre-wave radar data and the plane of scanning motion；As shown in figure 5, setting a certain target 17 that millimetre-wave radar 1 measures
Reading be (ρ, α, β, θ), and define：α=0 ° when millimetre-wave radar 1 is horizontal, when millimetre-wave radar 1 is in water
α values are that just, α values are negative when millimetre-wave radar 1 is horizontal lower section when prosposition sets top；When the second rotary shaft 4 with it is manned
β=0 ° when direction is vertical immediately ahead of vehicle, when millimetre-wave radar 1 is located at the right side of β=0 °, β is positive value, when millimetre-wave radar 1
β is negative value when the left side of β=0 °；When itself scanning direction of millimetre-wave radar 1 is vertical with 1 place plane of millimetre-wave radar
θ=0 °, when itself scanning direction is located at the top of θ=0 °, θ is positive value, the θ when itself scanning direction is located at the lower section of θ=0 °
For negative value.The rotation angle β of the first rotary shaft 3 is 1 rotation angle in the horizontal direction of millimetre-wave radar as shown in Figure 3.
Preferably, delay effect refers to, since the present apparatus is using the technical solution of three dimensionality dual rotary, in thunder
Up to detection wave during be issued to return, the position of radar has occurred that certain offset, although this period is very short,
But when rotary speed is higher, the error of this part is still very important, this is that the present apparatus is filled with the detection of other fixed radars
Set different place, it is therefore necessary to introduce dedicated delay correction factor.Delay revise subelemen 14 is repaiied including range measurement
Positive module, horizontal sweep correcting module and vertical scanning correcting module：Range measurement correcting module, the survey for the value ρ that adjusts the distance
Magnitude carries out the amendment for delay effect in detections of radar wave two-way process, and the modifying factor of output is：
When | α1+θ1| ＞ | α2+θ2| and | β1| ＞ | β2| when, illustrate that the rotation of device is towards the direction movement of target point
, the actual value measured at this time is less than normal, therefore above formula uses positive sign, at this time λρ＞ 1, on the contrary use negative sign, at this time λρ＜ 1；Meanwhile
Due to t1-t2It is the value of a very little, therefore the specific correction value of this correcting module depends entirely on the swing circle T of motor, rotation
Turn faster T it is smaller, then correction factor with 1 absolute value of the difference it is bigger, it is on the contrary then smaller.
Vertical scanning correcting module, for vertical rotary angle α imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | α1| ＞ | α2| when, above formula takes positive sign, otherwise takes
Negative sign；
Horizontal sweep correcting module, for rotating horizontally angle beta imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | β1| ＞ | β2| when, above formula takes positive sign, otherwise
Take negative sign；
Wherein m is the maximum detectable range of millimetre-wave radar 1, and ρ≤m；For reaction detection target 17 and millimeter wave
Influence of the distance to delay effect between radar 1, target 17 be then delayed closer to millimetre-wave radar 1 it is smaller, otherwise delay it is bigger；
t1For the time sent out to the 17 detections of radar wave of target, t2For detections of radar wave return time, then | t1-t2| represent thunder
The time required between target 17 and millimetre-wave radar 1 is travelled to and fro between up to detection wave；t1For the horizontal rotation week of millimetre-wave radar 1
Phase, t2For the vertical swing circle of millimetre-wave radar 1；α1For t1When α values, α2For t2When α values；β1For t1When β value, β2For
t2When β value；θ1For t1When θ values, θ2For t2When θ values；T1=2s, T2=2.4s, sampling interval of millimetre-wave radar is 2 °/
s。
Coordinate exports subelement 15：The object space coordinate exported after being delayed revise subelemen amendment is：
Wherein,
Data processing unit further includes that target RCS fluctuation characteristics measure subelement, for the RCS sequence variations system to target
Number measures, and radar cross section (RCS) value characterizes the ability of reception antenna direction target echo, by measuring target
RCS fluctuation characteristics, which can compare, determines different target types.
For being in the complex target of optical region, it is assumed that it is made of N number of scattering center, it can according to radar scattering theory
Know, radar return can regard the echo Vector modulation of multi-scattering centers as, the sight due to each scattering center with respect to radar
Angle is different so that in Vector modulation, respective relative phase changes the fluctuations for leading to echo signal amplitude, RCS at random
Value, which follows, also there are fluctuations.Therefore radar target RCS changes very sensitive, target RCS time sequences to the attitude angle of target
Row are substantially variable quantities of the RCS with azimuth of target, are a relief volumes, then the RCS of multi-scattering centers target is expressed as mesh
Mark azimuthal function：
Wherein, σiIndicate that i-th of scattering center RCS, α+θ indicates target with respect to the azimuth of millimetre-wave radar, RiIndicate the
I scattering center is with respect to radar center distance；λ is the parameter being manually set；
Then RCS sequence variations coefficient is expressed as：Wherein σ (k) indicates kth time detection
The RCS values of target, RCS serial meansSequence variations coefficient and azimuth are inputted as characteristic parameter
Target identification system is the identification completed to target.
In this embodiment, it is that manned device devises new millimetre-wave radar three-dimensional environment sensory perceptual system, to realize
180 ° of front horizontal and being scanned without dead angle for 180 ° of vertical direction cover, and economy and durability simple in structure, strong antijamming capability；Profit
Other components are coordinated to realize Automatic Control function with step-by-step motor, it is easy to control accurate；For new-type rotating radar system
The characteristics of system and delay effect devise range measurement correcting module, horizontal sweep correcting module, vertical scanning correcting module
Equal correcting modules so that the coordinate setting function of radar is more accurate, and T is arranged1=2s, T2=2.4s, between the sampling of millimetre-wave radar
It is divided into 2 °/s, is realizing that measurement error is less than 1% while detection without dead angle, is measuring delay rate and be less than 0.5%, and real-time
It is stronger；Accurate Coordinate calculation method is given, is provided the foundation with control errors to automatically control；It makes a connection for the novel rotary
Tool device uses new RCS fluctuation characteristic measuring devices so that the measurement of the RCS coefficient of variation is more accurate, to target identification
It is more advantageous；The size of the components such as rotating disk, rotary shaft can flexibly be chosen as the case may be, be various different size of manned dresses
The applicability set provides condition；Replace traditional light wave radar, decaying when being propagated using atmospheric window with millimetre-wave radar
It is small, it is influenced by natural light and infrared source small, road pavement can effectively be identified under atrocious weather situation and hide barrier
Hinder object, provides reliable guarantee for safety traffic, there are the superiority such as high resolution, high-precision, miniature antenna bore, achieve imaginary
Less than effect.
Embodiment 2：
A kind of full-automatic wheeled manned device with environment sensing ability as shown in Figs 1-4, including man carrier and peace
Millimetre-wave radar three-dimensional environment sensory perceptual system on man carrier；Millimetre-wave radar three-dimensional environment sensory perceptual system includes millimeter wave
Radar 1, rotation mechanism 10, control unit 11 and data processing unit 12；Rotation mechanism packet 10 includes the first rotary shaft
3, rotating disk 2 and the second rotary shaft 4, arrangement and, first rotation affixed with the center of rotating disk 2 vertically of the first rotary shaft 3
Axis 3 is driven by the first stepper motor 8 to be rotated；By 4 horizontal set of the second rotary shaft of the second stepper motor 9 driving rotation in axis
In bearing 5, the bearing block 5 is fixed in by 2 support shafts arranged vertically 6 in rotating disk 2；Second rotary shaft 4
Midpoint is provided with interconnecting piece 7, and the interconnecting piece 7 is integrally formed perpendicular to the second rotary shaft 4 and with the second rotary shaft 4, millimeter
Wave radar 1 is vertical with interconnecting piece 7 affixed；Itself intrinsic plane of scanning motion of the millimetre-wave radar 1 is flat where rotating disk 2
Face, and scanning range angle is ± 30 °；The rotating disk 2 has notch 16 in the side of arrangement support shaft 6, straight where notch 16
Line is parallel to the straight line where the second rotary shaft 4, and any support shaft 6 is less than 50mm at a distance from 16 place straight line of notch；Institute
It states the first stepper motor 8 and the second stepper motor 9 is controlled by microcontroller, microcontroller is used to receive control command, and will
Signal is sent to motor, while the angle turned over according to the initial position of device and two stepper motors in order to control for control command conversion
Degree calculates the current location of rotation mechanism, and the current position state of rotation mechanism 10 is fed back to data processing
Unit 12；The rotation mechanism 10 is whole to do level under the drive of the first stepper motor 8 towards vehicle forward direction 18
180 ° of period back and forth movement, while millimetre-wave radar 1 is done under the drive of the second stepper motor 9 towards vehicle forward direction 20
Vertical 180 ° of period back and forth movement；
As shown in figure 5, data processing unit 12 includes that data acquisition unit 13, delay revise subelemen 14 and coordinate are defeated
Go out subelement 15, data acquisition unit 13 receives the distance value ρ that millimetre-wave radar 1 measures obtained itself and target, connects simultaneously
The vertical rotary angle α and rotate horizontally angle beta and millimetre-wave radar 1 scan angle theta of itself that microcontroller is sent are received, to obtain
The position of complete millimetre-wave radar data and the plane of scanning motion；As shown in figure 5, setting a certain target 17 that millimetre-wave radar 1 measures
Reading be (ρ, α, β, θ), and define：α=0 ° when millimetre-wave radar 1 is horizontal, when millimetre-wave radar 1 is in water
α values are that just, α values are negative when millimetre-wave radar 1 is horizontal lower section when prosposition sets top；When the second rotary shaft 4 with it is manned
β=0 ° when direction is vertical immediately ahead of vehicle, when millimetre-wave radar 1 is located at the right side of β=0 °, β is positive value, when millimetre-wave radar 1
β is negative value when the left side of β=0 °；When itself scanning direction of millimetre-wave radar 1 is vertical with 1 place plane of millimetre-wave radar
θ=0 °, when itself scanning direction is located at the top of θ=0 °, θ is positive value, the θ when itself scanning direction is located at the lower section of θ=0 °
For negative value.The rotation angle β of the first rotary shaft 3 is 1 rotation angle in the horizontal direction of millimetre-wave radar as shown in Figure 3.
Preferably, delay effect refers to, since the present apparatus is using the technical solution of three dimensionality dual rotary, in thunder
Up to detection wave during be issued to return, the position of radar has occurred that certain offset, although this period is very short,
But when rotary speed is higher, the error of this part is still very important, this is that the present apparatus is filled with the detection of other fixed radars
Set different place, it is therefore necessary to introduce dedicated delay correction factor.Delay revise subelemen 14 is repaiied including range measurement
Positive module, horizontal sweep correcting module and vertical scanning correcting module：Range measurement correcting module, the survey for the value ρ that adjusts the distance
Magnitude carries out the amendment for delay effect in detections of radar wave two-way process, and the modifying factor of output is：
When | α1+θ1| ＞ | α2+θ2| and | β1| ＞ | β2| when, illustrate that the rotation of device is towards the direction movement of target point
, the actual value measured at this time is less than normal, therefore above formula uses positive sign, at this time λρ＞ 1, on the contrary use negative sign, at this time λρ＜ 1；Meanwhile
Due to t1-t2It is the value of a very little, therefore the specific correction value of this correcting module depends entirely on the swing circle T of motor, rotation
Turn faster T it is smaller, then correction factor with 1 absolute value of the difference it is bigger, it is on the contrary then smaller.
Vertical scanning correcting module, for vertical rotary angle α imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | α1| ＞ | α2| when, above formula takes positive sign, otherwise takes
Negative sign；
Horizontal sweep correcting module, for rotating horizontally angle beta imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | β1| ＞ | β2| when, above formula takes positive sign, otherwise
Take negative sign；
Wherein m is the maximum detectable range of millimetre-wave radar 1, and ρ≤m；For reaction detection target 17 and millimeter wave
Influence of the distance to delay effect between radar 1, target 17 be then delayed closer to millimetre-wave radar 1 it is smaller, otherwise delay it is bigger；
t1For the time sent out to the 17 detections of radar wave of target, t2For detections of radar wave return time, then | t1-t2| represent thunder
The time required between target 17 and millimetre-wave radar 1 is travelled to and fro between up to detection wave；t1For the horizontal rotation week of millimetre-wave radar 1
Phase, t2For the vertical swing circle of millimetre-wave radar 1；α1For t1When α values, α2For t2When α values；β1For t1When β value, β2For
t2When β value；θ1For t1When θ values, θ2For t2When θ values；T1=2s, T2=2.4s, sampling interval of millimetre-wave radar is 2 °/
s。
Coordinate exports subelement 15：The object space coordinate exported after being delayed revise subelemen amendment is：
Wherein,
Data processing unit further includes that target RCS fluctuation characteristics measure subelement, for the RCS sequence variations system to target
Number measures, and radar cross section (RCS) value characterizes the ability of reception antenna direction target echo, by measuring target
RCS fluctuation characteristics, which can compare, determines different target types.
For being in the complex target of optical region, it is assumed that it is made of N number of scattering center, it can according to radar scattering theory
Know, radar return can regard the echo Vector modulation of multi-scattering centers as, the sight due to each scattering center with respect to radar
Angle is different so that in Vector modulation, respective relative phase changes the fluctuations for leading to echo signal amplitude, RCS at random
Value, which follows, also there are fluctuations.Therefore radar target RCS changes very sensitive, target RCS time sequences to the attitude angle of target
Row are substantially variable quantities of the RCS with azimuth of target, are a relief volumes, then the RCS of multi-scattering centers target is expressed as mesh
Mark azimuthal function：
Wherein, σiIndicate that i-th of scattering center RCS, α+θ indicates target with respect to the azimuth of millimetre-wave radar, RiIndicate the
I scattering center is with respect to radar center distance；λ is the parameter being manually set；
Then RCS sequence variations coefficient is expressed as：Wherein σ (k) indicates kth time detection
The RCS values of target, RCS serial meansSequence variations coefficient and azimuth are inputted as characteristic parameter
Target identification system is the identification completed to target.
In this embodiment, it is that manned device devises new millimetre-wave radar three-dimensional environment sensory perceptual system, to realize
180 ° of front horizontal and being scanned without dead angle for 180 ° of vertical direction cover, and economy and durability simple in structure, strong antijamming capability；Profit
Other components are coordinated to realize Automatic Control function with step-by-step motor, it is easy to control accurate；For new-type rotating radar system
The characteristics of system and delay effect devise range measurement correcting module, horizontal sweep correcting module, vertical scanning correcting module
Equal correcting modules so that the coordinate setting function of radar is more accurate, and T is arranged1=2.2s, T2=2.6s, the sampling of millimetre-wave radar
Between be divided into 1.5 °/s, realizing that measurement error is less than 0.8% while detection without dead angle, measuring delay rate less than 0.4%, and
Real-time is stronger；Accurate Coordinate calculation method is given, is provided the foundation with control errors to automatically control；It is novel for this
Rotation mechanism uses new RCS fluctuation characteristic measuring devices so that the measurement of the RCS coefficient of variation is more accurate, to mesh
Mark is not more advantageous；The size of the components such as rotating disk, rotary shaft can flexibly be chosen as the case may be, be various different size of
The applicability of manned device provides condition；Replace traditional light wave radar with millimetre-wave radar, when being propagated using atmospheric window
Decaying it is small, influenced by natural light and infrared source it is small, can under atrocious weather situation road pavement carry out effectively identification simultaneously
Avoiding barrier provides reliable guarantee for safety traffic, has the superiority such as high resolution, high-precision, miniature antenna bore, obtains
Unexpected effect.
Embodiment 3：
A kind of full-automatic wheeled manned device with environment sensing ability as shown in Figs 1-4, including man carrier and peace
Millimetre-wave radar three-dimensional environment sensory perceptual system on man carrier；Millimetre-wave radar three-dimensional environment sensory perceptual system includes millimeter wave
Radar 1, rotation mechanism 10, control unit 11 and data processing unit 12；Rotation mechanism packet 10 includes the first rotary shaft
3, rotating disk 2 and the second rotary shaft 4, arrangement and, first rotation affixed with the center of rotating disk 2 vertically of the first rotary shaft 3
Axis 3 is driven by the first stepper motor 8 to be rotated；By 4 horizontal set of the second rotary shaft of the second stepper motor 9 driving rotation in axis
In bearing 5, the bearing block 5 is fixed in by 2 support shafts arranged vertically 6 in rotating disk 2；Second rotary shaft 4
Midpoint is provided with interconnecting piece 7, and the interconnecting piece 7 is integrally formed perpendicular to the second rotary shaft 4 and with the second rotary shaft 4, millimeter
Wave radar 1 is vertical with interconnecting piece 7 affixed；Itself intrinsic plane of scanning motion of the millimetre-wave radar 1 is flat where rotating disk 2
Face, and scanning range angle is ± 30 °；The rotating disk 2 has notch 16 in the side of arrangement support shaft 6, straight where notch 16
Line is parallel to the straight line where the second rotary shaft 4, and any support shaft 6 is less than 50mm at a distance from 16 place straight line of notch；Institute
It states the first stepper motor 8 and the second stepper motor 9 is controlled by microcontroller, microcontroller is used to receive control command, and will
Signal is sent to motor, while the angle turned over according to the initial position of device and two stepper motors in order to control for control command conversion
Degree calculates the current location of rotation mechanism, and the current position state of rotation mechanism 10 is fed back to data processing
Unit 12；The rotation mechanism 10 is whole to do level under the drive of the first stepper motor 8 towards vehicle forward direction 18
180 ° of period back and forth movement, while millimetre-wave radar 1 is done under the drive of the second stepper motor 9 towards vehicle forward direction 20
Vertical 180 ° of period back and forth movement；
As shown in figure 5, data processing unit 12 includes that data acquisition unit 13, delay revise subelemen 14 and coordinate are defeated
Go out subelement 15, data acquisition unit 13 receives the distance value ρ that millimetre-wave radar 1 measures obtained itself and target, connects simultaneously
The vertical rotary angle α and rotate horizontally angle beta and millimetre-wave radar 1 scan angle theta of itself that microcontroller is sent are received, to obtain
The position of complete millimetre-wave radar data and the plane of scanning motion；As shown in figure 5, setting a certain target 17 that millimetre-wave radar 1 measures
Reading be (ρ, α, β, θ), and define：α=0 ° when millimetre-wave radar 1 is horizontal, when millimetre-wave radar 1 is in water
α values are that just, α values are negative when millimetre-wave radar 1 is horizontal lower section when prosposition sets top；When the second rotary shaft 4 with it is manned
β=0 ° when direction is vertical immediately ahead of vehicle, when millimetre-wave radar 1 is located at the right side of β=0 °, β is positive value, when millimetre-wave radar 1
β is negative value when the left side of β=0 °；When itself scanning direction of millimetre-wave radar 1 is vertical with 1 place plane of millimetre-wave radar
θ=0 °, when itself scanning direction is located at the top of θ=0 °, θ is positive value, the θ when itself scanning direction is located at the lower section of θ=0 °
For negative value.The rotation angle β of the first rotary shaft 3 is 1 rotation angle in the horizontal direction of millimetre-wave radar as shown in Figure 3.
Preferably, delay effect refers to, since the present apparatus is using the technical solution of three dimensionality dual rotary, in thunder
Up to detection wave during be issued to return, the position of radar has occurred that certain offset, although this period is very short,
But when rotary speed is higher, the error of this part is still very important, this is that the present apparatus is filled with the detection of other fixed radars
Set different place, it is therefore necessary to introduce dedicated delay correction factor.Delay revise subelemen 14 is repaiied including range measurement
Positive module, horizontal sweep correcting module and vertical scanning correcting module：Range measurement correcting module, the survey for the value ρ that adjusts the distance
Magnitude carries out the amendment for delay effect in detections of radar wave two-way process, and the modifying factor of output is：
When | α1+θ1| ＞ | α2+θ2| and | β1| ＞ | β2| when, illustrate that the rotation of device is towards the direction movement of target point
, the actual value measured at this time is less than normal, therefore above formula uses positive sign, at this time λρ＞ 1, on the contrary use negative sign, at this time λρ＜ 1；Meanwhile
Due to t1-t2It is the value of a very little, therefore the specific correction value of this correcting module depends entirely on the swing circle T of motor, rotation
Turn faster T it is smaller, then correction factor with 1 absolute value of the difference it is bigger, it is on the contrary then smaller.
Vertical scanning correcting module, for vertical rotary angle α imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | α1| ＞ | α2| when, above formula takes positive sign, otherwise takes
Negative sign；
Horizontal sweep correcting module, for rotating horizontally angle beta imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | β1| ＞ | β2| when, above formula takes positive sign, otherwise
Take negative sign；
Wherein m is the maximum detectable range of millimetre-wave radar 1, and ρ≤m；For reaction detection target 17 and millimeter wave
Influence of the distance to delay effect between radar 1, target 17 be then delayed closer to millimetre-wave radar 1 it is smaller, otherwise delay it is bigger；
t1For the time sent out to the 17 detections of radar wave of target, t2For detections of radar wave return time, then | t1-t2| represent thunder
The time required between target 17 and millimetre-wave radar 1 is travelled to and fro between up to detection wave；t1For the horizontal rotation week of millimetre-wave radar 1
Phase, t2For the vertical swing circle of millimetre-wave radar 1；α1For t1When α values, α2For t2When α values；β1For t1When β value, β2For
t2When β value；θ1For t1When θ values, θ2For t2When θ values；T1=2s, T2=2.4s, sampling interval of millimetre-wave radar is 2 °/
s。
Coordinate exports subelement 15：The object space coordinate exported after being delayed revise subelemen amendment is：
Wherein,
Data processing unit further includes that target RCS fluctuation characteristics measure subelement, for the RCS sequence variations system to target
Number measures, and radar cross section (RCS) value characterizes the ability of reception antenna direction target echo, by measuring target
RCS fluctuation characteristics, which can compare, determines different target types.
For being in the complex target of optical region, it is assumed that it is made of N number of scattering center, it can according to radar scattering theory
Know, radar return can regard the echo Vector modulation of multi-scattering centers as, the sight due to each scattering center with respect to radar
Angle is different so that in Vector modulation, respective relative phase changes the fluctuations for leading to echo signal amplitude, RCS at random
Value, which follows, also there are fluctuations.Therefore radar target RCS changes very sensitive, target RCS time sequences to the attitude angle of target
Row are substantially variable quantities of the RCS with azimuth of target, are a relief volumes, then the RCS of multi-scattering centers target is expressed as mesh
Mark azimuthal function：
Wherein, σiIndicate that i-th of scattering center RCS, α+θ indicates target with respect to the azimuth of millimetre-wave radar, RiIndicate the
I scattering center is with respect to radar center distance；λ is the parameter being manually set；
Then RCS sequence variations coefficient is expressed as：Wherein σ (k) indicates kth time detection
The RCS values of target, RCS serial meansSequence variations coefficient and azimuth are inputted as characteristic parameter
Target identification system is the identification completed to target.
In this embodiment, it is that manned device devises new millimetre-wave radar three-dimensional environment sensory perceptual system, to realize
180 ° of front horizontal and being scanned without dead angle for 180 ° of vertical direction cover, and economy and durability simple in structure, strong antijamming capability；Profit
Other components are coordinated to realize Automatic Control function with step-by-step motor, it is easy to control accurate；For new-type rotating radar system
The characteristics of system and delay effect devise range measurement correcting module, horizontal sweep correcting module, vertical scanning correcting module
Equal correcting modules so that the coordinate setting function of radar is more accurate, and T is arranged1=2.4s, T2=2.7s, the sampling of millimetre-wave radar
Between be divided into 1.8 °/s, realizing that measurement error is less than 0.7% while detection without dead angle, measuring delay rate less than 0.4%, and
Real-time is stronger；Accurate Coordinate calculation method is given, is provided the foundation with control errors to automatically control；It is novel for this
Rotation mechanism uses new RCS fluctuation characteristic measuring devices so that the measurement of the RCS coefficient of variation is more accurate, to mesh
Mark is not more advantageous；The size of the components such as rotating disk, rotary shaft can flexibly be chosen as the case may be, be various different size of
The applicability of manned device provides condition；Replace traditional light wave radar with millimetre-wave radar, when being propagated using atmospheric window
Decaying it is small, influenced by natural light and infrared source it is small, can under atrocious weather situation road pavement carry out effectively identification simultaneously
Avoiding barrier provides reliable guarantee for safety traffic, has the superiority such as high resolution, high-precision, miniature antenna bore, obtains
Unexpected effect.
Embodiment 4：
A kind of full-automatic wheeled manned device with environment sensing ability as shown in Figs 1-4, including man carrier and peace
Millimetre-wave radar three-dimensional environment sensory perceptual system on man carrier；Millimetre-wave radar three-dimensional environment sensory perceptual system includes millimeter wave
Radar 1, rotation mechanism 10, control unit 11 and data processing unit 12；Rotation mechanism packet 10 includes the first rotary shaft
3, rotating disk 2 and the second rotary shaft 4, arrangement and, first rotation affixed with the center of rotating disk 2 vertically of the first rotary shaft 3
Axis 3 is driven by the first stepper motor 8 to be rotated；By 4 horizontal set of the second rotary shaft of the second stepper motor 9 driving rotation in axis
In bearing 5, the bearing block 5 is fixed in by 2 support shafts arranged vertically 6 in rotating disk 2；Second rotary shaft 4
Midpoint is provided with interconnecting piece 7, and the interconnecting piece 7 is integrally formed perpendicular to the second rotary shaft 4 and with the second rotary shaft 4, millimeter
Wave radar 1 is vertical with interconnecting piece 7 affixed；Itself intrinsic plane of scanning motion of the millimetre-wave radar 1 is flat where rotating disk 2
Face, and scanning range angle is ± 30 °；The rotating disk 2 has notch 16 in the side of arrangement support shaft 6, straight where notch 16
Line is parallel to the straight line where the second rotary shaft 4, and any support shaft 6 is less than 50mm at a distance from 16 place straight line of notch；Institute
It states the first stepper motor 8 and the second stepper motor 9 is controlled by microcontroller, microcontroller is used to receive control command, and will
Signal is sent to motor, while the angle turned over according to the initial position of device and two stepper motors in order to control for control command conversion
Degree calculates the current location of rotation mechanism, and the current position state of rotation mechanism 10 is fed back to data processing
Unit 12；The rotation mechanism 10 is whole to do level under the drive of the first stepper motor 8 towards vehicle forward direction 18
180 ° of period back and forth movement, while millimetre-wave radar 1 is done under the drive of the second stepper motor 9 towards vehicle forward direction 20
Vertical 180 ° of period back and forth movement；
As shown in figure 5, data processing unit 12 includes that data acquisition unit 13, delay revise subelemen 14 and coordinate are defeated
Go out subelement 15, data acquisition unit 13 receives the distance value ρ that millimetre-wave radar 1 measures obtained itself and target, connects simultaneously
The vertical rotary angle α and rotate horizontally angle beta and millimetre-wave radar 1 scan angle theta of itself that microcontroller is sent are received, to obtain
The position of complete millimetre-wave radar data and the plane of scanning motion；As shown in figure 5, setting a certain target 17 that millimetre-wave radar 1 measures
Reading be (ρ, α, β, θ), and define：α=0 ° when millimetre-wave radar 1 is horizontal, when millimetre-wave radar 1 is in water
α values are that just, α values are negative when millimetre-wave radar 1 is horizontal lower section when prosposition sets top；When the second rotary shaft 4 with it is manned
β=0 ° when direction is vertical immediately ahead of vehicle, when millimetre-wave radar 1 is located at the right side of β=0 °, β is positive value, when millimetre-wave radar 1
β is negative value when the left side of β=0 °；When itself scanning direction of millimetre-wave radar 1 is vertical with 1 place plane of millimetre-wave radar
θ=0 °, when itself scanning direction is located at the top of θ=0 °, θ is positive value, the θ when itself scanning direction is located at the lower section of θ=0 °
For negative value.The rotation angle β of the first rotary shaft 3 is 1 rotation angle in the horizontal direction of millimetre-wave radar as shown in Figure 3.
Preferably, delay effect refers to, since the present apparatus is using the technical solution of three dimensionality dual rotary, in thunder
Up to detection wave during be issued to return, the position of radar has occurred that certain offset, although this period is very short,
But when rotary speed is higher, the error of this part is still very important, this is that the present apparatus is filled with the detection of other fixed radars
Set different place, it is therefore necessary to introduce dedicated delay correction factor.Delay revise subelemen 14 is repaiied including range measurement
Positive module, horizontal sweep correcting module and vertical scanning correcting module：Range measurement correcting module, the survey for the value ρ that adjusts the distance
Magnitude carries out the amendment for delay effect in detections of radar wave two-way process, and the modifying factor of output is：
When | α1+θ1| ＞ | α2+θ2| and | β1| ＞ | β2| when, illustrate that the rotation of device is towards the direction movement of target point
, the actual value measured at this time is less than normal, therefore above formula uses positive sign, at this time λρ＞ 1, on the contrary use negative sign, at this time λρ＜ 1；Meanwhile
Due to t1-t2It is the value of a very little, therefore the specific correction value of this correcting module depends entirely on the swing circle T of motor, rotation
Turn faster T it is smaller, then correction factor with 1 absolute value of the difference it is bigger, it is on the contrary then smaller.
Vertical scanning correcting module, for vertical rotary angle α imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | α1| ＞ | α2| when, above formula takes positive sign, otherwise takes
Negative sign；
Horizontal sweep correcting module, for rotating horizontally angle beta imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | β1| ＞ | β2| when, above formula takes positive sign, otherwise
Take negative sign；
Wherein m is the maximum detectable range of millimetre-wave radar 1, and ρ≤m；For reaction detection target 17 and millimeter wave
Influence of the distance to delay effect between radar 1, target 17 be then delayed closer to millimetre-wave radar 1 it is smaller, otherwise delay it is bigger；
t1For the time sent out to the 17 detections of radar wave of target, t2For detections of radar wave return time, then | t1-t2| represent thunder
The time required between target 17 and millimetre-wave radar 1 is travelled to and fro between up to detection wave；t1For the horizontal rotation week of millimetre-wave radar 1
Phase, t2For the vertical swing circle of millimetre-wave radar 1；α1For t1When α values, α2For t2When α values；β1For t1When β value, β2For
t2When β value；θ1For t1When θ values, θ2For t2When θ values；T1=2s, T2=2.4s, sampling interval of millimetre-wave radar is 2 °/
s。
Coordinate exports subelement 15：The object space coordinate exported after being delayed revise subelemen amendment is：
Wherein,
Data processing unit further includes that target RCS fluctuation characteristics measure subelement, for the RCS sequence variations system to target
Number measures, and radar cross section (RCS) value characterizes the ability of reception antenna direction target echo, by measuring target
RCS fluctuation characteristics, which can compare, determines different target types.
For being in the complex target of optical region, it is assumed that it is made of N number of scattering center, it can according to radar scattering theory
Know, radar return can regard the echo Vector modulation of multi-scattering centers as, the sight due to each scattering center with respect to radar
Angle is different so that in Vector modulation, respective relative phase changes the fluctuations for leading to echo signal amplitude, RCS at random
Value, which follows, also there are fluctuations.Therefore radar target RCS changes very sensitive, target RCS time sequences to the attitude angle of target
Row are substantially variable quantities of the RCS with azimuth of target, are a relief volumes, then the RCS of multi-scattering centers target is expressed as mesh
Mark azimuthal function：
Wherein, σiIndicate that i-th of scattering center RCS, α+θ indicates target with respect to the azimuth of millimetre-wave radar, RiIndicate the
I scattering center is with respect to radar center distance；λ is the parameter being manually set；
Then RCS sequence variations coefficient is expressed as：Wherein σ (k) indicates kth time detection
The RCS values of target, RCS serial meansSequence variations coefficient and azimuth are inputted as characteristic parameter
Target identification system is the identification completed to target.
In this embodiment, it is that manned device devises new millimetre-wave radar three-dimensional environment sensory perceptual system, to realize
180 ° of front horizontal and being scanned without dead angle for 180 ° of vertical direction cover, and economy and durability simple in structure, strong antijamming capability；Profit
Other components are coordinated to realize Automatic Control function with step-by-step motor, it is easy to control accurate；For new-type rotating radar system
The characteristics of system and delay effect devise range measurement correcting module, horizontal sweep correcting module, vertical scanning correcting module
Equal correcting modules so that the coordinate setting function of radar is more accurate, and T is arranged1=2.5s, T2=2.8s, the sampling of millimetre-wave radar
Between be divided into 1.3 °/s.It is realizing that measurement error is less than 0.6% while detection without dead angle, is measuring delay rate less than 0.3%, and
Real-time is stronger；Accurate Coordinate calculation method is given, is provided the foundation with control errors to automatically control；It is novel for this
Rotation mechanism uses new RCS fluctuation characteristic measuring devices so that the measurement of the RCS coefficient of variation is more accurate, to mesh
Mark is not more advantageous；The size of the components such as rotating disk, rotary shaft can flexibly be chosen as the case may be, be various different size of
The applicability of manned device provides condition；Replace traditional light wave radar with millimetre-wave radar, when being propagated using atmospheric window
Decaying it is small, influenced by natural light and infrared source it is small, can under atrocious weather situation road pavement carry out effectively identification simultaneously
Avoiding barrier provides reliable guarantee for safety traffic, has the superiority such as high resolution, high-precision, miniature antenna bore, obtains
Unexpected effect.
Embodiment 5：
A kind of full-automatic wheeled manned device with environment sensing ability as shown in Figs 1-4, including man carrier and peace
Millimetre-wave radar three-dimensional environment sensory perceptual system on man carrier；Millimetre-wave radar three-dimensional environment sensory perceptual system includes millimeter wave
Radar 1, rotation mechanism 10, control unit 11 and data processing unit 12；Rotation mechanism packet 10 includes the first rotary shaft
3, rotating disk 2 and the second rotary shaft 4, arrangement and, first rotation affixed with the center of rotating disk 2 vertically of the first rotary shaft 3
Axis 3 is driven by the first stepper motor 8 to be rotated；By 4 horizontal set of the second rotary shaft of the second stepper motor 9 driving rotation in axis
In bearing 5, the bearing block 5 is fixed in by 2 support shafts arranged vertically 6 in rotating disk 2；Second rotary shaft 4
Midpoint is provided with interconnecting piece 7, and the interconnecting piece 7 is integrally formed perpendicular to the second rotary shaft 4 and with the second rotary shaft 4, millimeter
Wave radar 1 is vertical with interconnecting piece 7 affixed；Itself intrinsic plane of scanning motion of the millimetre-wave radar 1 is flat where rotating disk 2
Face, and scanning range angle is ± 30 °；The rotating disk 2 has notch 16 in the side of arrangement support shaft 6, straight where notch 16
Line is parallel to the straight line where the second rotary shaft 4, and any support shaft 6 is less than 50mm at a distance from 16 place straight line of notch；Institute
It states the first stepper motor 8 and the second stepper motor 9 is controlled by microcontroller, microcontroller is used to receive control command, and will
Signal is sent to motor, while the angle turned over according to the initial position of device and two stepper motors in order to control for control command conversion
Degree calculates the current location of rotation mechanism, and the current position state of rotation mechanism 10 is fed back to data processing
Unit 12；The rotation mechanism 10 is whole to do level under the drive of the first stepper motor 8 towards vehicle forward direction 18
180 ° of period back and forth movement, while millimetre-wave radar 1 is done under the drive of the second stepper motor 9 towards vehicle forward direction 20
Vertical 180 ° of period back and forth movement；
As shown in figure 5, data processing unit 12 includes that data acquisition unit 13, delay revise subelemen 14 and coordinate are defeated
Go out subelement 15, data acquisition unit 13 receives the distance value ρ that millimetre-wave radar 1 measures obtained itself and target, connects simultaneously
The vertical rotary angle α and rotate horizontally angle beta and millimetre-wave radar 1 scan angle theta of itself that microcontroller is sent are received, to obtain
The position of complete millimetre-wave radar data and the plane of scanning motion；As shown in figure 5, setting a certain target 17 that millimetre-wave radar 1 measures
Reading be (ρ, α, β, θ), and define：α=0 ° when millimetre-wave radar 1 is horizontal, when millimetre-wave radar 1 is in water
α values are that just, α values are negative when millimetre-wave radar 1 is horizontal lower section when prosposition sets top；When the second rotary shaft 4 with it is manned
β=0 ° when direction is vertical immediately ahead of vehicle, when millimetre-wave radar 1 is located at the right side of β=0 °, β is positive value, when millimetre-wave radar 1
β is negative value when the left side of β=0 °；When itself scanning direction of millimetre-wave radar 1 is vertical with 1 place plane of millimetre-wave radar
θ=0 °, when itself scanning direction is located at the top of θ=0 °, θ is positive value, the θ when itself scanning direction is located at the lower section of θ=0 °
For negative value.The rotation angle β of the first rotary shaft 3 is 1 rotation angle in the horizontal direction of millimetre-wave radar as shown in Figure 3.
Preferably, delay effect refers to, since the present apparatus is using the technical solution of three dimensionality dual rotary, in thunder
Up to detection wave during be issued to return, the position of radar has occurred that certain offset, although this period is very short,
But when rotary speed is higher, the error of this part is still very important, this is that the present apparatus is filled with the detection of other fixed radars
Set different place, it is therefore necessary to introduce dedicated delay correction factor.Delay revise subelemen 14 is repaiied including range measurement
Positive module, horizontal sweep correcting module and vertical scanning correcting module：Range measurement correcting module, the survey for the value ρ that adjusts the distance
Magnitude carries out the amendment for delay effect in detections of radar wave two-way process, and the modifying factor of output is：
When | α1+θ1| ＞ | α2+θ2| and | β1| ＞ | β2| when, illustrate that the rotation of device is towards the direction movement of target point
, the actual value measured at this time is less than normal, therefore above formula uses positive sign, at this time λρ＞ 1, on the contrary use negative sign, at this time λρ＜ 1；Meanwhile
Due to t1-t2It is the value of a very little, therefore the specific correction value of this correcting module depends entirely on the swing circle T of motor, rotation
Turn faster T it is smaller, then correction factor with 1 absolute value of the difference it is bigger, it is on the contrary then smaller.
Vertical scanning correcting module, for vertical rotary angle α imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | α1| ＞ | α2| when, above formula takes positive sign, otherwise takes
Negative sign；
Horizontal sweep correcting module, for rotating horizontally angle beta imitate for being delayed in detections of radar wave two-way process
The amendment answered, the modifying factor of outputWhen | β1| ＞ | β2| when, above formula takes positive sign, otherwise
Take negative sign；
Wherein m is the maximum detectable range of millimetre-wave radar 1, and ρ≤m；For reaction detection target 17 and millimeter wave
Influence of the distance to delay effect between radar 1, target 17 be then delayed closer to millimetre-wave radar 1 it is smaller, otherwise delay it is bigger；
t1For the time sent out to the 17 detections of radar wave of target, t2For detections of radar wave return time, then | t1-t2| represent thunder
The time required between target 17 and millimetre-wave radar 1 is travelled to and fro between up to detection wave；t1For the horizontal rotation week of millimetre-wave radar 1
Phase, t2For the vertical swing circle of millimetre-wave radar 1；α1For t1When α values, α2For t2When α values；β1For t1When β value, β2For
t2When β value；θ1For t1When θ values, θ2For t2When θ values；T1=2s, T2=2.4s, sampling interval of millimetre-wave radar is 2 °/
s。
Coordinate exports subelement 15：The object space coordinate exported after being delayed revise subelemen amendment is：
Wherein,
Data processing unit further includes that target RCS fluctuation characteristics measure subelement, for the RCS sequence variations system to target
Number measures, and radar cross section (RCS) value characterizes the ability of reception antenna direction target echo, by measuring target
RCS fluctuation characteristics, which can compare, determines different target types.
For being in the complex target of optical region, it is assumed that it is made of N number of scattering center, it can according to radar scattering theory
Know, radar return can regard the echo Vector modulation of multi-scattering centers as, the sight due to each scattering center with respect to radar
Angle is different so that in Vector modulation, respective relative phase changes the fluctuations for leading to echo signal amplitude, RCS at random
Value, which follows, also there are fluctuations.Therefore radar target RCS changes very sensitive, target RCS time sequences to the attitude angle of target
Row are substantially variable quantities of the RCS with azimuth of target, are a relief volumes, then the RCS of multi-scattering centers target is expressed as mesh
Mark azimuthal function：
Wherein, σiIndicate that i-th of scattering center RCS, α+θ indicates target with respect to the azimuth of millimetre-wave radar, RiIndicate the
I scattering center is with respect to radar center distance；λ is the parameter being manually set；
Then RCS sequence variations coefficient is expressed as：Wherein σ (k) indicates kth time detection
The RCS values of target, RCS serial meansSequence variations coefficient and azimuth are inputted as characteristic parameter
Target identification system is the identification completed to target.
In this embodiment, it is that manned device devises new millimetre-wave radar three-dimensional environment sensory perceptual system, to realize
180 ° of front horizontal and being scanned without dead angle for 180 ° of vertical direction cover, and economy and durability simple in structure, strong antijamming capability；Profit
Other components are coordinated to realize Automatic Control function with step-by-step motor, it is easy to control accurate；For new-type rotating radar system
The characteristics of system and delay effect devise range measurement correcting module, horizontal sweep correcting module, vertical scanning correcting module
Equal correcting modules so that the coordinate setting function of radar is more accurate, T1=2.6s, T2=2.9s, the sampling interval of millimetre-wave radar
For 1.2 °/s, is realizing that measurement error is less than 0.5% while detection without dead angle, measuring delay rate and be less than 0.2%, and in real time
Property is stronger；Accurate Coordinate calculation method is given, is provided the foundation with control errors to automatically control；For the Novel rotary
Mechanical device uses new RCS fluctuation characteristic measuring devices so that the measurement of the RCS coefficient of variation is more accurate, knows to target
It is more not advantageous；The size of the components such as rotating disk, rotary shaft can flexibly be chosen as the case may be, be various different size of manned
The applicability of device provides condition；Replace traditional light wave radar, declining when being propagated using atmospheric window with millimetre-wave radar
Reduce, influenced by natural light and infrared source small, road pavement effectively can be identified and be hidden under atrocious weather situation
Barrier provides reliable guarantee for safety traffic, has the superiority such as high resolution, high-precision, miniature antenna bore, achieve meaning
Unimaginable effect.
Finally it should be noted that the above embodiments are merely illustrative of the technical solutions of the present invention, rather than the present invention is protected
The limitation of range is protected, although being explained in detail to the present invention with reference to preferred embodiment, those skilled in the art answer
Work as understanding, technical scheme of the present invention can be modified or replaced equivalently, without departing from the reality of technical solution of the present invention
Matter and range.
Claims (1)
1. a kind of full-automatic wheeled manned device with environment sensing ability, characterized in that including man carrier and mounted on load
Millimetre-wave radar three-dimensional environment sensory perceptual system on people's vehicle；Millimetre-wave radar three-dimensional environment sensory perceptual system include millimetre-wave radar,
Rotation mechanism, control unit and data processing unit；Rotation mechanism includes the first rotary shaft, rotating disk and the second rotation
Shaft, the first rotary shaft vertically arrangement and it is affixed with the center of rotating disk, first rotary shaft is driven by the first stepper motor
Dynamic rotation；It is sleeved in bearing block by the second rotation axis horizontal of the second stepper motor driving rotation, the bearing block passes through 2
The support shaft arranged vertically is affixed on the rotating pan；The midpoint of second rotary shaft is provided with interconnecting piece, the interconnecting piece
It is integrally formed perpendicular to the second rotary shaft and with the second rotary shaft, millimetre-wave radar is vertical with interconnecting piece affixed；The millimeter wave
Itself intrinsic plane of scanning motion of radar is perpendicular to plane where rotating disk, and scanning range angle is ± 30 °；The rotating disk is in cloth
There is notch in the side for setting support shaft, the straight line parallel where notch in the straight line where the second rotary shaft, and any support shaft with
The distance of straight line is less than 50mm where notch；First stepper motor and the second stepper motor are controlled by microcontroller,
Microcontroller is for receiving control command, and signal is sent to motor in order to control by control command conversion, while according to the first of device
Beginning position and the goniometer that turns over of two stepper motors calculate the current location of rotation mechanism, and by rotation mechanism
Current position state feeds back to data processing unit；The rotation mechanism it is whole under the drive of the first stepper motor towards
Vehicle forward direction does the period back and forth movement of 180 ° of level, at the same millimetre-wave radar under the drive of the second stepper motor towards
Vehicle forward direction does vertical 180 ° of period back and forth movement；
Data processing unit includes data acquisition unit, delay revise subelemen and coordinate output subelement；Data acquisition
Unit receives the distance value ρ of itself and target that millimetre-wave radar measurement obtains, while receiving the vertical rotary angle α of microcontroller transmission
With itself scan angle theta for rotating horizontally angle beta and millimetre-wave radar；If millimetre-wave radar be to the reading of a certain target (ρ, α,
β, θ), and define：α=0 ° when radar is horizontal, when radar is horizontal top, α values are just, at radar
α values are negative when below horizontal position, β=0 ° when the second rotary shaft is vertical with direction immediately ahead of man carrier, when radar is located at β
β is positive value when=0 ° of right side, and when radar is located at the left side of β=0 °, β is negative value；When itself scanning direction of millimetre-wave radar
θ=0 ° when vertical with plane where millimetre-wave radar, when itself scanning direction is located at the top of θ=0 °, θ is positive value, when itself
θ is negative value when scanning direction is located at the lower section of θ=0 °；
The revise subelemen that is delayed includes range measurement correcting module, horizontal sweep correcting module and vertical scanning correcting module：Away from
From correcting module is measured, the measured value for the value ρ that adjusts the distance be directed to delay effect in detections of radar wave two-way process and repaiies
Just, the modifying factor of output is：
When | α1+θ1| ＞ | α2+θ2| and | β1| ＞ | β2| when, above formula takes positive sign, otherwise takes negative sign；
Vertical scanning correcting module, for carrying out vertical rotary angle α for delay effect in detections of radar wave two-way process
It corrects, the modifying factor of outputWhen | α1| ＞ | α2| when, above formula takes positive sign, otherwise takes negative
Number；
Horizontal sweep correcting module, for being carried out for delay effect in detections of radar wave two-way process to rotating horizontally angle beta
It corrects, the modifying factor of outputWhen | β1| ＞ | β2| when, above formula takes positive sign, otherwise takes negative
Number；
Wherein m is the maximum detectable range of millimetre-wave radar, and ρ≤m；For reaction detection target and millimetre-wave radar it
Between influence of the distance to delay effect, target be then delayed closer to radar it is smaller, otherwise delay it is bigger；t1For to the target radar
The time that detection wave is sent out, t2The time returned for detections of radar wave；|t1-t2| represent detections of radar wave travel to and fro between target and
Time needed between radar；T1For the horizontal rotation period of millimetre-wave radar, T2For the vertical swing circle of millimetre-wave radar；
α1For t1When α values, α2For t2When α values；β1For t1When β value, β2For t2When β value；θ1For t1When θ values, θ2For t2When θ
Value；T1=2s, T2The sampling interval of=2.4s, millimetre-wave radar are 2 °/s；
Coordinate exports subelement：The object space coordinate exported after being delayed revise subelemen amendment is：
Wherein,
Data processing unit further includes that target RCS fluctuation characteristics measure subelement, for the RCS sequence variations coefficient of target into
Row measures：
For being in the complex target of optical region, it is assumed that be made of N number of scattering center, then the RCS tables of multi-scattering centers target
It is shown as the function of azimuth of target：
Wherein, σiIndicate that i-th of scattering center RCS, α+θ indicates target with respect to the azimuth of millimetre-wave radar, RiIt indicates i-th
Scattering center is with respect to radar center distance；λ is the parameter being manually set；
Then RCS sequence variations coefficient is expressed as：Wherein σ (k) indicates kth time detection target
RCS values, RCS serial means
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610089156.0A CN105644455B (en) | 2016-02-17 | 2016-02-17 | A kind of full-automatic wheeled manned device with environment sensing ability |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610089156.0A CN105644455B (en) | 2016-02-17 | 2016-02-17 | A kind of full-automatic wheeled manned device with environment sensing ability |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN105644455A CN105644455A (en) | 2016-06-08 |
| CN105644455B true CN105644455B (en) | 2018-10-02 |
Family
ID=56489635
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610089156.0A Expired - Fee Related CN105644455B (en) | 2016-02-17 | 2016-02-17 | A kind of full-automatic wheeled manned device with environment sensing ability |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN105644455B (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107992043A (en) * | 2017-12-12 | 2018-05-04 | 太仓鼎诚电子科技有限公司 | Obstacle avoidance system based on single rotary ultrasonic wave sensor |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN201259544Y (en) * | 2008-08-28 | 2009-06-17 | 阮树成 | Millimeter-wave random code PM AM anti-collision radar for ship |
| CN201259546Y (en) * | 2008-08-28 | 2009-06-17 | 阮树成 | Time division multi-channel random code phase modulated anti-collision radar for ship |
| CN101373217B (en) * | 2008-08-28 | 2011-12-28 | 阮树成 | Millimeter wave marine frequency modulation multichannel anti-collision radar |
| JP5293715B2 (en) * | 2010-09-30 | 2013-09-18 | 三菱電機株式会社 | Antenna device |
| CN203398298U (en) * | 2013-08-27 | 2014-01-15 | 中船重工鹏力（南京）大气海洋信息系统有限公司 | A weather radar antenna rotary table |
-
2016
- 2016-02-17 CN CN201610089156.0A patent/CN105644455B/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| CN105644455A (en) | 2016-06-08 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US20240053477A1 (en) | System and method for measuring image distance of power transmission lines with unmanned aerial vehicle (uav) | |
| CN105738900B (en) | A kind of intelligent robot with environment sensing ability | |
| CN207752371U (en) | A kind of robot autonomous navigation device and robot | |
| US4936678A (en) | Position detection system for use with agricultural and construction equipment | |
| CN104914863A (en) | Integrated unmanned motion platform environment understanding system and work method thereof | |
| CN105730649B (en) | A kind of means of water transport with environment sensing ability | |
| CN108919825A (en) | The unmanned plane indoor locating system and method for having barrier avoiding function | |
| CN102707269B (en) | Range walk correction method for airborne radar | |
| CN110146089A (en) | A kind of crusing robot localization method based on Embedded A I computing platform | |
| CN105629236B (en) | A kind of full-automatic wheeled cleaning device with environment sensing ability | |
| CN105607060B (en) | A kind of automatic backing device with identification function | |
| CN105644455B (en) | A kind of full-automatic wheeled manned device with environment sensing ability | |
| CN105605519B (en) | A kind of solar street light with environment sensing ability | |
| CN105717509B (en) | A kind of flight instruments with environment sensing ability | |
| CN105699972B (en) | A kind of full-automatic wheeled load-carrying device with environment sensing ability | |
| CN105660028B (en) | A kind of full-automatic harvesting device with environment sensing ability | |
| CN105652270B (en) | A kind of automatic gate inhibition with identification function | |
| CN105672173B (en) | A kind of zebra stripes Intelligent guardrail with identification function | |
| CN105487075B (en) | A kind of intelligent anticollision warning device with identification function | |
| CN105644456B (en) | A kind of autosteerer with identification function | |
| CN105403886A (en) | Automatic extraction method for airborne SAR scaler image position | |
| CN105699967B (en) | A kind of full-automatic wheeled patrol equipment with environment sensing ability | |
| CN105738901B (en) | A kind of full-automatic wheeled watering device with environment sensing ability | |
| CN105759261B (en) | A kind of automatic slow-down device with identification function | |
| CN105749460B (en) | A kind of full-automatic wheeled extinguishing device with environment sensing ability |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| TA01 | Transfer of patent application right | ||
| TA01 | Transfer of patent application right |
Effective date of registration: 20180823 Address after: 210000 2, B unit 300, Zhihui Road, Kirin science and Technology Innovation Park, Jiangning District, Nanjing, Jiangsu. Applicant after: NANJING CHUQING ELECTRONIC TECHNOLOGY Co.,Ltd. Address before: 315200 No. 555 north tunnel road, Zhenhai District, Ningbo, Zhejiang Applicant before: Chen Yanglong |
|
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| TR01 | Transfer of patent right | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20191104 Address after: No.5 Yongzhi Road, Qinhuai District, Nanjing, Jiangsu Province Patentee after: Jiangsu huiyucheng Intelligent Equipment Research Institute Co.,Ltd. Address before: 210000, Nanjing, Jiangsu province Jiangning Qilin science and Technology Innovation Park, 300 Chi Chi Road, B unit, 2 floor Patentee before: NANJING CHUQING ELECTRONIC TECHNOLOGY Co.,Ltd. |
|
| CF01 | Termination of patent right due to non-payment of annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20181002 Termination date: 20220217 |