CN109765913A - A kind of round-the-clock unmanned cruiser system of two-wheel drive - Google Patents
A kind of round-the-clock unmanned cruiser system of two-wheel drive Download PDFInfo
- Publication number
- CN109765913A CN109765913A CN201910185124.4A CN201910185124A CN109765913A CN 109765913 A CN109765913 A CN 109765913A CN 201910185124 A CN201910185124 A CN 201910185124A CN 109765913 A CN109765913 A CN 109765913A
- Authority
- CN
- China
- Prior art keywords
- cruiser
- single line
- line laser
- laser radar
- radar
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
Abstract
A kind of round-the-clock unmanned cruiser system of two-wheel drive, including cruiser ontology and control system;Cruiser ontology has driving wheel and driven wheel, and a pair of driving wheels is driven by two direct current generators;Direct current generator is connected with planetary reducer;First forward and backward side's environment detection and protection system in control system are mainly made of single line laser radar, single line laser radar and CCD camera;Second forward and backward side's environment detection and protection system are mainly made of two microwave radars;Forward and backward blind area detection and obstacle avoidance system are made of three ultrasonic sensors;Single line laser radar, microwave radar, CCD camera, wireless communication module, wireless communication module and assistant controller are connect with master controller;Ultrasonic sensor and motor driver are connect with assistant controller, and motor driver is connect with two direct current generators respectively.The system stability, reliability and cost performance are high, and calculation process speed is fast, and flexibility is high, and can successfully manage bad weather.
Description
Technical field
The invention belongs to unmanned technical fields, and in particular to a kind of round-the-clock unmanned cruiser system of two-wheel drive
System.
Background technique
As the speed of modernization construction is accelerated, supermarket, large pier, International airport, various conference and exhibition centers, large size
The quantity and scale in the places such as logistics warehouse, saloon bar, hospital are continuously increased, various large size residence districts and playground day
Benefit increases, and mankind's activity and logistics transportation etc. become increasingly complex, and a large amount of human and material resources and security resource is needed to ensure this
System safe operation.Current security technology is mainly based on manpower patrol and CCD camera locating and monitoring, both modes are
It is not able to satisfy the security demand of existing large-scale complex environment, is gone on patrol using the security of safety protection robot substitution mankind's patrol automatic
Change system can solve the matter of great urgency at the moment, because security patrol automated system not only can be further improved security system
Stability, safety and real-time, and can effectively save cost of labor.
Unmanned cruiser can perceive environment and this by sensor as a kind of novel special security class robot
Body state simultaneously realizes avoidance, shuttles in bustling crowd and various barrier, completes autonomous patrol mission.Nobody
Driving cruiser is timed, pinpoints, uninterrupted mobile monitoring and patrol are that solution security patrol automates best solution
Certainly scheme.Unmanned cruiser system is that environment sensing, dynamic decision, route planning and behaviour control are concentrated on one
Multi-functional composite system, it perceives vehicle-periphery using onboard sensor, and according to perceiving road obtained, patrol
Patrol vehicle location, barrier and suspicious danger information, control the steering and speed of vehicle, thus enable the vehicle to safety, can
It is travelled on patrol path by ground.The crowds such as unmanned cruiser collection automatic control, architecture, artificial intelligence, vision calculating
More technologies are the products of computer science, pattern-recognition and intelligent control technology high development in one, and measure a state
One important symbol of family research strength and industrial level, has broad application prospects in national defence and national economy field.
It is still in infancy currently, Intelligent unattended drives cruiser development, either the intelligent driving of which kind of degree, the
The perception of one step is all primary, that is, perceives unmanned cruiser periphery complex environment, on this basis could
Corresponding path planning and driving behavior decision are made, before the selection of detecting sensor is unmanned cruiser success avoidance
It mentions.Multi-line laser radar is exactly distribution in vertical direction by multiple laser emitters, passes through motor as its name suggests
Rotation forms the scanning of a plurality of harness.Theoretically, certainly harness is more, closeer, just more abundant to environment description, in this way
The requirement of algorithm can also be reduced.3D multi-line laser radar passes through the 3D mould of the available robot of laser scanning
Type can be relatively easy to detect the row around robot with the variation that related algorithm compares previous frame and next frame environment
People and other obstacle informations, while another big characteristic of 3D laser radar is to synchronize to build figure, the global map obtained in real time passes through
It is compared with the characteristic body in high-precision map, the positioning accuracy for navigating and reinforcing robot may be implemented.Multi-line laser radar is visited
It is relatively wide to survey range, a large amount of environment range informations can be provided, biggish convenience can be provided for control decision, the above advantage makes
Obtaining multi-line laser radar becomes a preferential selection of unmanned cruiser perception circumstances not known.
The electromechanics arrangement architecture of general common simple unmanned patrol motor vehicle drive system is as shown in Figure 1.Nobody
It drives cruiser to detect environment by multi-line laser radar sensor detection system and be conveyed to PC machine, then PC machine is by coding
Reason sends control instruction to SCM Based slave computer, and single chip control module sends control instruction after communication decoding
To Direct Current Servo Motor Controller, controller drives two direct current generators movements, and then by being directly connected to direct current generator
Driving wheel drives unmanned cruiser walking;The variation for the peripheral environment that single-chip computer control system is acquired according to laser radar is real
When adjust the movement of direct current generator, and then control the position of unmanned cruiser in the actual environment, CCD camera is responsible for reality
When acquire the image in unmanned cruiser patrol path and stored in real time by PC machine.Existing simple unmanned patrol
Vehicle control is that single multi-line laser radar sensor is controlled by single single-chip microcontroller to realize above-mentioned function.
There is problems for existing unmanned cruiser, mainly have:
(1) due to being influenced by direct current generator feature itself, the volume and weight of direct current generator is relatively large, is unfavorable for nobody
Drive the raising of cruiser dynamic property.
(2) sliding contact of the brush and commutator of direct current generator causes mechanical wear and spark, makes direct current generator
Failure is more, reliability is low, the service life is short, maintenance heavy workload.
(3) since the direct current generator length of cruiser is larger, using the unmanned patrol vehicle width of traditional mechanical structure
It spends larger, some narrow spaces can not be passed through.
(4) existing unmanned cruiser direct current generator is directly mechanically connected with driving wheel, passes through controller tune
The voltage of direct current generator is saved to complete to adjust the speed, although meeting the requirement of the speed of travel, drives entire unmanned patrol
The torque of vehicle is smaller, and the ability for adapting to outdoor rugged and rough road conditions is poor.
(5) existing unmanned cruiser is all made of rudimentary singlechip chip, and working frequency is lower, and only tens
Hertz, it is unable to satisfy the control that unmanned cruiser interferes various complex environments, unmanned cruiser is easily caused and loses
Control.
(6) it is influenced by unmanned cruiser PC machine performance, the environment detection sensor of unmanned cruiser acquires number
According to that quickly can not calculate and store, judgement of the unmanned cruiser to ambient enviroment is affected.
(7) it is influenced by unmanned cruiser PC machine performance, the ccd sensor image acquisition data of unmanned cruiser
Can not real-time perfoming quickly analyze and calculate, master station can only by analysis storage image data could find patrol in asking
Topic.
(8) although 3D data may be implemented in multi-line laser radar, it can be determined that the height of barrier handles the information on ground
Deng, but price is relatively expensive, can not promote the use of a large area.
(9) present unmanned cruiser substantially only considers forward detection and avoidance, does not consider the obstacle at rear
Object information, sometimes the cruiser barrier that rear occurs in reversing can enter unmanned cruiser protection zone, make
At unnecessary injury.
(10) based on the unmanned cruiser of multi-line laser radar in forward movement there is a detection blind area,
Once there is barrier to be in blind area, it is easy to generate traffic accident.
(11) based on the unmanned cruiser of multi-line laser radar actually reversing reverse procedure in also will appear detection it is blind
Area, once traffic accident can also be generated by having barrier to enter movement blind area during the motion.
(12) fast response servo that two axis direct current generators can not be rapidly completed in SCM Based control system is adjusted, and is increased
The adjustment time of unmanned cruiser posture, unmanned cruiser can not quickly walk.
(13) SCM Based lower computer control system will complete the parts of images acquisition process later period by wireless system
Transformation task, by capacity itself, transmission time is longer, and automatic driving car is caused not walk quickly.
(14) existing unmanned cruiser is to realize environment detection by navigation forward sensor, dead when encountering
When lane, u-turn, when centainly encountering small space, unmanned patrol can only be realized by way of rotating in place 180 degree
Vehicle will be unable to realize u-turn, and patrol mission is caused to fail.
(15) laser radar is very sensitive to the weather for having misty rain, and misty rain absorbs terribly, so having laser radar
Rain has the weather of mist, and laser radar performance can be greatly reduced, and causes large effect to the safety of unmanned cruiser.
(16) laser radar is very sensitive to the environment for having smog, and smog absorbs terribly, so having laser radar
Under the operating condition of smog, laser radar performance can be greatly reduced, and cause large effect to the safety of unmanned cruiser.
(17) laser radar is very sensitive to the environment for having dust, and dust absorbs terribly, so having laser radar
Under the operating condition of dust, laser radar performance can be greatly reduced, and cause large effect to the safety of unmanned cruiser.
(18) laser radar is very sensitive to the weather for having strong light, and strong sunlight can sometimes make laser radar performance
It can be greatly reduced, sometimes be exported even without signal, large effect is caused to the safety of unmanned cruiser.
Therefore, it is necessary to carry out weight based on the unmanned cruiser system of monolithic processor controlled multi-line laser radar to existing
New design, seek it is a kind of it is cheap, cost performance is relatively high, the practical of multiclass sensor fusion round-the-clock unmanned is patrolled
Patrol vehicle system.
Summary of the invention
In view of the above existing problems in the prior art, the present invention provides a kind of round-the-clock unmanned cruisers of two-wheel drive
System, which can effectively improve the stability and reliability of unmanned cruiser, and can reduce unmanned cruiser
Frequency of maintenance;The system can effectively improve anti-interference ability, can improve unmanned cruiser and cope with boisterous ability, and
Its with rear detect and barrier avoiding function, detection blind area can be effectively eliminated, make unmanned cruiser walk when safety and
Reliability is higher;The system can effectively shorten unmanned cruiser the pose adjustment time, effectively improve unmanned patrol
The control performance of vehicle effectively improves flexibility and dynamic property that nobody steps up patrols in vehicle motion process, makes unmanned patrol
It patrols the passability of vehicle more preferably and is less prone to slipping phenomenon and unmanned cruiser can be promoted to outdoor rugged and rough road conditions
Adaptability;The system can effectively improve the cost performance of unmanned cruiser, be conducive to the big face of unmanned cruiser
Product is promoted.
To achieve the goals above, the present invention provides a kind of round-the-clock unmanned cruiser system of two-wheel drive, including
Cruiser ontology and the control system being arranged on cruiser ontology;
The cruiser body lower part the middle part of length direction assemble a pair of driving wheels, length direction left part and the right side
Portion is respectively equipped with a pair of driven, and cruiser body interior is equipped with two direct currents for respectively driving two driving wheels
Machine;
The control system include power supply, power conversion module, motor driver, wireless communication module, master controller and
Assistant controller;
The cruiser body interior is additionally provided with two planets being located on the outside of two direct current generator motor shafts and subtracts
Fast machine;The planetary reducer is 90 degree of corner planetary reducers;
The direction that the length direction of two direct current generators prolongs cruiser body width extends, and two direct current generators are vertical
It is arranged at intervals upwards, the motor shaft of two direct current generators is arranged to ground opposite to each other;The direct current generator is rare-earth permanent magnet brushless
DC servo motor, the motor shaft of direct current generator and the input terminal of planetary reducer connect, and the output shaft of planetary reducer passes through
Gear set drives driving wheel;The gear set by being distributed and pitch wheel one and gear two form in the longitudinal direction;It is described
Gear one is set on the output shaft of planetary reducer, and the gear two is set in the shaft at driving wheel center;
The control system further includes the first front environment detection and protection system, the second front environment detection and protection system
System, the first rear environment detection and protection system, the second rear environment detection and protection system, front blind-area detection and avoidance system
System, the detection of rear blind area and obstacle avoidance system and 360 degree of CCD cameras one that cruiser bodies top center is set;
First front environment detection and protection system mainly by single line laser radar L1, single line laser radar L2 and
CCD camera two forms;The forward position of cruiser bodies top is obliquely arranged in the single line laser radar L1 left low and right high
It sets, the single line laser radar L2 is horizontally disposed at the front end of cruiser body lower part, and the setting of CCD camera two is being patrolled
The front of vehicle ontology is patrolled, and close to the center of short transverse;
Second front environment detection and protection system are mainly made of microwave radar M1 and microwave radar M2;It is described micro-
The front of cruiser ontology is arranged in wave radar M1, and between single line laser radar L1 and CCD camera two;The microwave
The front end of the lower part of cruiser ontology is arranged in radar M2, and is located at the lower part of single line laser radar L2;
First rear environment detection and protection system mainly by single line laser radar L3, single line laser radar L4 and
CCD camera three forms;The position of cruiser bodies top rearward is obliquely arranged in the single line laser radar L3 right low left high
It sets, the single line laser radar L4 is horizontally disposed at the rear end of cruiser body lower part, and the setting of CCD camera three is being patrolled
The rear portion of vehicle ontology is patrolled, and close to the center of short transverse;
Second rear environment detection and protection system are mainly made of microwave radar M3 and microwave radar M4;It is described micro-
The front and rear part of cruiser ontology is arranged in wave radar M3, and between single line laser radar L3 and CCD camera three;It is described micro-
The front end of the lower part of cruiser ontology is arranged in wave radar M4, and is located at the lower part of single line laser radar L4;
The front blind-area detection and obstacle avoidance system and the detection of rear blind area and obstacle avoidance system are separately positioned on cruiser ontology
Bottom front and bottom rear end;Front blind-area detection and obstacle avoidance system are made of ultrasonic sensor US1, US2 and US3, wherein surpassing
Sonic sensor US1, US2 and US3 are evenly distributed in the width direction, and rear blind area detection and obstacle avoidance system are by ultrasonic sensor
US4, US5 and US6 composition, wherein ultrasonic sensor US4, US5 and US6 is evenly distributed in the width direction;
Single line laser radar L1~the L4, microwave radar M1~M4, CCD camera one, CCD camera two, CCD camera shooting
Machine three, wireless communication module and assistant controller are connect with master controller;Ultrasonic sensor US1~the US6 and motor drive
Dynamic device is connect with assistant controller, and motor driver is connect with two direct current generators respectively;Power supply respectively with motor driver and
Power conversion module connection, power conversion module is for providing the supply of DC power supply;Wireless communication module is used for by wireless
Mode establishes the communication connection between the master station of distal end.
In the technical scheme, CCD camera one is responsible for the collection of patrol environment, and module is sent out in real time by wireless communication
Give master station.By the first front or behind environment detection and protection system setting can accurately and fast detect front or
It is stepped up patrols vehicle and front or behind moving obstacle so as to effectively detect nobody apart from farther away environmental aspect at rear
Distance;Inclination on roof and for detecting front is provided in first front or behind environment detection and protection system
The single line laser radar of setting and be arranged in lower car body and horizontally disposed single line laser radar, can not only reach multi-thread and swash
The Effect on Detecting of optical radar, the barrier that can effectively detect the unmanned cruiser direction of motion or the position where people, notice
Unmanned patrol vehicle control realizes Emergency avoidance, and low compared to the hardware cost of multi-line laser radar, is conducive to nothing
The popularization of people's driving cruiser practical application.It is provided in first front or behind environment detection and protection system and swashs positioned at single line
CCD camera two or three between optical radar and single line laser radar can not only assist single line laser radar and single line laser radar
Detection and navigation accuracy are improved, video analysis can be also more advantageous to, and on the one hand can find that movement road surface temporarily loses in advance
Small obstacle and moving line in road conditions fluctuating situation, can make realtime graphic obtain performance it is more preferable, can be to unmanned
Cruiser, which advanced optimizes path or regulation power throwing over barrier, has significant help.On the other hand it can effectively detect
The presence of two sides free area, to provide certain help for unmanned cruiser advance turning and avoidance, moreover it is possible to effectively visit
The presence of direction of motion two sides columnar object is measured, to provide certain side to position when unmanned cruiser forward or backward
It helps.By enabling the second front or behind environment detection and the setting of system being protected quickly and accurately to detect front or behind
The short-distance blind section being closer especially is accelerated forwardly in rigid starting or is fallen backward can effectively eliminate unmanned cruiser
The short-distance blind section occurred when vehicle improves the safety and reliability when walking of unmanned cruiser.In addition, the second front
Or rear environment detection and protection system use the microwave radar group positioned at the microwave radar of vehicle body upper portion and positioned at lower car body
At since microwave is the very short radio wave of wavelength, directionality is fine, and speed is equal to the light velocity.It is stood when microwave encounters barrier
It is reflected back, the distance of barrier, and the ability of microwave penetration mist, cigarette, dust can be measured according to electromagnetic wave two-way time
By force, have the characteristics that round-the-clock, round-the-clock can work, in this way once encountering bad weather, system can excise laser radar detection
System relies only on microwave radar systems work, meets the normal patrol work of unmanned cruiser under round-the-clock adverse circumstances,
And then boisterous patrol operation can be successfully managed, but microwave radar is lower relative to lidar measurement precision, therefore,
As the supplement of the first front or behind environment detection and protection system, the detection effect of short-distance blind section can be effectively improved
Fruit.In addition, system has two-way navigation sensor, when encountering blind alley, the mode of 180 degree is not needed to rotate in place to realize
U-turn need to only switch the control logic of front and back group navigation sensor and motor driver, so that it may realize u-turn, increase nobody
It drives cruiser and passes through the flexibility of the ability of small space and patrol operation.Furthermore make master controller to focus on patrol
Image data, single line laser radar signal and the microwave radar signal that the CCD camera of vehicle acquires in real time, receive assistant controller
Processing result from master controller, and handle the feedback signal of ultrasonic sensor group and motor driver is controlled,
The speed of image procossing and multisensor data fusion processing can not only be greatly improved, and the negative of assistant controller can be effectively reduced
Lotus can effectively prevent " run and fly " of motion control main program, so as to make unmanned cruiser anti-interference ability significantly
Enhancing.
Further, the CCD camera two and the equal left low and right high of microwave radar M1 are obliquely arranged;The CCD camera
The equal right low left high of three and microwave radar M3 is obliquely arranged.
In the technical scheme, by the way that CCD camera two and three is arranged obliquely, and make superposed microwave radar
M1 and M3 are obliquely arranged, and can not only more effectively find the fluctuating of road conditions in moving line, moreover it is possible to be more conducive to discovery fortune in advance
The small obstacle that dynamic road surface temporarily loses.
Further, the tilt angle of the single line laser radar L1 and L3 is 5 degree;Single line laser radar L2 and L4 distance
The distance on ground is 15cm~30cm.
In the technical scheme, the tilt angle of single line laser radar L1 and L3 is 5 degree, can not only make single line laser thunder
More effectively cooperate up to L1 and L2, single line laser radar L3 and L4, to effectively improve the detection of equidirectional two single line radars
Effect, and can be conducive to the fluctuating for finding road conditions in moving line in advance by the setting of the tilt angle and move road surface face
When lose small obstacle the case where so that cruiser can make in advance reply reaction, be conducive to improve cruiser went on patrol
Safety and reliability in journey.
Further, the master controller is NUC7 processor;The core of the assistant controller uses STM32F767.
In the technical scheme, make master controller NUC7 processor, assistant controller uses STM32F767, to make to patrol
Patrol pair that the control of vehicle is made of the master system based on vehicle-mounted computer NUC and the ARM lower computer system based on STM32F767
Nuclear control system carries out, wherein being mainly used for working in unmanned cruiser system based on vehicle-mounted computer NUC master system
Measure maximum more single line laser radar signal processings, microwave radar signal processing, ccd image acquisition and analysis and the friendship with master station
Mutual communication simultaneously completes the input in path and map, the processing of each Data Fusion of Sensor;Unmanned cruiser is handled by NUC7
The data fusion of multisensor substantially increases arithmetic speed, and then it is fast to give full play to NUC microcomputer data processing speed
The characteristics of, it solves single arm processor and runs slower bottleneck, shorten that the development cycle is short, and enable the portable of program
Power is stronger.ARM lower computer control system based on STM32F767 is mainly used for the upper of real-time reception NUC microcomputer composition
Machine multisensor digital convergence signal, and realize the reality of the Digital Signal Processing of part, response various interruptions and realization and master station
When data communication and storage.Complete two axis brush DC servo SERVO CONTROLs, the data storage, I/ of unmanned cruiser system
The functions such as O control, blind area detection and avoidance signal processing, image analysis and transmission, can make maximum two axis of workload straight in this way
Stream brushless servo system control gives STM32F767 processing, thus make whole system with STM32F767 kinetic control system at
Core is managed, the very fast advantage of STM32F767 data processing can be given full play to, thereby realize the rational division of work of NUC and ARM,
With the feature that NUC data processing speed can be made full use of fast, a large amount of Multi-sensor Fusion signal and various data are quickly handled
Algorithm process, arm processor is freed from hard work amount effectively, motion control master can be effectively prevented
" run and fly " of program, and can fully consider the interference source of surrounding, significantly enhance the anti-interference energy of unmanned cruiser
Power.Simultaneously between NUC and ARM can real-time perfoming communication and data exchange and the calling of required data between each other, can effectively mention
The environment detection function of high unmanned cruiser.The front and rear of the unmanned cruiser of the present invention is adopted in same position
With identical laser radar, microwave radar, CCD camera and ultrasonic sensor, unmanned cruiser can be realized narrow
The accuracy of small space navigation and the flexibility of u-turn.
Further, as a preference, the model LMS151-10100 of single line laser radar.
Further, in order to realize closed-loop control, so that assistant controller can preferably control the operating condition of driving wheel, it is described
Encoder is connected on driven wheel, the encoder is connect with assistant controller, with for Real-time Feedback cruiser ontology displacement,
Velocity and acceleration.
It further, further include four charging modules, four charging modules point for the ease of charging to cruiser ontology
It is not distributed in the surrounding of cruiser ontology, and connects to power supply, the power supply is battery group.
In view of the above-mentioned problems of the prior art, the present invention also provides a kind of round-the-clock unmanned patrols of two-wheel drive
Vehicle system, which can effectively improve the stability and reliability of unmanned cruiser, and can reduce unmanned cruiser
Frequency of maintenance;The system can improve the control calculation process speed of unmanned cruiser, and can effectively shorten data transmission
Time, make unmanned cruiser rapidly ambient enviroment is accurately judged and have quick walking function;This is
System can effectively improve anti-interference ability, can improve unmanned cruiser and cope with boisterous ability, and it is visited with rear
Survey and barrier avoiding function, can effectively eliminate detection blind area, and safety and reliability when unmanned cruiser being made to walk is higher;It should
System can effectively shorten unmanned cruiser the pose adjustment time, effectively improve unmanned cruiser control performance,
Flexibility and dynamic property that nobody steps up patrols in vehicle motion process are effectively improved, makes the passability of unmanned cruiser more
Well and it is less prone to slipping phenomenon and unmanned cruiser can be promoted to the adaptability of outdoor rugged and rough road conditions;This is
System can effectively improve the cost performance of unmanned cruiser, be conducive to being widely applied for unmanned cruiser.
To achieve the goals above, the present invention provides a kind of round-the-clock unmanned cruiser system of two-wheel drive, including
Cruiser ontology and the control system being arranged on cruiser ontology;
The cruiser body lower part the middle part of length direction assemble a pair of driving wheels, length direction left part and the right side
Portion is respectively equipped with a pair of driven, and cruiser body interior is equipped with two direct currents for respectively driving two driving wheels
Machine;
The control system includes power supply, power conversion module, motor driver, wireless communication module, master controller, auxiliary
Controller one and assistant controller two;
The cruiser body interior is additionally provided with two planets being located on the outside of two direct current generator motor shafts and subtracts
Fast machine;The planetary reducer is 90 degree of corner planetary reducers;
The direction that the length direction of two direct current generators prolongs cruiser body width extends, and two direct current generators are vertical
It is arranged at intervals upwards, the motor shaft of two direct current generators is arranged to ground opposite to each other;The direct current generator is rare-earth permanent magnet brushless
DC servo motor, the motor shaft of direct current generator and the input terminal of planetary reducer connect, and the output shaft of planetary reducer passes through
The shaft at gear set driving driving wheel center;The gear set by being distributed and pitch wheel one and gear two in the longitudinal direction
Composition;The gear one is set on the output shaft of planetary reducer, and the gear two is set in the shaft at driving wheel center;
The control system further includes the first front environment detection and protection system, the second front environment detection and protection system
System, the first rear environment detection and protection system, the second rear environment detection and protection system, front blind-area detection and avoidance system
System, the detection of rear blind area and obstacle avoidance system and 360 degree of CCD cameras one that cruiser bodies top center is set;
First front environment detection and protection system mainly by single line laser radar L1, single line laser radar L2 and
CCD camera two forms;The forward position of cruiser bodies top is obliquely arranged in the single line laser radar L1 left low and right high
It sets, the single line laser radar L2 is horizontally disposed at the front end of cruiser body lower part, and the setting of CCD camera two is being patrolled
The front of vehicle ontology is patrolled, and close to the center of short transverse;
Second front environment detection and protection system are mainly made of microwave radar M1 and microwave radar M2;It is described micro-
The front of cruiser ontology is arranged in wave radar M1, and between single line laser radar L1 and CCD camera two;The microwave
The front end of the lower part of cruiser ontology is arranged in radar M2, and is located at the lower part of single line laser radar L2;
First rear environment detection and protection system mainly by single line laser radar L3, single line laser radar L4 and
CCD camera three forms;The position of cruiser bodies top rearward is obliquely arranged in the single line laser radar L3 right low left high
It sets, the single line laser radar L4 is horizontally disposed at the rear end of cruiser body lower part, and the setting of CCD camera three is being patrolled
The rear portion of vehicle ontology is patrolled, and close to the center of short transverse;
Second rear environment detection and protection system are mainly made of microwave radar M3 and microwave radar M4;It is described micro-
The front and rear part of cruiser ontology is arranged in wave radar M3, and between single line laser radar L3 and CCD camera three;It is described micro-
The front end of the lower part of cruiser ontology is arranged in wave radar M4, and is located at the lower part of single line laser radar L4;
The front blind-area detection and obstacle avoidance system and the detection of rear blind area and obstacle avoidance system are separately positioned on cruiser ontology
Bottom front and bottom rear end;Front blind-area detection and obstacle avoidance system are made of ultrasonic sensor US1, US2 and US3, wherein surpassing
Sonic sensor US1, US2 and US3 are evenly distributed in the width direction, and rear blind area detection and obstacle avoidance system are by ultrasonic sensor
US4, US5 and US6 composition, wherein ultrasonic sensor US4, US5 and US6 is evenly distributed in the width direction;
Single line laser radar L1~the L4, microwave radar M1~M4, CCD camera one, CCD camera two, CCD camera shooting
Machine three, wireless communication module, assistant controller one and assistant controller two are connect with master controller;The ultrasonic sensor US1
~US6 is connect with assistant controller one, and assistant controller two is connect with assistant controller one and motor driver respectively;Motor driver point
It is not connect with two direct current generators;Power supply is connect with motor driver and power conversion module respectively, and power conversion module is used for
The supply of DC power supply is provided;Wireless communication module is for wirelessly establishing the communication connection between the master station of distal end.
In the technical scheme, CCD camera one is responsible for the collection of patrol environment, and module is sent out in real time by wireless communication
Give master station.By the first front or behind environment detection and protection system setting can accurately and fast detect front or
It is stepped up patrols vehicle and front or behind moving obstacle so as to effectively detect nobody apart from farther away environmental aspect at rear
Distance;Inclination on roof and for detecting front is provided in first front or behind environment detection and protection system
The single line laser radar of setting and be arranged in lower car body and horizontally disposed single line laser radar, can not only reach multi-thread and swash
The Effect on Detecting of optical radar, the barrier that can effectively detect the unmanned cruiser direction of motion or the position where people, notice
Unmanned patrol vehicle control realizes Emergency avoidance, and low compared to the hardware cost of multi-line laser radar, is conducive to nothing
The popularization of people's driving cruiser practical application.It is provided in first front or behind environment detection and protection system and swashs positioned at single line
CCD camera two or three between optical radar and single line laser radar can not only assist single line laser radar and single line laser radar
Detection and navigation accuracy are improved, video analysis can be also more advantageous to, and on the one hand can find that movement road surface temporarily loses in advance
Small obstacle and moving line in road conditions fluctuating situation, can make realtime graphic obtain performance it is more preferable, can be to unmanned
Cruiser, which advanced optimizes path or regulation power throwing over barrier, has significant help.On the other hand it can effectively detect
The presence of two sides free area, to provide certain help for unmanned cruiser advance turning and avoidance, moreover it is possible to effectively visit
The presence of direction of motion two sides columnar object is measured, to provide certain side to position when unmanned cruiser forward or backward
It helps.By enabling the second front or behind environment detection and the setting of system being protected quickly and accurately to detect front or behind
The short-distance blind section being closer especially is accelerated forwardly in rigid starting or is fallen backward can effectively eliminate unmanned cruiser
The short-distance blind section occurred when vehicle improves the safety and reliability when walking of unmanned cruiser.In addition, the second front
Or rear environment detection and protection system use the microwave radar group positioned at the microwave radar of vehicle body upper portion and positioned at lower car body
At since microwave is the very short radio wave of wavelength, directionality is fine, and speed is equal to the light velocity.It is stood when microwave encounters barrier
It is reflected back, the distance of barrier, and the ability of microwave penetration mist, cigarette, dust can be measured according to electromagnetic wave two-way time
By force, have the characteristics that round-the-clock, round-the-clock can work, in this way once encountering bad weather, system can excise laser radar detection
System relies only on microwave radar systems work, meets the normal patrol work of unmanned cruiser under round-the-clock adverse circumstances,
And then boisterous patrol operation can be successfully managed, but microwave radar is lower relative to lidar measurement precision, therefore,
As the supplement of the first front or behind environment detection and protection system, the detection effect of short-distance blind section can be effectively improved
Fruit.In addition, system has two-way navigation sensor, when encountering blind alley, the mode of 180 degree is not needed to rotate in place to realize
U-turn need to only switch the control logic of front and back group navigation sensor and motor driver, so that it may realize u-turn, increase nobody
It drives cruiser and passes through the flexibility of the ability of small space and patrol operation.Furthermore make master controller to focus on patrol
Image data, single line laser radar signal and the microwave radar signal that the CCD camera of vehicle acquires in real time, connect assistant controller one
The processing result from master controller is received, and handles the feedback signal of ultrasonic sensor group and motor driver is controlled
System, can not only greatly improve the speed of image procossing and multisensor data fusion processing, and assistant controller can be effectively reduced
One load can effectively prevent " run and fly " of motion control main program, so as to make the anti-interference energy of unmanned cruiser
Power greatly enhances.The fast response servo that direct current generator can be rapidly completed in SERVO CONTROL based on FPGA is adjusted, and has given full play to FPGA
The very fast feature of arithmetic speed greatly reduces the adjustment time of unmanned cruiser posture, enables unmanned cruiser
Quickly walking.Direct current generator is controlled by assistant controller two, further mitigates the burden of assistant controller one, can be accelerated auxiliary
One processor of controller controls the sending of signal, and then can be further improved the speed of travel of automatic driving car.
Further, the CCD camera two and the equal left low and right high of microwave radar M1 are obliquely arranged;The CCD camera
The equal right low left high of three and microwave radar M3 is obliquely arranged.
In the technical scheme, by the way that CCD camera two and three is arranged obliquely, and make superposed microwave radar
M1 and M3 are obliquely arranged, and can not only more effectively find the fluctuating of road conditions in moving line, moreover it is possible to be more conducive to discovery fortune in advance
The small obstacle that dynamic road surface temporarily loses.
Further, the tilt angle of the single line laser radar L1 and L3 is 5 degree;Single line laser radar L2 and L4 distance
The distance on ground is 15cm~30cm.
In the technical scheme, the tilt angle of single line laser radar L1 and L3 is 5 degree, can not only make single line laser thunder
More effectively cooperate up to L1 and L2, single line laser radar L3 and L4, to effectively improve the detection of equidirectional two single line radars
Effect, and can be conducive to the fluctuating for finding road conditions in moving line in advance by the setting of the tilt angle and move road surface face
When lose small obstacle the case where so that cruiser can make in advance reply reaction, be conducive to improve cruiser went on patrol
Safety and reliability in journey.
Further, each driven wheel is universal wheel.In order to improve the flexibility of cruiser movement, meanwhile, can also it make
Turn radius when cruiser turns in situ is smaller.
Further, the master controller is NUC7 processor;The core of the assistant controller one uses STM32F767;Institute
The core of assistant controller two is stated using FPGA.
In the technical scheme, make master controller NUC7 processor, assistant controller one uses STM32F767, auxiliary control system
Device two uses FPGA, to make the control of cruiser by the master system based on vehicle-mounted computer NUC and based on STM32F767's
Three nuclear control systems of ARM lower computer system and FPGA composition carry out, wherein mainly being used based on vehicle-mounted computer NUC master system
The maximum more single line laser radar signal processings of workload, microwave radar signal processing, CCD in unmanned cruiser system
Image Acquisition and analysis and with the input for interactively communicating and completing path and map of master station, each Data Fusion of Sensor processing;
The data fusion that the multisensor of unmanned cruiser is handled by NUC7 substantially increases arithmetic speed, and then can sufficiently send out
The fast feature of NUC microcomputer data processing speed is waved, single arm processor is solved and runs slower bottleneck, shorten exploitation
Period is short, and keeps the portable ability of program stronger.ARM lower computer control system based on STM32F767 is mainly used for reality
When receive the host computer multisensor digital convergence signal of NUC microcomputer composition, and realize the Digital Signal Processing of part, sound
Answer the real-time data communication and storage of various interruptions and realization with master station.Complete unmanned cruiser system data storage,
The functions such as I/O control, blind area detection and avoidance signal processing, image analysis and transmission, can make maximum two axis of workload in this way
Brush DC servo system control gives FPGA processing, thus make whole system with FPGA kinetic control system processing core,
FPGA data can be given full play to and handle very fast advantage, thereby realize the rational division of work of NUC, FPGA and ARM, sufficiently with energy
Using the fast feature of NUC data processing speed, quickly handle at a large amount of Multi-sensor Fusion signal and the algorithm of various data
Reason, effectively frees arm processor from hard work amount, can effectively prevent motion control main program
" run and fly ", and can fully consider the interference source of surrounding, significantly enhance the anti-interference ability of unmanned cruiser.Simultaneously
The calling of the communication of energy real-time perfoming and data exchange and mutual required data, can effectively improve between NUC, FPGA and ARM
The environment detection function of unmanned cruiser.The front and rear of the unmanned cruiser of the present invention is all made of in same position
Identical laser radar, microwave radar, CCD camera and ultrasonic sensor can be realized unmanned cruiser narrow
The accuracy of space navigation and the flexibility of u-turn.
Further, as a preference, the model LMS151-10100 of single line laser radar.
Further, in order to realize closed-loop control, so that assistant controller one can preferably control the operating condition of driving wheel, institute
It states and is connected with encoder on driven wheel, the encoder is connect with assistant controller one, for Real-time Feedback cruiser ontology
Displacement, velocity and acceleration.
It further, further include four charging modules, four charging modules point for the ease of charging to cruiser ontology
It is not distributed in the surrounding of cruiser ontology, and connects to power supply, the power supply is battery group.
Detailed description of the invention
Fig. 1 is the structural schematic diagram of existing unmanned cruiser motor internal arrangement;
Fig. 2 is the structural representation structure chart of the unmanned cruiser motor arrangement of two-wheeled of the invention;
Fig. 3 is the structural schematic diagram of the unmanned cruiser sensor of the present invention and camera alignment;
Fig. 4 is the left view of Fig. 3;
Fig. 5 is the right view of Fig. 3;
Fig. 6 is the functional block diagram of the control system of one embodiment in the present invention;
Fig. 7 is unmanned cruiser operation schematic diagram in the present invention;
Fig. 8 is the unmanned bilateral navigation scheme of cruiser in the present invention;
Fig. 9 is the unmanned unilateral navigation scheme of cruiser in the present invention;
Figure 10 is unmanned cruiser inertial navigation schematic diagram in the present invention;
Figure 11 is that unmanned cruiser reverses end for end schematic diagram in the present invention;
Figure 12 is the functional block diagram of the control system of another embodiment in the present invention;
Figure 13 is that NUC matches the functional block diagram for carrying out image procossing with FPGA in the present invention.
In figure: 1, cruiser ontology, 2, driving wheel, 3, driven wheel, 4, direct current generator, 5, planetary reducer, 6, gear one,
7, gear two, 8, CCD camera one, 9, single line laser radar L1,10, single line laser radar L2,11, CCD camera two, 12,
Microwave radar M1,13, microwave radar M2,14, single line laser radar L3,15, single line laser radar L4,16, CCD camera three,
17, microwave radar M3,18, microwave radar M4,19, ultrasonic sensor US1,20, ultrasonic sensor US2,21, ultrasonic wave biography
Sensor US3,22, ultrasonic sensor US4,23, ultrasonic sensor US5,24, ultrasonic sensor US6,25, charging module,
26, front blind-area detection and obstacle avoidance system, 27, the detection of rear blind area and obstacle avoidance system.
Specific embodiment
Below with reference to embodiment, the invention will be further described.
Embodiment 1:
As shown in Figures 1 to 5, the round-the-clock unmanned cruiser system of a kind of two-wheel drive, including 1 He of cruiser ontology
Control system on cruiser ontology 1 is set;1 lower part of cruiser ontology is in a pair of of driving of the middle part of length direction assembly
Wheel 2, length direction left part and right part be respectively equipped with a pair of driven 3, as a preference, each driven wheel 3 is ten thousand
To wheel.1 mounted inside of cruiser ontology has two direct current generators 4 for respectively driving two driving wheels 2;The cruiser sheet
Two planetary reducers 5 being located on the outside of two 4 motor shafts of direct current generator, the planetary reduction gear are additionally provided with inside body 1
Machine 5 is 90 degree of corner planetary reducers;The direction that the length direction of two direct current generators 4 prolongs 1 width of cruiser ontology extends,
And two direct current generators 4 are arranged at intervals in the longitudinal direction, the motor shaft of two direct current generators 4 is arranged to ground opposite to each other;It is described straight
Galvanic electricity machine 4 is rare earth permanent magnet brushless DC servo motor, the stator and ordinary straight galvanic electricity of rare earth permanent magnet brushless DC servo motor
Machine stator structure having the same, only using Nd-Fe-B rare earth permanent magnetic material as magnetic pole instead of the excitation pole of direct current generator
And excitation winding, so that the structure of direct current brushless servo motor is relatively simple, and electronic commutation eliminates and is easy out of order collection
Electric ring and brush, realize non-brushing, improve the reliability of motor operation.Rare earth permanent-magnetic material uses so that power of motor
Density is higher, and the volume of motor be can be made smaller.Rare-earth permanent magnet brushless servo has small in size, weight with respect to traditional servo motor
Amount is light, and power output is big, and response is fast, and inertia is small, and rotation is smooth, and torque is stablized, and non-maintaining, high-efficient, running temperature is low, electromagnetic radiation
It is small, the advantages that service life is long.These characteristics make rare earth permanent magnet brushless DC servo motor be particularly suitable for substitution direct current generator, and answer
In the robot control system more special for unmanned cruiser these requirements.The motor shaft and planet of direct current generator 4
The input terminal of speed reducer 5 connects, and the output shaft of planetary reducer 5 drives driving wheel 2 by gear set;Planetary reducer 5 is 90
Planetary reducer is spent, i.e. the input shaft of planetary reducer 5 and output shaft is perpendicular;The gear set by being distributed and phase in the longitudinal direction
Intermeshed gear 1 and gear 27 form;The gear 1 is set on the output shaft of planetary reducer 5, the gear
27 are set in the shaft at 2 center of driving wheel;Direct current generator 4 connects by the way that its motor shaft and 90 degree of planetary reducers 5 are directly mechanical
It connects, then 5 output shafts of planetary reducer are mechanically connected by gear 1 and gear 27 and driving wheel, using direct current generator 4
This combination of cooperation planetary reducer 5 is able to achieve the matching between the unmanned cruiser speed of travel and demand torque, energy
The torque when walking of unmanned cruiser is effectively increased, meanwhile, it also can be reduced the width of unmanned cruiser.As one kind
It is preferred that gear 1 and gear 27 can use the gear ratio of 1:1.Due to the axial position for the direct current brushless servo motor that has been staggered
It sets, so that the width of unmanned cruiser is greatly lowered, is conducive to unmanned cruiser and passes through some narrow regions.
Planetary reducer 5 is a kind of independent type closed driving device between prime mover and working machine, main function be exactly for
It reduces load/motor rotary inertia ratio and reduces revolving speed and increase torque, and under the premise for guaranteeing precision drive.It is accurate
Planet-gear speed reducer is small with structure size, volume is light and handy, gear range, reduction range are wide, low noise, transmission efficiency
High, the advantages that output torque is high, since the above advantage planet-gear speed reducer is widely used in DC servo motor, hands over
In the electronic products such as flow servo motor, stepper motor, it can be used for lifting transport, engineering machinery, metallurgy, mine, petrochemical industry, build
Build the fields such as machinery, industry light industry textile industry, medical instrument, instrument and meter, ship, automobile.
As shown in fig. 6, the control system include power supply, power conversion module, motor driver, wireless communication module,
Master controller, assistant controller, the first front environment detection and protection system, the second front environment detection and protection system, first
Rear environment detection and protection system, the second rear environment detection and protection system, front blind-area detection and obstacle avoidance system 26, rear blind
Area's detection and obstacle avoidance system 27 and 360 degree of CCD cameras 1 that 1 top center of cruiser ontology is set;
In order to realize that unmanned cruiser navigates and reverses end for end in small space, the unmanned cruiser sheet of the present invention
The front and rear of body is all made of identical laser radar, microwave radar, CCD camera and supersonic sensing in same position
Device.First front environment detection and protection system are mainly by single line laser radar L1 9,10 and of single line laser radar L2
CCD camera 2 11 forms;It is forward that 1 top of cruiser ontology is obliquely arranged in 9 left low and right high of single line laser radar L1
Position, the single line laser radar L2 10 is horizontally disposed at the front end of 1 lower part of cruiser ontology, the CCD camera two
11 are arranged in the front of cruiser ontology 1, and close to the center of short transverse;First rear environment detection and protection
System is mainly made of single line laser radar L3 14, single line laser radar L4 15 and CCD camera 3 16;The single line laser
1 top rearward position of cruiser ontology, the single line laser radar L4 15 is obliquely arranged in 14 right low left high of radar L3
It is horizontally disposed at the rear end of 1 lower part of cruiser ontology, the rear portion of cruiser ontology 1 is arranged in the CCD camera 3 16, and
Close to the center of short transverse;Due to being provided with the first rear environment detection and protection system, when unmanned cruiser
Once movement is got up, reversed single line laser radar can effectively detect unmanned cruiser and rear moving obstacle away from
From playing the unmanned cruiser of protection when in case of emergency, unmanned cruiser can accelerate to flee danger region
The effect of ontology.
Second front environment detection and protection system are mainly made of microwave radar M1 12 and microwave radar M2 13;
The front of cruiser ontology 1 is arranged in the microwave radar M1 12, and is located at single line laser radar L1 9 and CCD camera two
Between 11;The front end of the lower part of cruiser ontology 1 is arranged in the microwave radar M2 13, and is located at single line laser radar L2 10
Lower part;Second rear environment detection and protection system are mainly made of microwave radar M3 17 and microwave radar M4 18;
The front and rear part of cruiser ontology 1 is arranged in the microwave radar M3 17, and is located at single line laser radar L3 14 and CCD camera
Between 3 16;The front end of the lower part of cruiser ontology 1 is arranged in the microwave radar M4 18, and is located at single line laser radar L4
15 lower part;Since microwave radar is insensitive to misty rain, hazy weather, to having dust, have the environment of strong light insensitive, so
Rain has the weather of mist, the patrol vehicle control can directly excise laser radar and navigated using microwave radar, improve
The safety of unmanned cruiser.
In addition, in order to meet a wide range of multi-site operation, can be added for the unmanned cruiser of this structure
Site sensor with certain redundancy (can for connect with assistant controller GPS positioning module), not only conducive to nobody
The positioning of cruiser is driven, and is also beneficial to tracking of the master station to unmanned cruiser.
Preferably, the model of single line laser radar is LMS151-10100.
As a preference, the first front environment detection and protection system and the first rear environment detection and protection system pair
It is arranged with claiming ground setting, the second front environment detection and protection system and the second rear environment detection and protection symmetry system having symmetry.For
Can precision navigation and video analysis, CCD camera of the invention uses two groups, wherein CD video camera 2 11 and CCD camera shooting
Machine 3 16 is responsible for vision guided navigation use as one group, and CCD camera 1 is responsible for going on patrol environment as another group to be collected, can be through
For the environmental information flowed again by wireless real-time transmission after arm processor decoding to master station, master station can find suspicious letter in time
Breath.
As a preference, the CCD camera 2 11 and the equal left low and right high of microwave radar M1 12 are obliquely arranged;Institute
It states CCD camera 3 16 and the equal right low left high of microwave radar M3 17 is obliquely arranged.
As a preference, the tilt angle of the single line laser radar L1 and L3 is 5 degree;Single line laser radar L2 and
Distance of the L4 apart from ground is 15cm~30cm.With ground there is the unmanned patrol bus-top single line of certain angle to swash
Optical radar, microwave radar combine the fluctuating that can find road conditions in moving line in advance very well with CCD camera acquisition, to nobody
Driving cruiser path optimizing has certain help.There is the unmanned patrol bus-top single line of certain angle with ground
Laser radar data, microwave radar can also find that movement road surface temporarily loses in conjunction with CCD camera acquisition data in advance very well
Small obstacle, advanced optimizing path or regulation power throwing over barrier to unmanned cruiser has certain side
It helps.
Due to sensor combinations, unmanned cruiser is when starting moves forward generally in forward region
There are a blind area, collide when starting in order to prevent, the front blind-area detection and obstacle avoidance system 26 and the detection of rear blind area and
Obstacle avoidance system 27 is separately positioned on bottom front and the bottom rear end of cruiser ontology 1;Front blind-area detection and obstacle avoidance system 26 by
Ultrasonic sensor US1, US2 and US3 composition, wherein ultrasonic sensor US1, US2 and US3 equably divides in the width direction
Cloth, the detection of rear blind area and obstacle avoidance system 27 are made of ultrasonic sensor US4, US5 and US6, wherein ultrasonic sensor US4,
US5 and US6 are evenly distributed in the width direction;Due to being added one group by ultrasonic sensor in the bottom of unmanned cruiser
The front blind-area detection of US1, US2, US3 composition and obstacle avoidance system.In unmanned cruiser driving process, CCD camera meeting
Environmental information is acquired in real time and is sent to vehicle-mounted NUC7 processor and master station, it, can remotely pilotless when master station finds doubtful information
The cruiser starting secondary determining suspicious information of reversing back, which is driven, at this time generally in rear moving region there are a blind area is
Prevent to collide, the present invention is added one group by ultrasonic sensor US4, US5, US6 in the bottom of unmanned cruiser
The rear blind area detection of composition and obstacle avoidance system.The blind area detection system being made of multiple ultrasonic sensors can effectively eliminate nobody and drive
It sails cruiser and has just started and be accelerated forwardly or short-distance blind section that when reversing back occurs, when improving the walking of unmanned cruiser
Safety and reliability.Simultaneously as being equipped with two-way navigation sensor group, when encountering blind alley, original place rotation is not needed
The mode of turnback is reversed end for end to realize, need to only switch the SERVO CONTROL logic of front and back group navigation sensor and left and right servo motor,
It can realize u-turn, increase ability of the unmanned cruiser by small space.
Single line laser radar L1~the L4, microwave radar M1~M4, CCD camera 1, CCD camera 2 11, CCD
Video camera 3 16, wireless communication module and assistant controller are connect with master controller;Ultrasonic sensor US1~the US6 and
Motor driver is connect with assistant controller, and motor driver is connect with two direct current generators 4 respectively;Power supply drives with motor respectively
Dynamic device is connected with power conversion module, and power conversion module is for providing the supply of DC power supply;Wireless communication module is for leading to
Cross the communication connection that wireless mode is established between the master station of distal end.
In order to improve the environment detection function of unmanned cruiser, the master controller is preferably NUC7 processor;Institute
The core of assistant controller is stated using STM32F767.STM32F756 processor is that STM company completely new ARM series produced produces
Product, are global first volume production and the microcontroller for possessing 32 bit ARM Cortex-M7 processors, product be all equipped with possess it is floating
The Cortex-M7 core of point processing unit and DSP extended function, arithmetic speed highest 216MHz;With towards kernel, peripheral hardware and
The AXI of memory interconnection and more ahb bus matrixes, using 6 grades of super scalar pipelines and floating point unit;Two general DMA controls
Device and one are exclusively used in the DMA of graphics accelerator;STM32 series between comparing, possesses richer peripheral hardware;Simultaneously
STM32F7 has excellent instruction and pin compatibility: Cortex-M4 instruction set that Cortex-M7 is backward compatible, STM32F7 system
Column and STM32F4 series pin compatibility;ARM Cortex-M7 efficiency is surmounted early stage core (example by STM32F7MCU series of products
Such as Cortex-M4) advantage apply to ultimate attainment, efficiency reaches nearly twice of DSP, and These characteristics are very suitable to STM32F7
Substitution partial lower ARM family chip or dsp chip do unmanned two axis direct current brushless servo motor control system of cruiser
Data processing.
The traditional two-wheeled mechanical structure and multi-line laser radar Working mould that domestic existing unmanned cruiser mostly uses
Formula, therefore existing unmanned cruiser has the shortcomings that stability is poor, rapidity difference and sexual valence are poor, in order to guarantee nobody
The stability and reliability of patrol vehicle control are driven, while in order to improve cost performance and control calculation process speed, this Shen
The novel two-wheeled mechanical mechanism based on planetary reducer please be propose, and introduces Intel in being based on STM32F767 controller
7th generation NUC microcomputer of state-of-the-art technology forms (newest embedded based on Intel the 7th generation microcomputer NUC7+ARM
STM32F767) the completely new control model of dual-core controller.In order to improve the environment detection function of unmanned cruiser, use
More single line laser radars, microwave radar, CCD camera and ultrasonic sensor based on Intel's the 7th generation NUC microcomputer
Integration technology realizes the detection of cruiser ambient enviroment, and introduces the figure of Image Acquisition and ARM based on high definition CCD camera
As data analysis system, and by wireless in real time acquisition information back to master station.Whole system is movement control with STM32F767
System processing core processed, the host computer multisensor digital convergence signal of real-time reception NUC microcomputer composition, and realize part
Digital Signal Processing, the various interruptions of response and realization and the real-time data communication of master station and storage.The control system is mostly single
Line laser radar detection, microwave radar detection, ccd image acquisition and analysis system concentrate design, can be in the control system
The battery management module connected to power supply is set, and controls connection battery management module, battery management module by assistant controller
Voltage sensor two, measurement electric current including voltage sensor one, measurement monomer voltage for measuring assembled battery total voltage
The current sensor of size, the temperature sensing one of each battery temperature of measurement and the electric resistance sensor for measuring battery internal resistance,
Rationally to monitor the parameters situations such as battery total voltage, monomer voltage, the internal resistance of battery, temperature, and then quickly put in on-vehicle battery
It in electric process, opposite end voltage can be detected in real time, guarantee that battery terminal voltage closer to actual parameter, is conducive to the low of battery
Pressure protection.In this way, the control system can be made fully to consider that battery in the effect of this system, is controlled based on ARM+NUC double-core
Device can the operating status constantly to unmanned cruiser be monitored and operation, improve the utilization rate of the energy of battery, have
Conducive to the continuation of the journey of unmanned cruiser, realize unmanned cruiser it is stable, it is reliable, constantly in the patrol of each region
Operation.
The control system is maximum more single line laser radar signal processings of workload in unmanned cruiser system, micro-
The processing of NUC microcomputer is given in wave Radar Signal Processing and ccd image acquisition and analysis, handles unmanned cruiser by NUC7
CCD camera image data and multisensor data fusion signal, substantially increase arithmetic speed, give full play to NUC
The very fast feature of microcomputer data processing speed solves single ARM software and runs slower bottleneck, shortens the development cycle
It is short, and enhance program transportability ability effectively.Since this control system handles a large amount of single line laser radar sensings using NUC
The data and algorithm of device and microwave radar sensor, and fully considered the interference source of surrounding, ARM from hard work amount
It frees, effectively prevents " run and fly " of motion control main program, unmanned cruiser anti-interference ability greatly enhances.
And blind area detection and the functions such as avoidance, image analysis and transmission, data storage, I/O control give STM32F767 completion, in this way
It is achieved that the division of labor of ARM Yu NUC microcomputer, while improving control system operation and processing speed, also further mentions
The high stability and reliability of control system, at the same can also make master controller and assistant controller therebetween can real-time perfoming it is logical
News carry out data exchange and calling.Meanwhile single line laser radar, microwave radar cooperate ccd image acquisition system, can not only have
The barrier or the position where people that effect detects the unmanned cruiser direction of motion, notify unmanned patrol vehicle control
It realizes Emergency avoidance, and lower compared to multi-line laser radar hardware cost, is conducive to unmanned cruiser practical application
It promotes.Meanwhile the presence of direction of motion two sides columnar object can be effectively detected, it is positioned when can advance for unmanned cruiser
Certain help is provided.The presence of two sides free area can also effectively be detected, can for unmanned cruiser advance turning and
Avoidance provides certain help.
Further, encoder can also be connected on the driven wheel 3, the encoder is connect with assistant controller, with
Displacement, velocity and acceleration for Real-time Feedback cruiser ontology 1.
It further include four charging modules, four charging modules are respectively distributed to cruiser for the ease of realizing charging process
The surrounding of ontology 1, and connect to power supply, the power supply is battery group.Preferably, the charging module is preferably wireless
Charging module, in this way, can automatically carry out charging operation after cruiser reaches specified region.
In order to make the cruiser that there is warning function, the acousto-optic report connecting with assistant controller or master controller can also be increased
Alert system.In order to understand ambient weather situation in time, can also increase on cruiser ontology and assistant controller or main control
The photosensitive sensor of device connection comes.
In order to further enhance the control precision for having no way of driving cruiser, in order to perceive rotation angle and maintenance side
To, meanwhile, also for navigation and locating effect can be improved, it is additionally provided with the gyroscope connecting with assistant controller.
Working principle: unmanned cruiser system is divided into two parts by the present invention: the Novel machine based on planetary reducer
Tool system and double-core control system based on NUC7+ARM, double-core control system is by the master system based on vehicle-mounted computer NUC
With the ARM lower computer system composition based on STM32F767.Path and ground are wherein completed based on vehicle-mounted computer NUC master system
Scheme input, more single line laser radars, the data fusion of microwave radar sensor and the functions such as the acquisition of CCD figure and processing;It is based on
The ARM lower computer control system of STM32F767 complete unmanned cruiser system two axis brush DC servo SERVO CONTROLs,
The functions such as data storage, I/O control, wherein the maximum two axis brush DC servo system control of workload gives STM32F767
Processing, gives full play to the very fast advantage of STM32F767 data processing, thereby realizes the division of labor of NUC and ARM, while the two
Between again can be communicated, real-time perfoming data exchange and calling.
For the unmanned cruiser dual-core controller based on ARM (STM32F767)+NUC7 that designs of the present invention,
Under power-on state, arm processor and NUC controller are completed to initialize first, and then vehicle-mounted computer NUC7 is driven by nobody
Sail cruiser control master station and transfer cruiser driving path and cartographic information, subsequent blind-spot sensor is started to work, and at ARM
Device communication is managed, arm processor, which determines, opens unmanned cruiser patrol mode after clear enters working region, while with
NUC controller mutually communicates, and NUC real-time reception laser radar, microwave radar and CCD camera feedback signal simultaneously decode, then
It is communicated with arm processor and transmits input control signal to arm processor, arm processor controls signal control by decoded input
Direct current brushless servo motor processed, direct current brushless servo motor drive unmanned patrol after planetary reducer conversion rate and torque
It patrols vehicle fast running, and gives ARM to handle by signals such as the displacement of encoder Real-time Feedback, velocity and accelerations on moving wheel
Device.In unmanned cruiser motion process, the patrol image capturing system real-time Transmission scene patrol based on CCD camera
Information is to master station.Once encountering bad weather, system meeting excise laser radar-probing system relies only on microwave radar systems work
Make, meets the normal patrol work of unmanned cruiser under round-the-clock adverse circumstances.Unmanned cruiser patrols once opening
Mode is patrolled, 360 degree of CCD cameras 1 will return in real time patrol environment by arm processor.
In conjunction with Fig. 7, into Figure 11 introduction present invention, the specific function of unmanned cruiser is accomplished by
1) for unmanned cruiser between patrol mission, master station generally can recognize first patrol by it by remote control mode
The Essential Environment in region passes through mobile lidar L1~L4, microwave radar M1 in unmanned cruiser walking process
~M4 and CCD camera two and CCD camera three carry out environment detection and build figure, while by WLAN in real time environment
Map transmission stores after being handled by master station to master station and forms entire beat map, if region is larger, total standing-meeting is to patrolling
The map for patrolling region is split, and is divided into several mapping modules, conducive to the calling in unmanned cruiser later period, once it completes
The foundation of area map, unmanned cruiser are returned to master station and enter patrol state of awaiting orders.
2) it is not connected between patrol order in unmanned cruiser, it generally can be in master station's hair to be controlled such as waiting area
Out go out say the word, if voltage is lower, unmanned cruiser can charge automatically.Unmanned cruiser is waiting
After period after being connected to the task of setting out, unmanned cruiser will detect extraneous environmental aspect, if environment compares
Badly, it will not participate in navigation for laser radar L1~L4 of navigation, CCD camera two and CCD camera three, system will be opened only
Open microwave radar, ultrasonic sensor navigates.Vehicle-mounted computer NUC7 transfers unmanned cruiser by master station and goes on patrol point
Information forms the driving path and navigation map information of new period patrol then in conjunction with master station's cartographic information, is then based on
The arm processor of STM32F767 is opened front and back blind-spot sensor and is scanned to blind area, if there is to enter movement blind for barrier
Area, arm processor can sound an alarm, and wait the removing of barrier;If clear enters movement blind area, unmanned to patrol
Vehicle is patrolled to start to go on patrol automatically.
3) after unmanned cruiser starts starting, arm processor opens each single line laser thunder according to ambient weather situation
Real time environment scanning is carried out up to sensor L1~L4, microwave radar M1~M4 and CCD camera two and CCD camera three, then
The real-time map of generation and original map, which compare, determines the location of unmanned cruiser and posture, ARM processing
Laser radar sensor L1~L4, microwave radar M1~M4, CCD camera two and the CCD camera three that device is fed back by NUC7
Image data, adjust the SERVO CONTROL of two direct current generators by motor driver, and then complete unmanned cruiser
Initialization pose adjustment, unmanned cruiser enters automatic patrol mode.
4) when unmanned cruiser injection is gone on patrol automatically, sensor L1~L4, the microwave radar M1 of navigation
Feedback signal, and is conveyed to NUC and arm processor by~M4 and the work of CCD camera two and CCD camera three, first have NUC into
Row Data Fusion and STM32F767 respond various interruption protections and image analysis, and then NUC and ARM is communicated, at ARM
Device environment according to locating for the unmanned cruiser that NUC is fed back is managed, determines that unmanned cruiser is being worked as according to Fig. 8, Fig. 9 and Figure 10
It is bilateral navigation, left unilateral navigation, right unilateral navigation or the inertial navigation based on gyroscope under premode, then ARM is handled
Device send control signal to motor driver, and it is unmanned to realize that the direct current generator after completing adjusting controls the movement of speed reducer again
The speed and the direction of motion of cruiser change, and unmanned cruiser is allowed easily to complete to go on patrol automatically.
5) after unmanned cruiser enters moving line, the single line laser sensor L1 and microwave radar of front obliquely
M1, front parallel to the ground detection single line laser radar group L2 and microwave radar M2 and CCD camera two (or laser sensor
L3 and microwave radar M3, front detection single line laser radar group L4 and microwave radar M4 and CCD camera three parallel to the ground)
The environment that front can be detected the moment forms new environmental map, and the map transmitted with master station compares, and determines fixed obstacle
With mobile people and object location information etc..
If single line laser sensor L1, microwave radar M1 cooperate CCD camera two (or single line laser sensor L3, micro-
Wave radar M3 cooperates CCD camera three) detect fluctuating pitting or the small-scale obstacle in forward path there are certain altitude
Object will be into assistant controller (STM32F767) sending if height and width have been more than the requirement that unmanned cruiser is crossed
Fluctuating pitting data are transferred to NUC simultaneously and are handled by disconnected request, and STM32F767 can be to interrupting priority processing and enter front
Hide protection subprogram: if there is enough walking spaces on the left of unmanned cruiser, arm processor will adjust two direct currents
The control of machine moves unmanned cruiser to the left according to different navigation modes, after completing to hide movement, ARM processing
The control for adjusting two direct current generators deviates unmanned cruiser to the right according to navigation mode and drives into NUC7 again by device
Optimized path;If there is enough walking spaces on the right side of unmanned cruiser, arm processor will adjust two direct currents
The control of machine moves unmanned cruiser to the right according to navigation mode, and after completing to hide movement, arm processor will be adjusted
The control for saving two direct current generators deviates unmanned cruiser to the left according to navigation mode and to drive into NUC7 again excellent
The path of change;If the height and width or small obstacle of fluctuating pitting are in unmanned cruiser tolerance, ARM processing
Device will increase the power of two direct current generators, and unmanned cruiser is travelled according to the normal path optimizing of setting.
If single line laser sensor L1 and L2, microwave radar M1 and M2 and CCD camera two (or single line laser sensor
L3, L4, microwave radar M3, M4 cooperate CCD camera three) it detects and temporarily there is large obstacle in path optimizing left front,
NUC will issue interrupt requests to ARM (STM32F767) and handle barrier data simultaneously, and ARM can go forward side by side to priority processing is interrupted
Enter left front avoidance protection subprogram: NUC and ARM communicate and transmit barrier data information, if barrier is patrolled with unmanned
Patrol immediately ahead of vehicle has enough spaces that unmanned cruiser can be allowed to pass through between projection, and arm processor will maintain current two
The SERVO CONTROL of direct current generator, unmanned cruiser continue to keep current running state;If barrier is patrolled with unmanned
Patrolling has overlapping between projection immediately ahead of vehicle, arm processor makes the control for adjusting two direct current generators according to barrier data information
Unmanned cruiser moves to the right according to different navigation modes, and after completing to hide movement, arm processor will adjust two
The control of direct current generator deviates unmanned cruiser to the left according to navigation mode and to drive into NUC7 again optimized
Path.
If single line laser sensor L1 and L2, microwave radar M1 and M2 and CCD camera two (or single line laser sensor
L3 and L4, microwave radar M3 and M4 cooperate CCD camera three) it detects and temporarily there is large-scale obstacle in path optimizing right front
Object, NUC will issue interrupt requests to ARM (STM32F767) and handle barrier data simultaneously, and ARM (STM32F767) can centering
Disconnected priority processing simultaneously enters avoidance protection subprogram before the right side: NUC and ARM communicate and transmit barrier data information, if obstacle
There are enough spaces that unmanned cruiser can be allowed to pass through between projection immediately ahead of object and unmanned cruiser, ARM processing
Device will maintain the SERVO CONTROL of current two direct current generator, and unmanned cruiser continues to keep current running state;If obstacle
Have overlapping immediately ahead of object and unmanned cruiser between projection, it is straight that arm processor according to barrier data information will adjust two
The control of galvanic electricity machine moves unmanned cruiser to the left according to navigation mode, after completing to hide movement, arm processor
The control for adjusting two direct current generators deviates unmanned cruiser to the right according to navigation mode and drives into NUC7 again
Optimized path.
During unmanned cruiser is gone on patrol forward, when encountering blind alley shown in Figure 11, arm processor will be adjusted
The control of two direct current generators makes unmanned cruiser smoothly stop in safe range, and then arm processor will automatically switch
Front and back navigation sensor group, the laser sensor L3 and microwave radar M3, detection list in rear parallel to the ground of rear obliquely
Line laser radar group L4 and microwave radar M4, CCD camera three are by work, and the environment for detecting the direction of motion forms new environment
Map compares with the map of master station transmission, determines the location of fixed unmanned cruiser information etc., unmanned cruiser into
Enter reverse group sensor navigational state, while arm processor can switch the control logic of direct current brushless servo motor.In unmanned patrol
For vehicle by reverse group sensor group navigation driving process, one moment of CCD camera detects ambient enviroment, and is passed in real time by wireless
It is defeated by master station to be analyzed, until encountering next blind alley, arm processor switches to positive group sensor navigational state again.
6) when unmanned cruiser enters moving line and moves forward, detection single line laser radar L4 parallel to the ground
It is anti-that movement is detected with blind-spot sensor group US4~US6 (or single line laser radar L2 and blind-spot sensor group US1~US3) moment
The environment in direction is simultaneously transferred to NUC and ARM progress data fusion, if after sensor fusion system judges unmanned cruiser
When side is close to unmanned cruiser there are barrier, NUC will issue interrupt requests to ARM and barrier data will be transmitted simultaneously
To ARM, arm processor can be to interrupting priority processing, protecting subprogram subsequently into rear avoidance and sounding an alarm, and ARM is handled
The speed for increasing by two direct current generators is made unmanned cruiser acceleration flee danger region by device;If after unmanned cruiser
Side enters protection scope there is no barrier, and unmanned cruiser will be travelled according to the normal speed of setting.
7) after unmanned cruiser enters moving line, blind-spot sensor group US1~US3 parallel to the ground (or it is blind
Zone sensors group US4~US6) moment detection direction of motion blind area environment, if (or the blind area blind-spot sensor group US1~US3
Sensor group US4~US6) judgement temporarily have barrier enter unmanned cruiser movement blind area when, will be issued to ARM promptly
Barrier data are transferred to ARM simultaneously and are handled by interrupt requests, and ARM can be kept away subsequently into blind area priority processing is interrupted
Barrier protection subprogram simultaneously sounds an alarm, and arm processor makes unmanned cruiser rapidly for two direct current generator emergency brakings are controlled
Parking, prevents unmanned cruiser from injuring meiofauna life, and after danger releases, it is straight that arm processor will readjust two
The SERVO CONTROL of galvanic electricity machine travels unmanned cruiser according to the normal speed of setting.
8) in most cases due to unmanned cruiser, be not one-stop service mode, the patrol place of arrival compared with
More, by being emphasis beat, unmanned cruiser skip emphasis beat, the present invention have given up generally in order to prevent
Website read method, site sensor S1 and S2 with certain redundancy can also be added in the present invention, when unmanned patrol
When vehicle will reach emphasis patrol website, arm processor first turns on sensor S1 and S2, while adjustment is controlled two direct currents
Machine runs at a low speed unmanned cruiser, and is read out to the site identity of beat, when any one sensing
Device be triggered Shi Ze represent unmanned cruiser arrived setting emphasis patrol website.
9) when unmanned cruiser enters emphasis patrol point, CCD camera one will carry out figure to emphasis beat
As acquisition and Real-time Feedback is to arm processor, and arm processor is total by radioing to after internal image analysis system coding
It stands, master station decodes image information first and stores keynote message, will be to ARM and NUC if master station finds suspicious decoded information
Controller issues parking interrupt requests, and adjustment two direct current generators of control are made unmanned cruiser stop in emergency by arm processor,
Then arm processor control CCD camera one carries out secondary image acquisition and is transferred to master station after analysis of encoding again;When nobody
After driving cruiser completes this website patrol mission, the SERVO CONTROL of adjustment two direct current generators of control is made nobody by arm processor
It drives cruiser to continue to travel according to set speed, arm processor is by showing in one real-time Transmission current path of CCD camera
Field picture is to master station.
10) in order to meet the actual functional capability needs of unmanned cruiser in special circumstances in hazardous environment etc., this
Urgent stop selection function can also be added in invention: nobody can be freely arranged in unmanned cruiser initial operating stage master station and drive
Sail cruiser and need the patrol website that goes, then unmanned cruiser by itself navigation sensor can with complete independently this
A setting, when if an emergency situation is encountered during patrol, master station needs to change operating path or urgent patrol website, main website
It is communicated by wireless device and unmanned cruiser NUC, walking path and patrol point information is then changed by NUC,
The unmanned cruiser path of real-time update and patrol stop site information after NUC and ARM communication control, arm processor according to
The SERVO CONTROL that new requirement controls two direct current generators completes newly assigned patrol mission.
11) when unmanned cruiser is gone on patrol by fixed route, a variety of acoustooptic alarm systems in system propose work
The presence of the awake unmanned cruiser of surrounding pedestrian, when unmanned cruiser loses communication with main website, arm processor can be sent out
Automatic stop sign out, the direct original place of arm processor lock two direct current generators of unmanned cruiser, unmanned cruiser
It will not collide or hurt people because of uncontrolled, at this time biography of the main website since unmanned cruiser can not be collected into
Defeated information will carry out fast track to unmanned cruiser according to a upper patrol bus stop information, and solve failure problems.
Embodiment 2:
As shown in Figures 1 to 5, the round-the-clock unmanned cruiser system of a kind of two-wheel drive, including 1 He of cruiser ontology
Control system on cruiser ontology 1 is set;1 lower part of cruiser ontology is in a pair of of driving of the middle part of length direction assembly
Wheel 2, length direction left part and right part be respectively equipped with a pair of driven 3, as a preference, each driven wheel 3 is ten thousand
To wheel.1 mounted inside of cruiser ontology has two direct current generators 4 for respectively driving two driving wheels 2;The cruiser sheet
Two planetary reducers 5 being located on the outside of two 4 motor shafts of direct current generator, the planetary reduction gear are additionally provided with inside body 1
Machine 5 is 90 degree of corner planetary reducers;The direction that the length direction of two direct current generators 4 prolongs 1 width of cruiser ontology extends,
And two direct current generators 4 are arranged at intervals in the longitudinal direction, the motor shaft of two direct current generators 4 is arranged to ground opposite to each other;It is described straight
Galvanic electricity machine 4 is rare earth permanent magnet brushless DC servo motor, the stator and ordinary straight galvanic electricity of rare earth permanent magnet brushless DC servo motor
Machine stator structure having the same, only using Nd-Fe-B rare earth permanent magnetic material as magnetic pole instead of the excitation pole of direct current generator
And excitation winding, so that the structure of direct current brushless servo motor is relatively simple, and electronic commutation eliminates and is easy out of order collection
Electric ring and brush, realize non-brushing, improve the reliability of motor operation.Rare earth permanent-magnetic material uses so that power of motor
Density is higher, and the volume of motor be can be made smaller.Rare-earth permanent magnet brushless servo has small in size, weight with respect to traditional servo motor
Amount is light, and power output is big, and response is fast, and inertia is small, and rotation is smooth, and torque is stablized, and non-maintaining, high-efficient, running temperature is low, electromagnetic radiation
It is small, the advantages that service life is long.These characteristics make rare earth permanent magnet brushless DC servo motor be particularly suitable for substitution direct current generator, and answer
In the robot control system more special for unmanned cruiser these requirements.The motor shaft and planet of direct current generator 4
The input terminal of speed reducer 5 connects, and the output shaft of planetary reducer 5 drives the shaft at 2 center of driving wheel by gear set;Planet subtracts
Fast machine 5 is 90 degree of planetary reducers, i.e. the input shaft of planetary reducer 5 and output shaft is perpendicular;The gear set is by longitudinal direction
Upper distribution and pitch wheel 1 and the composition of gear 27;The gear 1 is set in the output shaft of planetary reducer 5
On, the gear 27 is set in the shaft at 2 center of driving wheel;Direct current generator 4 passes through its motor shaft and 90 degree of planetary reducers
5 are directly mechanically connected, and then 5 output shafts of planetary reducer are mechanically connected by gear 1 and gear 27 and driving wheel, adopt
With direct current generator 4 cooperate planetary reducer 5 this combination be able to achieve the unmanned cruiser speed of travel and demand torque it
Between matching, can effectively increase unmanned cruiser walking when torque, meanwhile, also can be reduced the width of unmanned cruiser
Degree.As a preference, gear 1 and gear 27 can use the gear ratio of 1:1.Due to the brush DC servo electricity that has been staggered
The axial position of machine is conducive to unmanned cruiser and passes through so that the width of unmanned cruiser is greatly lowered
Narrow region.Planetary reducer 5 is a kind of independent type closed driving device between prime mover and working machine, main to make
Increase torque with being exactly for reducing load/motor rotary inertia ratio and reducing revolving speed, and before guaranteeing precision drive
Under mentioning.Precise planet-gear speed reducer is small with structure size, volume is light and handy, gear range, reduction range are wide, noise
Low, the advantages that transmission efficiency is high, output torque is high, since the above advantage planet-gear speed reducer is widely used in direct current
In the electronic products such as servo motor, AC servo motor, stepper motor, can be used for lifting transport, engineering machinery, metallurgy, mine,
The fields such as petrochemical industry, building machinery, industry light industry textile industry, medical instrument, instrument and meter, ship, automobile.
As shown in figure 12, the control system include power supply, power conversion module, motor driver, wireless communication module,
Master controller, assistant controller one, assistant controller two, the first front environment detection and protection system, the second front environment detection and
Protection system, the first rear environment detection and protection system, the second rear environment detection and protection system, front blind-area detect and keep away
Barrier system 26, the detection of rear blind area and obstacle avoidance system 27 and 360 degree of CCD camera shooting that 1 top center of cruiser ontology is set
Machine 1;
In order to realize that unmanned cruiser navigates and reverses end for end in small space, the unmanned cruiser sheet of the present invention
The front and rear of body is all made of identical laser radar, microwave radar, CCD camera and supersonic sensing in same position
Device.First front environment detection and protection system are mainly by single line laser radar L1 9,10 and of single line laser radar L2
CCD camera 2 11 forms;It is forward that 1 top of cruiser ontology is obliquely arranged in 9 left low and right high of single line laser radar L1
Position, the single line laser radar L2 10 is horizontally disposed at the front end of 1 lower part of cruiser ontology, the CCD camera two
11 are arranged in the front of cruiser ontology 1, and close to the center of short transverse;First rear environment detection and protection
System is mainly made of single line laser radar L3 14, single line laser radar L4 15 and CCD camera 3 16;The single line laser
1 top rearward position of cruiser ontology, the single line laser radar L4 15 is obliquely arranged in 14 right low left high of radar L3
It is horizontally disposed at the rear end of 1 lower part of cruiser ontology, the rear portion of cruiser ontology 1 is arranged in the CCD camera 3 16, and
Close to the center of short transverse;Due to being provided with the first rear environment detection and protection system, when unmanned cruiser
Once movement is got up, reversed single line laser radar can effectively detect unmanned cruiser and rear moving obstacle away from
From playing the unmanned cruiser of protection when in case of emergency, unmanned cruiser can accelerate to flee danger region
The effect of ontology.
Second front environment detection and protection system are mainly made of microwave radar M1 12 and microwave radar M2 13;
The front of cruiser ontology 1 is arranged in the microwave radar M1 12, and is located at single line laser radar L1 9 and CCD camera two
Between 11;The front end of the lower part of cruiser ontology 1 is arranged in the microwave radar M2 13, and is located at single line laser radar L2 10
Lower part;Second rear environment detection and protection system are mainly made of microwave radar M3 17 and microwave radar M4 18;
The front and rear part of cruiser ontology 1 is arranged in the microwave radar M3 17, and is located at single line laser radar L3 14 and CCD camera
Between 3 16;The front end of the lower part of cruiser ontology 1 is arranged in the microwave radar M4 18, and is located at single line laser radar L4
15 lower part;Since microwave radar is insensitive to misty rain, hazy weather, to having dust, have the environment of strong light insensitive, so
Rain has the weather of mist, the patrol vehicle control can directly excise laser radar and navigated using microwave radar, improve
The safety of unmanned cruiser.
In addition, in order to meet a wide range of multi-site operation, can be added for the unmanned cruiser of this structure
Site sensor with certain redundancy (can for connect with assistant controller one GPS positioning module), not only conducive to nothing
People drives the positioning of cruiser, and is also beneficial to tracking of the master station to unmanned cruiser.
Preferably, the model of single line laser radar is LMS151-10100.
As a preference, the first front environment detection and protection system and the first rear environment detection and protection system pair
It is arranged with claiming ground setting, the second front environment detection and protection system and the second rear environment detection and protection symmetry system having symmetry.For
Can precision navigation and video analysis, CCD camera of the invention uses two groups, wherein CD video camera 2 11 and CCD camera shooting
Machine 3 16 is responsible for vision guided navigation use as one group, and CCD camera 1 is responsible for going on patrol environment as another group to be collected, can be through
For the environmental information flowed again by wireless real-time transmission after arm processor decoding to master station, master station can find suspicious letter in time
Breath.
As a preference, the CCD camera 2 11 and the equal left low and right high of microwave radar M1 12 are obliquely arranged;Institute
It states CCD camera 3 16 and the equal right low left high of microwave radar M3 17 is obliquely arranged.
As a preference, the tilt angle of the single line laser radar L1 and L3 is 5 degree;Single line laser radar L2 and
Distance of the L4 apart from ground is 15cm~30cm.With ground there is the unmanned patrol bus-top single line of certain angle to swash
Optical radar, microwave radar combine the fluctuating that can find road conditions in moving line in advance very well with CCD camera acquisition, to nobody
Driving cruiser path optimizing has certain help.There is the unmanned patrol bus-top single line of certain angle with ground
Laser radar data, microwave radar can also find that movement road surface temporarily loses in conjunction with CCD camera acquisition data in advance very well
Small obstacle, advanced optimizing path or regulation power throwing over barrier to unmanned cruiser has certain side
It helps.
Due to sensor combinations, unmanned cruiser is when starting moves forward generally in forward region
There are a blind area, collide when starting in order to prevent, the front blind-area detection and obstacle avoidance system 26 and the detection of rear blind area and
Obstacle avoidance system 27 is separately positioned on bottom front and the bottom rear end of cruiser ontology 1;Front blind-area detection and obstacle avoidance system 26 by
Ultrasonic sensor US1, US2 and US3 composition, wherein ultrasonic sensor US1, US2 and US3 equably divides in the width direction
Cloth, the detection of rear blind area and obstacle avoidance system 27 are made of ultrasonic sensor US4, US5 and US6, wherein ultrasonic sensor US4,
US5 and US6 are evenly distributed in the width direction;Due to being added one group by ultrasonic sensor in the bottom of unmanned cruiser
The front blind-area detection of US1, US2, US3 composition and obstacle avoidance system.In unmanned cruiser driving process, CCD camera meeting
Environmental information is acquired in real time and is sent to vehicle-mounted NUC7 processor and master station, it, can remotely pilotless when master station finds doubtful information
The cruiser starting secondary determining suspicious information of reversing back, which is driven, at this time generally in rear moving region there are a blind area is
Prevent to collide, the present invention is added one group by ultrasonic sensor US4, US5, US6 in the bottom of unmanned cruiser
The rear blind area detection of composition and obstacle avoidance system.The blind area detection system being made of multiple ultrasonic sensors can effectively eliminate nobody and drive
It sails cruiser and has just started and be accelerated forwardly or short-distance blind section that when reversing back occurs, when improving the walking of unmanned cruiser
Safety and reliability.Simultaneously as being equipped with two-way navigation sensor group, when encountering blind alley, original place rotation is not needed
The mode of turnback is reversed end for end to realize, need to only switch the SERVO CONTROL logic of front and back group navigation sensor and left and right servo motor,
It can realize u-turn, increase ability of the unmanned cruiser by small space.
Single line laser radar L1~the L4, microwave radar M1~M4, CCD camera 1, CCD camera 2 11, CCD
Video camera 3 16, wireless communication module, assistant controller one and assistant controller two are connect with master controller;The supersonic sensing
Device US1~US6 is connect with assistant controller one, and assistant controller two is connect with assistant controller one and motor driver respectively;Motor drives
Dynamic device is connect with two direct current generators 4 respectively;Power supply is connect with motor driver and power conversion module respectively, power supply modulus of conversion
Block is for providing the supply of DC power supply;Wireless communication module is for wirelessly establishing the communication between the master station of distal end
Connection.
In order to improve the environment detection function of unmanned cruiser, the master controller is preferably NUC7 processor;Institute
The core of assistant controller one is stated using STM32F767;The core of the assistant controller two uses FPGA.STM32F767 processor
It is STM company completely new ARM series of products produced, is global first volume production and possesses 32 bit ARMCortex-M7 processing
The microcontroller of device, product are all equipped with the Cortex-M7 core for possessing floating-point operation unit and DSP extended function, arithmetic speed
Highest 216MHz;STM32F7MCU series of products efficiency reaches nearly twice of DSP, compare between STM32 series, possess richer
Rich peripheral hardware, while the backward compatible Cortex-M4 instruction set of Cortex-M7, STM32F7 series and STM32F4 series pin are simultaneous
Hold, These characteristics make STM32F7 be very suitable to substitution part ARM family chip or dsp chip do data processing.
FPGA itself is the cell array of standard, and user can be according to oneself design needs, by being specifically laid out
Wiring tool carries out its inside to reconfigure connection, designs the specific integrated circuit of client's needs, while FPGA is by soft
Part design realizes that hardware circuit function, the system of FPGA design have good reusable and modification property.In order to improve system
Arithmetic speed, improves the patrol speed and stability of unmanned cruiser, and the present invention completes two important function using FPGA
Can: first is that the servo control algorithm of two axis direct current brushless servo motors is realized by FPGA, second is that realizing part by FPGA
The function of image procossing primary stage: the data volume of image rudimentary processing stage is big, and algorithm is simple, and there is biggish parallel
Property;Being handled using software is a very time-consuming process, but utilizes hardware handles, so that it may be located parallel to mass data
Reason, can greatly improve processing speed.In order to increase the processing capacity of host computer, the newest 7th generation processing of Intel is introduced
Device NUC7, FPGA and NUC7 image procossing catenation principle is as shown in figure 13.
The traditional two-wheeled mechanical structure and multi-line laser radar Working mould that domestic existing unmanned cruiser mostly uses
Formula, therefore existing unmanned cruiser has the shortcomings that stability is poor, rapidity difference and sexual valence are poor, in order to guarantee nobody
The stability and reliability of patrol vehicle control are driven, while in order to improve cost performance and control calculation process speed, this Shen
Please propose the novel two-wheeled mechanical mechanism based on planetary reducer, and using based on the 7th generation NUC of Intel microcomputer+
The completely new control model of ARM (newest embedded STM32F767)+FPGA.In order to improve the environment detection of unmanned cruiser
Function, using more single line laser radars, microwave radar, CCD camera and ultrasound based on Intel's the 7th generation NUC microcomputer
Wave sensor integration technology realizes the detection of cruiser ambient enviroment, and introduces the Image Acquisition based on high definition CCD camera
With the analysis of image data system of ARM, and by wireless in real time acquisition information back to master station.Whole system is fortune with FPGA
Autocontrol system processing core, the host computer multisensor digital convergence signal of real-time reception NUC microcomputer composition and ARM control
Signal processed, and realize the real-time data communication and storage of the various interruptions of the Digital Signal Processing of part, response and realization with master station.
The control system detects more single line laser radars, microwave radar detection, ccd image acquires and analysis system concentrates design, can
The battery management module connected to power supply to be arranged in the control system, and connection battery management is controlled by assistant controller one
Module, battery management module include the voltage biography for measuring the voltage sensor one of assembled battery total voltage, measuring monomer voltage
The current sensor of the size of sensor two, measurement electric current measures the temperature sensing one of each battery temperature and for measuring in battery
The electric resistance sensor of resistance, rationally to monitor the parameters situations such as battery total voltage, monomer voltage, the internal resistance of battery, temperature, in turn
In on-vehicle battery fast discharge process, it opposite end voltage can be detected in real time, guarantee battery terminal voltage closer to practical ginseng
Number, is conducive to the low-voltage variation of battery.In this way, the control system can be made fully to consider battery in the effect of this system, base
In tri- nuclear control device of ARM+NUC+FPGA can the operating status constantly to unmanned cruiser be monitored and operation, improve
The utilization rate of the energy of battery is conducive to the continuation of the journey of unmanned cruiser, realize unmanned cruiser it is stable, it is reliable,
Constantly in the patrol operation of each region.
The control system is maximum more single line laser radar signal processings of workload in unmanned cruiser system, micro-
NUC microcomputer and FPGA processing, direct current generator (brush DC are given in wave Radar Signal Processing and ccd image acquisition and analysis
Servo motor) SERVO CONTROL give FPGA processing.The CCD camera of unmanned cruiser is jointly processed by by NUC7 and FPGA
Image data and multisensor data fusion signal, substantially increase arithmetic speed, give full play to NUC microcomputer and
The very fast feature of FPGA data processing speed solves single ARM software and runs slower bottleneck, and it is short to shorten the development cycle, and
And enhance program transportability ability effectively.The SERVO CONTROL that direct current brushless servo motor is handled by FPGA, can give full play to
The function that the very fast feature of FPGA arithmetic speed and program are easily transplanted substantially increases operation speed so that control is fairly simple
Degree further solves monolithic ARM and runs slower bottleneck, and it is short to further shorten the development cycle, and program transportability
Ability further enhances, simultaneously, moreover it is possible to quickly respond control instruction, achieve the purpose that quickly to control.Due to this control system
The data and algorithm of a large amount of single line laser radar sensors and microwave radar sensor are handled using NUC microcomputer and FPGA,
And the interference source around having fully considered, meanwhile, use, the unmanned a large amount of data of cruiser servo-system of FPGA processing with
Algorithm fully frees ARM from hard work amount, effectively prevents " run and fly " of motion control main program,
Unmanned cruiser anti-interference ability greatly enhances.And blind area detection and avoidance, image analysis and transmission, data storage, I/O
The functions such as control give STM32F767 completion, thereby realize the rational division of work of ARM, FPGA and NUC microcomputer, improve
While control system operation and processing speed, the stability and reliability of control system are also further improved, while
Can make can real-time perfoming communication progress data exchange and calling between two three of master controller, assistant controller one and assistant controller.
Meanwhile single line laser radar, microwave radar cooperate ccd image acquisition system, not only can effectively detect unmanned cruiser
The barrier of the direction of motion or the position where people notify unmanned patrol vehicle control to realize Emergency avoidance, Er Qiexiang
It is more lower than multi-line laser radar hardware cost, be conducive to the popularization of unmanned cruiser practical application.Meanwhile it can effectively detect
To the presence of direction of motion two sides columnar object, certain help can be provided to position when the advance of unmanned cruiser.It can also
The presence of two sides free area is effectively detected, turning and the avoidance of can advancing for unmanned cruiser provide certain help.
Furthermore unmanned cruiser direct current brushless servo motor PWM modulation signal and direction signal are exported by FPGA, pass through driving electricity
Road can directly drive direct current generator, not only alleviate the burden of ARM, simplify interface circuit, and eliminate and compile inside ARM
The trouble of writing position, speed control program and various pid algorithms, so that the debugging of system is simpler.It is patrolled unmanned
Patrol in vehicle operational process, FPGA can also the torque to two direct current generators carry out on-line identification and utilize motor torque and electric current
Relationship compensates, and reduces direct current brushless servo motor torque shake to the shadow of the unmanned cruiser servo-system of high speed
It rings.In the control of unmanned cruiser, FPGA is according to sensor L1~L4, M1~M4 and CCD2 and CCD3 image capturing system
Feedback signal determine that unmanned cruiser deviates the offset of optimal path center, then according to different offsets
Pid parameter inside adjustment FPGA in real time, easily realizes segmentation P, PD, PID control and nonlinear PID controller, has system
Certain is adaptive.FPGA moment and NUC and ARM are communicated, their interruptive command of real-time reception, when in case of emergency,
NUC and ARM can block the PWM output of FPGA at the first time, prevent unmanned cruiser from injuring due to failure.Due to having
On-line storage and wireless transmission function, unmanned cruiser master station can easily transfer the information gone on patrol, can be real-time
Patrol mission is adjusted according to peripheral situations, improves the efficiency of unmanned cruiser automation patrol.
Further, encoder can also be connected on the driven wheel 3, the encoder is connect with assistant controller one,
With the displacement for Real-time Feedback cruiser ontology 1, velocity and acceleration.
It further include four charging modules, four charging modules are respectively distributed to cruiser for the ease of realizing charging process
The surrounding of ontology 1, and connect to power supply, the power supply is battery group.Preferably, the charging module is preferably wireless
Charging module, in this way, can automatically carry out charging operation after cruiser reaches specified region.
In order to make the cruiser that there is warning function, the acousto-optic connecting with assistant controller one or master controller can also be increased
Alarm system.In order to understand ambient weather situation in time, can also increase on cruiser ontology and assistant controller one or master
The photosensitive sensor of controller connection comes.
In order to further enhance the control precision for having no way of driving cruiser, in order to perceive rotation angle and maintenance side
To, meanwhile, also for navigation and locating effect can be improved, it is additionally provided with the gyroscope connecting with assistant controller one.
Working principle: the unmanned cruiser based on ARM (STM32F767)+NUC7+FPGA designed for the present invention
Three nuclear control devices, under power-on state, then vehicle-mounted computer NUC7 is transferred by unmanned cruiser control master station and is patrolled
Vehicle driving path and cartographic information are patrolled, subsequent blind-spot sensor is started to work, and is communicated with ARM and FPGA processor, ARM processing
Device, which determines, opens unmanned cruiser patrol mode after clear enters working region, at the same with NUC and FPGA controller
Mutually communication, NUC real-time reception laser radar, microwave radar and CCD camera feedback signal simultaneously decode, and then handle with ARM
Device communicates and transmits input control signal to FPGA processor, FPGA processor by decoded input control signal control direct current without
Brush servo motor, direct current brushless servo motor drive unmanned cruiser quick after planetary reducer conversion rate and torque
Traveling, and by signals such as the displacement of encoder Real-time Feedback, velocity and accelerations on moving wheel to arm processor.At nobody
It drives in cruiser motion process, the patrol image capturing system real-time Transmission scene patrol information based on CCD camera is to total
It stands.Once encountering bad weather, system meeting excise laser radar-probing system relies only on microwave radar systems work, meets
The normal patrol work of unmanned cruiser under round-the-clock adverse circumstances.Unmanned cruiser once opens patrol mode,
360 degree of CCD cameras 1 will return in real time patrol environment by arm processor.
Unmanned cruiser system is divided into two parts: novel mechanical system based on planetary reducer and based on NUC7
The three nuclear control systems of+ARM+FPGA, control system mainly by the master system based on vehicle-mounted computer NUC and are based on
The lower computer system of the ARM and FPGA of STM32F767 form.Wherein based on vehicle-mounted computer NUC master system complete path and
Map input, more single line laser radars, the data fusion of microwave radar sensor and the functions such as the acquisition of CCD figure and processing;Base
Two axis brush DC servo SERVO CONTROLs, the data of unmanned cruiser system are completed in ARM+FPGA lower computer control system
The functions such as storage, I/O control, wherein the maximum two axis brush DC servo system control of workload gives FPGA processing, sufficiently
It plays FPGA data and handles very fast advantage, thereby realize the rational division of work between NUC, ARM and FPGA three, while three
It can be communicated again between person, real-time perfoming data exchange and calling.
In conjunction with Fig. 7, into Figure 11 introduction present invention, the specific function of unmanned cruiser is accomplished by
1) for unmanned cruiser between patrol mission, master station generally can recognize first patrol by it by remote control mode
The Essential Environment in region passes through mobile lidar L1~L4, microwave radar M1 in unmanned cruiser walking process
~M4 and CCD camera two and CCD camera three carry out environment detection and build figure, while by WLAN in real time environment
Map transmission stores after being handled by master station to master station and forms entire beat map, if region is larger, total standing-meeting is to patrolling
The map for patrolling region is split, and is divided into several mapping modules, conducive to the calling in unmanned cruiser later period, once it completes
The foundation of area map, unmanned cruiser are returned to master station and enter patrol state of awaiting orders.
2) it is not connected between patrol order in unmanned cruiser, it generally can be in master station's hair to be controlled such as waiting area
Out go out say the word, if voltage is lower, unmanned cruiser can charge automatically.Unmanned cruiser is waiting
After period after being connected to the task of setting out, unmanned cruiser will detect extraneous environmental aspect, if environment compares
Badly, it will not participate in navigation for laser radar L1~L4 of navigation, CCD camera two and CCD camera three, system will be opened only
Open microwave radar, ultrasonic sensor navigates.Vehicle-mounted computer NUC7 transfers unmanned cruiser by master station and goes on patrol point
Information forms the driving path and navigation map information of new period patrol then in conjunction with master station's cartographic information, is then based on
The arm processor of STM32F767 is opened front and back blind-spot sensor and is scanned to blind area, if there is to enter movement blind for barrier
Area, arm processor can sound an alarm, and FPGA is forbidden to work, and the PWM that FPGA blocks two direct current brushless servo motors exports letter
Number, unmanned cruiser removes the locked waiting barrier in original place;If clear enters movement blind area or barrier quilt
It removes, ARM controller can enable FPGA work, and FPGA exports the pwm control signal of direct current brushless servo motor, two brush DCs
Servo motor drives unmanned cruiser to start to go on patrol automatically by planetary reducer.
3) after unmanned cruiser starts starting, arm processor opens each single line laser thunder according to ambient weather situation
Real time environment scanning is carried out up to sensor L1~L4, microwave radar M1~M4 and CCD camera two and CCD camera three, then
The real-time map of generation and original map, which compare, determines the location of unmanned cruiser and posture, ARM processing
Laser radar sensor L1~L4, microwave radar M1~M4, CCD camera two and the CCD camera three that device is fed back by NUC7
Image data adjustment output bias signal to FPGA, FPGA adjust the SERVO CONTROL of direct current brushless servo motor in real time, in turn
The initialization pose adjustment of unmanned cruiser is completed, unmanned cruiser enters automatic patrol mode.
4) when unmanned cruiser injection is gone on patrol automatically, sensor L1~L4, the microwave radar M1 of navigation
Feedback signal, and is conveyed to NUC and arm processor by~M4 and the work of CCD camera two and CCD camera three, first have NUC and
FPGA carries out Data Fusion and STM32F767 responds various interruption protections and image analysis, and then NUC and ARM is communicated,
Arm processor environment according to locating for the unmanned cruiser that NUC is fed back determines unmanned patrol according to Fig. 8, Fig. 9 and Figure 10
Vehicle is bilateral navigation, left unilateral navigation, right unilateral navigation or the inertial navigation based on gyroscope under the current model, then
Arm processor input control deviation signal to FPGA, FPGA according to deviation signal through internal servo programe generate driving direct current without
The servo-control signal of brush servo motor, direct current brushless servo motor are realized unmanned after speed reducer conversion rate and torque
The speed and the direction of motion of cruiser change, and unmanned cruiser is allowed easily to complete to go on patrol automatically.
5) after unmanned cruiser enters moving line, the single line laser sensor L1 and microwave radar of front obliquely
M1, front parallel to the ground detection single line laser radar group L2 and microwave radar M2 and CCD camera two (or laser sensor
L3 and microwave radar M3, front detection single line laser radar group L4 and microwave radar M4 and CCD camera three parallel to the ground)
The environment in front can be detected the moment and form new environmental map by NUC7, the map that NUC7 is transmitted with master station compares, really
Determine fixed obstacle and mobile people and object location information etc..
If single line laser sensor L1, microwave radar M1 cooperate CCD camera two (or single line laser sensor L3, micro-
Wave radar M3 cooperates CCD camera three) detect fluctuating pitting or the small-scale obstacle in forward path there are certain altitude
Object will issue if height and width have been more than the requirement that unmanned cruiser is crossed to assistant controller one (STM32F767)
Fluctuating pitting data are transferred to NUC simultaneously and are handled by interrupt requests, before STM32F767 can be to interrupting priority processing and entering
Hide protection subprogram in side: if having enough walking spaces, ARM on the left of unmanned cruiser in the new map of NUC feedback
Maximum deviation position signal will be communicated and inputted in FPGA, and FPGA will adjust brush DC servo according to ARM input control signal
The SERVO CONTROL of motor, unmanned cruiser according to oneself the location of difference come determine navigation mode and to the left automatically
Mobile, after completing to hide movement, the SERVO CONTROL for readjusting direct current brushless servo motor drives nobody by FPGA controller
Sailing cruiser, automatic side deviates and drives into the optimized path NUC7 again to the right according to navigation mode;If NUC feedback
There are enough walking spaces on the right side of unmanned cruiser in new map, ARM will be communicated in FPGA and be inputted maximum deviation position
Signal, FPGA will adjust the SERVO CONTROL of direct current brushless servo motor, unmanned cruiser root according to ARM input control signal
Navigation mode is determined according to the location of oneself difference and is automatically moved to the right, after completing to hide movement, FPGA control
The SERVO CONTROL for readjusting direct current brushless servo motor is made unmanned cruiser according to navigation mode automatic side to the left by device
It deviates and drives into the optimized path NUC7 again;If the height and width or the small-scale obstacle of the fluctuating pitting of NUC7 feedback
The object data information tolerance cross-country in unmanned cruiser, and the unmanned cruiser left-right position of map denotation is equal
When not having enough mobile spaces, FPGA controller will increase the power of direct current brushless servo motor, and unmanned cruiser will
Simultaneously throwing over barrier is travelled according to the normal path optimizing of setting.
If single line laser sensor L1 and L2, microwave radar M1 and M2 and CCD camera two (or single line laser sensor
L3, L4, microwave radar M3, M4 cooperate CCD camera three) it detects and temporarily there is large obstacle in path optimizing left front,
NUC will issue interrupt requests to ARM (STM32F767) and handle barrier data simultaneously, and ARM can go forward side by side to priority processing is interrupted
Enter left front avoidance protection subprogram: NUC and ARM communicate and transmit barrier data information, if barrier is patrolled with unmanned
Patrol immediately ahead of vehicle has enough spaces that unmanned cruiser can be allowed to pass through between projection, and FPGA processor will maintain current two
The SERVO CONTROL of direct current generator, unmanned cruiser continue to keep current running state;If barrier is patrolled with unmanned
Patrolling immediately ahead of vehicle has overlapping between projection, and input maximum deviation position signal is to FPGA, FPGA after ARM controller analysis processing
The SERVO CONTROL of direct current brushless servo motor will be adjusted according to ARM input control signal, unmanned cruiser is according to oneself institute
The position difference at place determines navigation mode and automatically moves to the right that after completing to hide movement, FPGA controller will again
The SERVO CONTROL of adjusting direct current brushless servo motor makes unmanned cruiser according to navigation mode, and automatic side offset is laid equal stress on to the left
Newly drive into the optimized path NUC7.
If single line laser sensor L1 and L2, microwave radar M1 and M2 and CCD camera two (or single line laser sensor
L3 and L4, microwave radar M3 and M4 cooperate CCD camera three) it detects and temporarily there is large-scale obstacle in path optimizing right front
Object, NUC will issue interrupt requests to ARM (STM32F767) and handle barrier data simultaneously, and ARM (STM32F767) can centering
Disconnected priority processing simultaneously enters avoidance protection subprogram before the right side: NUC and ARM communicate and transmit barrier data information, if obstacle
There are enough spaces that unmanned cruiser can be allowed to pass through between projection immediately ahead of object and unmanned cruiser, FPGA processing
Device will maintain the SERVO CONTROL of current two direct current generator, and unmanned cruiser continues to keep current running state;If obstacle
There is overlapping, the input maximum deviation position after ARM controller analysis processing immediately ahead of object and unmanned cruiser between projection
Signal will adjust the SERVO CONTROL of direct current brushless servo motor to FPGA, FPGA according to ARM input control signal, unmanned to patrol
It patrols vehicle and navigation mode is determined according to the location of oneself difference and is automatically moved to the left, after completing to hide movement,
FPGA controller by the SERVO CONTROL for readjusting direct current brushless servo motor make unmanned cruiser according to navigation mode to
Right automatic side deviates and drives into the optimized path NUC7 again.
During unmanned cruiser is gone on patrol forward, when encountering blind alley shown in Figure 11, FPGA processor will be adjusted
The control for saving two direct current generators makes unmanned cruiser smoothly stop in safe range, and then arm processor will be cut automatically
Change front and back navigation sensor group, the laser sensor L3 and microwave radar M3, rear detection parallel to the ground of rear obliquely
Single line laser radar group L4 and microwave radar M4, CCD camera three are by work, and the environment for detecting the direction of motion forms new ring
Condition figure, the map transmitted with master station compare, and determine the location of fixed unmanned cruiser information etc., unmanned cruiser
Into reverse group sensor navigational state, while FPGA processor can switch the control logic of direct current brushless servo motor.At nobody
Cruiser is by reverse group sensor group navigation driving process, and one moment of CCD camera detects ambient enviroment, and by wireless real
When be transferred to master station and analyzed, until encountering next blind alley, arm processor switches to positive group sensor navigation shape again
State.
6) when unmanned cruiser enters moving line and moves forward, detection single line laser radar L4 parallel to the ground
It is anti-that movement is detected with blind-spot sensor group US4~US6 (or single line laser radar L2 and blind-spot sensor group US1~US3) moment
The environment in direction is simultaneously transferred to NUC and ARM progress data fusion, if after sensor fusion system judges unmanned cruiser
When side is close to unmanned cruiser there are barrier, NUC will issue interrupt requests to ARM and barrier data will be transmitted simultaneously
To ARM, arm processor can be to interrupting priority processing, protecting subprogram subsequently into rear avoidance and sounding an alarm, and ARM is controlled
Input minimum deflection position signal will adjust brush DC according to ARM input control signal to FPGA, FPGA after device analysis processing
The speed of servo motor makes unmanned cruiser acceleration flee danger region;If there is no barriers at unmanned cruiser rear
Object is hindered to enter protection scope, unmanned cruiser will be travelled according to the normal speed of setting.
7) after unmanned cruiser enters moving line, blind-spot sensor group US1~US3 parallel to the ground (or it is blind
Zone sensors group US4~US6) moment detection direction of motion blind area environment, if (or the blind area blind-spot sensor group US1~US3
Sensor group US4~US6) judgement temporarily have barrier enter unmanned cruiser movement blind area when, will be issued to ARM promptly
Barrier data are transferred to ARM simultaneously and are handled by interrupt requests, and ARM can be kept away subsequently into blind area priority processing is interrupted
Barrier protection subprogram simultaneously sounds an alarm, and ARM will forbid FPGA to work, and block is controlled the PWM of direct current brushless servo motor by FPGA
Signal is controlled, and emergency braking makes unmanned cruiser crash-stop, prevents unmanned cruiser from injuring meiofauna raw
Life, after danger releases, ARM enables FPGA again, and the SERVO CONTROL for readjusting direct current brushless servo motor is made nothing by FPGA
People drives cruiser and travels according to the normal speed of setting.
8) in most cases due to unmanned cruiser, be not one-stop service mode, the patrol place of arrival compared with
More, by being emphasis beat, unmanned cruiser skip emphasis beat, the present invention have given up generally in order to prevent
Website read method, site sensor S1 and S2 with certain redundancy can also be added in the present invention, when unmanned patrol
When vehicle will reach emphasis patrol website, arm processor first turns on sensor S1 and S2, while FPGA is straight by adjustment control two
Galvanic electricity machine runs at a low speed unmanned cruiser, and is read out to the site identity of beat, when any one
Sensor be triggered Shi Ze represent unmanned cruiser arrived setting emphasis patrol website.
9) when unmanned cruiser enters emphasis patrol point, CCD camera one will carry out figure to emphasis beat
As acquisition and Real-time Feedback is to arm processor, and arm processor is total by radioing to after internal image analysis system coding
It stands, master station decodes image information first and stores keynote message, will be to ARM, NUC if master station finds suspicious decoded information
Parking interrupt requests are issued with FPGA processor, adjustment control direct current brushless servo motor is made unmanned patrol by FPGA processor
It patrols vehicle to stop in emergency, then arm processor control CCD camera 1 carries out secondary image acquisition and is transferred to master station;When nobody drives
Sail after cruiser completes this website patrol mission, FPGA processor will adjustment control direct current brushless servo motor X and Y servo control
System makes unmanned cruiser continue to travel according to set speed, and arm processor relies on the current road of 1 real-time Transmission of CCD camera
Live image in diameter is to master station.
10) in order to meet the actual functional capability needs of unmanned cruiser in special circumstances in hazardous environment etc., this
Urgent stop selection function can also be added in invention: nobody can be freely arranged in unmanned cruiser initial operating stage master station and drive
Sail cruiser and need the patrol website that goes, then unmanned cruiser by itself navigation sensor can with complete independently this
A setting, when if an emergency situation is encountered during patrol, master station needs to change operating path or urgent patrol website, main website
It is communicated by wireless device and unmanned cruiser NUC, walking path and patrol point information is then changed by NUC,
NUC stops site information with the unmanned cruiser path of real-time update after ARM communication control and patrol, and FPGA is controlled according to ARM
The new job requirement of device input processed adjusts the SERVO CONTROL of direct current brushless servo motor to complete newly assigned patrol mission.
11) when unmanned cruiser is gone on patrol by fixed route, a variety of acoustooptic alarm systems in system propose work
It wakes up the presence of the unmanned cruiser of surrounding pedestrian, when unmanned cruiser and main website lose communication, arm processor can be to
FPGA issues automatic stopping signal, and two direct current generators of unmanned cruiser are locked to the direct original place of FPGA processor, nobody
Driving cruiser will not collide or hurt people because of uncontrolled, and main website is unmanned due to that can not be collected at this time
The transmission information of cruiser will carry out fast track to unmanned cruiser according to a upper patrol bus stop information, and solve
Certainly failure problems.
Claims (10)
1. a kind of round-the-clock unmanned cruiser system of two-wheel drive, including cruiser ontology (1) and setting are in cruiser sheet
Control system on body (1);
Cruiser ontology (1) lower part the middle part of length direction assemble a pair of driving wheels (2), length direction left part and
Right part is respectively equipped with a pair of driven (3), and cruiser ontology (1) mounted inside has for respectively driving two driving wheels (2)
Two direct current generators (4);
The control system includes power supply, power conversion module, motor driver, wireless communication module, master controller and auxiliary control
Device processed;
It is located on the outside of two direct current generator (4) motor shafts it is characterized in that, being additionally provided with inside the cruiser ontology (1)
Two planetary reducers (5);The planetary reducer (5) is 90 degree of corner planetary reducers;
The direction that the length direction of two direct current generators (4) prolongs cruiser ontology (1) width extends, and two direct current generators
(4) it is arranged at intervals in the longitudinal direction, the motor shaft of two direct current generators (4) is arranged to ground opposite to each other;The direct current generator (4) is
The motor shaft of rare earth permanent magnet brushless DC servo motor, direct current generator (4) is connect with the input terminal of planetary reducer (5), planet
The output shaft of speed reducer (5) drives driving wheel (2) by gear set;The gear set by being distributed and intermeshing in the longitudinal direction
Gear one (6) and gear two (7) composition;The gear one (6) is set on the output shaft of planetary reducer (5), the gear
Two (7) are set in the shaft at driving wheel (2) center;
The control system further include the first front environment detection and protection system, the second front environment detection and protection system,
First rear environment detection and protection system, the second rear environment detection and protection system, front blind-area detection and obstacle avoidance system
(26), rear blind area detection and obstacle avoidance system (27) and setting are imaged in 360 degree of CCD of cruiser ontology (1) top center
Machine one (8);
First front environment detection and protection system are mainly by single line laser radar L1 (9), single line laser radar L2 (10)
It is formed with CCD camera two (11);Cruiser ontology (1) is obliquely arranged in single line laser radar L1 (9) left low and right high
The forward position in top, the single line laser radar L2 (10) is horizontally disposed at the front end of cruiser ontology (1) lower part, described
CCD camera two (11) is arranged in the front of cruiser ontology (1), and close to the center of short transverse;
Second front environment detection and protection system are mainly made of microwave radar M1 (12) and microwave radar M2 (13);Institute
It states microwave radar M1 (12) to be arranged in the front of cruiser ontology (1), and is located at single line laser radar L1 (9) and CCD camera
Between two (11);The microwave radar M2 (13) is arranged in the front end of the lower part of cruiser ontology (1), and is located at single line laser thunder
Up to the lower part of (10) L2;
First rear environment detection and protection system are mainly by single line laser radar L3 (14), single line laser radar L4 (15)
It is formed with CCD camera three (16);Cruiser ontology (1) is obliquely arranged in single line laser radar L3 (14) right low left high
Top rearward position, the single line laser radar L4 (15) is horizontally disposed at the rear end of cruiser ontology (1) lower part, described
CCD camera three (16) is arranged at the rear portion of cruiser ontology (1), and close to the center of short transverse;
Second rear environment detection and protection system are mainly made of microwave radar M3 (17) and microwave radar M4 (18);Institute
It states microwave radar M3 (17) to be arranged in the front and rear part of cruiser ontology (1), and is located at single line laser radar L3 (14) and CCD camera shooting
Between machine three (16);The microwave radar M4 (18) is arranged in the front end of the lower part of cruiser ontology (1), and is located at single line laser
The lower part of radar L4 (15);
The front blind-area detection and obstacle avoidance system (26) and the detection of rear blind area and obstacle avoidance system (27) are separately positioned on cruiser sheet
The bottom front of body (1) and bottom rear end;Front blind-area detection and obstacle avoidance system (26) are by ultrasonic sensor US1, US2 and US3
Composition, wherein ultrasonic sensor US1, US2 and US3 is evenly distributed in the width direction, rear blind area detection and obstacle avoidance system
(27) it is made of ultrasonic sensor US4, US5 and US6, wherein ultrasonic sensor US4, US5 and US6 is uniform in the width direction
Ground distribution;
Single line laser radar L1~the L4, microwave radar M1~M4, CCD camera one (8), CCD camera two (11), CCD
Video camera three (16), wireless communication module and assistant controller are connect with master controller;Ultrasonic sensor US1~the US6
It is connect with assistant controller with motor driver, motor driver is connect with two direct current generators (4) respectively;Power supply respectively with electricity
Machine driver is connected with power conversion module, and power conversion module is for providing the supply of DC power supply;Wireless communication module is used
In the communication connection wirelessly established between the master station of distal end.
2. the round-the-clock unmanned cruiser system of a kind of two-wheel drive according to claim 1, which is characterized in that described
CCD camera two (11) and microwave radar M1 (12) left low and right high are obliquely arranged;The CCD camera three (16) and microwave
Radar M3 (17) right low left high is obliquely arranged;The tilt angle of the single line laser radar L1 and L3 is 5 degree;Single line swashs
Distance of the optical radar L2 and L4 apart from ground is 15cm~30cm.
3. the round-the-clock unmanned cruiser system of a kind of two-wheel drive according to claim 1 or 2, which is characterized in that
The master controller is NUC7 processor;The core of the assistant controller uses STM32F767;The model of single line laser radar
LMS151-10100。
4. the round-the-clock unmanned cruiser system of a kind of two-wheel drive according to claim 3, which is characterized in that described
Encoder is connected on driven wheel (3), the encoder is connect with assistant controller, to be used for Real-time Feedback cruiser ontology (1)
Displacement, velocity and acceleration.
5. the round-the-clock unmanned cruiser system of a kind of two-wheel drive according to claim 4, which is characterized in that also wrap
Four charging modules are included, four charging modules are respectively distributed to the surrounding of cruiser ontology (1), and connect to power supply, described
Power supply is battery group.
6. a kind of round-the-clock unmanned cruiser system of two-wheel drive, including cruiser ontology (1) and setting are in cruiser sheet
Control system on body (1);
Cruiser ontology (1) lower part the middle part of length direction assemble a pair of driving wheels (2), length direction left part and
Right part is respectively equipped with a pair of driven (3), and cruiser ontology (1) mounted inside has for respectively driving two driving wheels (2)
Two direct current generators (4);
The control system includes power supply, power conversion module, motor driver, wireless communication module, master controller, auxiliary control system
Device one and assistant controller two;
It is located on the outside of two direct current generator (4) motor shafts it is characterized in that, being additionally provided with inside the cruiser ontology (1)
Two planetary reducers (5);The planetary reducer (5) is 90 degree of corner planetary reducers;
The direction that the length direction of two direct current generators (4) prolongs cruiser ontology (1) width extends, and two direct current generators
(4) it is arranged at intervals in the longitudinal direction, the motor shaft of two direct current generators (4) is arranged to ground opposite to each other;The direct current generator (4) is
The motor shaft of rare earth permanent magnet brushless DC servo motor, direct current generator (4) is connect with the input terminal of planetary reducer (5), planet
The output shaft of speed reducer (5) drives the shaft at driving wheel (2) center by gear set;The gear set by being distributed in the longitudinal direction and
Pitch wheel one (6) and gear two (7) composition;The gear one (6) is set in the output shaft of planetary reducer (5)
On, the gear two (7) is set in the shaft at driving wheel (2) center;
The control system further include the first front environment detection and protection system, the second front environment detection and protection system,
First rear environment detection and protection system, the second rear environment detection and protection system, front blind-area detection and obstacle avoidance system
(26), rear blind area detection and obstacle avoidance system (27) and setting are imaged in 360 degree of CCD of cruiser ontology (1) top center
Machine one (8);
First front environment detection and protection system are mainly by single line laser radar L1 (9), single line laser radar L2 (10)
It is formed with CCD camera two (11);Cruiser ontology (1) is obliquely arranged in single line laser radar L1 (9) left low and right high
The forward position in top, the single line laser radar L2 (10) is horizontally disposed at the front end of cruiser ontology (1) lower part, described
CCD camera two (11) is arranged in the front of cruiser ontology (1), and close to the center of short transverse;
Second front environment detection and protection system are mainly made of microwave radar M1 (12) and microwave radar M2 (13);Institute
It states microwave radar M1 (12) to be arranged in the front of cruiser ontology (1), and is located at single line laser radar L1 (9) and CCD camera
Between two (11);The microwave radar M2 (13) is arranged in the front end of the lower part of cruiser ontology (1), and is located at single line laser thunder
Up to the lower part of (10) L2;
First rear environment detection and protection system are mainly by single line laser radar L3 (14), single line laser radar L4 (15)
It is formed with CCD camera three (16);Cruiser ontology (1) is obliquely arranged in single line laser radar L3 (14) right low left high
Top rearward position, the single line laser radar L4 (15) is horizontally disposed at the rear end of cruiser ontology (1) lower part, described
CCD camera three (16) is arranged at the rear portion of cruiser ontology (1), and close to the center of short transverse;
Second rear environment detection and protection system are mainly made of microwave radar M3 (17) and microwave radar M4 (18);Institute
It states microwave radar M3 (17) to be arranged in the front and rear part of cruiser ontology (1), and is located at single line laser radar L3 (14) and CCD camera shooting
Between machine three (16);The microwave radar M4 (18) is arranged in the front end of the lower part of cruiser ontology (1), and is located at single line laser
The lower part of radar L4 (15);
The front blind-area detection and obstacle avoidance system (26) and the detection of rear blind area and obstacle avoidance system (27) are separately positioned on cruiser sheet
The bottom front of body (1) and bottom rear end;Front blind-area detection and obstacle avoidance system (26) are by ultrasonic sensor US1, US2 and US3
Composition, wherein ultrasonic sensor US1, US2 and US3 is evenly distributed in the width direction, rear blind area detection and obstacle avoidance system
(27) it is made of ultrasonic sensor US4, US5 and US6, wherein ultrasonic sensor US4, US5 and US6 is uniform in the width direction
Ground distribution;
Single line laser radar L1~the L4, microwave radar M1~M4, CCD camera one (8), CCD camera two (11), CCD
Video camera three (16), wireless communication module, assistant controller one and assistant controller two are connect with master controller;The ultrasonic wave passes
Sensor US1~US6 is connect with assistant controller one, and assistant controller two is connect with assistant controller one and motor driver respectively;Motor
Driver is connect with two direct current generators (4) respectively;Power supply is connect with motor driver and power conversion module respectively, and power supply turns
Mold changing block is for providing the supply of DC power supply;Wireless communication module is for wirelessly establishing between the master station of distal end
Communication connection.
7. the round-the-clock unmanned cruiser system of a kind of two-wheel drive according to claim 6, which is characterized in that described
CCD camera two (11) and microwave radar M1 (12) left low and right high are obliquely arranged;The CCD camera three (16) and microwave
Radar M3 (17) right low left high is obliquely arranged;The tilt angle of the single line laser radar L1 and L3 is 5 degree;Single line swashs
Distance of the optical radar L2 and L4 apart from ground is 15cm~30cm.
8. the round-the-clock unmanned cruiser system of a kind of two-wheel drive according to claim 6 or 7, which is characterized in that
The master controller is NUC7 processor;The core of the assistant controller one uses STM32F767;The core of the assistant controller two
The heart uses FPGA;The model LMS151-10100 of single line laser radar.
9. the round-the-clock unmanned cruiser system of a kind of two-wheel drive according to claim 8, which is characterized in that described
Encoder is connected on driven wheel (3), the encoder is connect with assistant controller one, to be used for Real-time Feedback cruiser ontology
(1) displacement, velocity and acceleration.
10. the round-the-clock unmanned cruiser system of a kind of two-wheel drive according to claim 9, which is characterized in that also
Including four charging modules, four charging modules are respectively distributed to the surrounding of cruiser ontology (1), and connect to power supply, institute
Stating power supply is battery group.
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2018102241689 | 2018-03-19 | ||
CN201810224647.0A CN108469820A (en) | 2018-03-19 | 2018-03-19 | A kind of round-the-clock unmanned cruiser system of two-wheel drive low speed |
CN201810224168.9A CN108490936A (en) | 2018-03-19 | 2018-03-19 | A kind of round-the-clock unmanned cruiser system of two-wheel drive high speed |
CN2018102246470 | 2018-03-19 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109765913A true CN109765913A (en) | 2019-05-17 |
Family
ID=66458945
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910185124.4A Withdrawn CN109765913A (en) | 2018-03-19 | 2019-03-12 | A kind of round-the-clock unmanned cruiser system of two-wheel drive |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109765913A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110341601A (en) * | 2019-06-14 | 2019-10-18 | 江苏大学 | A kind of pillar A blind is eliminated and auxiliary driving device and its control method |
CN112678089A (en) * | 2020-12-08 | 2021-04-20 | 北京云汉通航科技有限公司 | Unmanned prowl car |
-
2019
- 2019-03-12 CN CN201910185124.4A patent/CN109765913A/en not_active Withdrawn
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110341601A (en) * | 2019-06-14 | 2019-10-18 | 江苏大学 | A kind of pillar A blind is eliminated and auxiliary driving device and its control method |
CN110341601B (en) * | 2019-06-14 | 2023-02-17 | 江苏大学 | A-pillar blind area eliminating and driving assisting device and control method thereof |
CN112678089A (en) * | 2020-12-08 | 2021-04-20 | 北京云汉通航科技有限公司 | Unmanned prowl car |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108205325A (en) | A kind of round-the-clock unmanned cruiser system of four-wheel drive low speed | |
CN108469820A (en) | A kind of round-the-clock unmanned cruiser system of two-wheel drive low speed | |
CN1331641C (en) | Security ensuring and patrolling robot | |
CN108279681A (en) | A kind of two-wheel drive type low speed cruiser system and working method | |
CN106054896A (en) | Intelligent navigation robot dolly system | |
CN104238566B (en) | Electronic circuit is with inspection robot control system based on image recognition | |
CN113085896B (en) | Auxiliary automatic driving system and method for modern rail cleaning vehicle | |
CN206833250U (en) | A kind of unmanned investigation dolly based on laser radar | |
CN102608998A (en) | Vision guiding AGV (Automatic Guided Vehicle) system and method of embedded system | |
CN108177651A (en) | A kind of quick unmanned vehicle detection obstacle avoidance system of Multi-sensor Fusion | |
CN109799833A (en) | A kind of unmanned cruiser system of two-wheel drive low speed and working method | |
WO2015100899A1 (en) | Intelligent cruise robot based on wireless charging odd-shaft aircraft | |
CN109514566A (en) | A kind of intelligent monitoring machine people based on raspberry pie | |
CN108037756A (en) | A kind of Multi-sensor Fusion middling speed unmanned vehicle detects obstacle avoidance system | |
CN111459172A (en) | Autonomous navigation system of boundary security unmanned patrol car | |
CN109765908A (en) | A kind of six wheel drives quickly unmanned cruiser system and working method | |
CN108279683A (en) | A kind of round-the-clock unmanned cruiser system of six wheel drive low speed | |
CN108227720A (en) | A kind of round-the-clock unmanned cruiser system of four-wheel drive high speed | |
CN109765913A (en) | A kind of round-the-clock unmanned cruiser system of two-wheel drive | |
CN113810655B (en) | Implementation method of intelligent life-saving system in lake area | |
CN108189834A (en) | A kind of Multi-sensor Fusion low speed unmanned vehicle detects obstacle avoidance system | |
CN109799832A (en) | A kind of unmanned cruiser system of four-wheel drive low speed and working method | |
CN108490936A (en) | A kind of round-the-clock unmanned cruiser system of two-wheel drive high speed | |
CN2739724Y (en) | Patrol electronic policeman | |
CN108334096A (en) | A kind of round-the-clock unmanned cruiser system of novel two-wheel drive high speed |
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: 20190517 |
|
WW01 | Invention patent application withdrawn after publication |