CN206959855U - A kind of alignment system of automatical pilot transportation vehicle - Google Patents
A kind of alignment system of automatical pilot transportation vehicle Download PDFInfo
- Publication number
- CN206959855U CN206959855U CN201720905462.7U CN201720905462U CN206959855U CN 206959855 U CN206959855 U CN 206959855U CN 201720905462 U CN201720905462 U CN 201720905462U CN 206959855 U CN206959855 U CN 206959855U
- Authority
- CN
- China
- Prior art keywords
- car body
- camera
- microcontroller
- transportation vehicle
- accelerometer
- 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.)
- Active
Links
Landscapes
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The alignment system for the automatical pilot transportation vehicle that the utility model embodiment provides, wherein, the alignment system includes:Accelerometer, gyroscope, magnetometer, photoelectric encoder, ultrasonic probe, camera and microcontroller;The accelerometer, the gyroscope, the magnetometer, the photoelectric encoder, the ultrasonic probe and the camera are connected with the microcontroller respectively.By using accelerometer, gyroscope, magnetometer, photoelectric encoder, ultrasonic probe and camera, the data related to the current pose of automatical pilot transportation vehicle, position etc. can be obtained comprehensive, multi-facetedly, overcome the deficiency that tradition uses single-sensor method;The data got are handled simultaneously, so as to more be accurately obtained the information such as the current posture of automatical pilot transportation vehicle, position, realize the high accuracy positioning to automatical pilot transportation vehicle, while also contribute to the precision navigation of automatical pilot transportation vehicle.
Description
Technical field
The utility model embodiment, which is related to, is automatically positioned field of navigation technology, more particularly to a kind of automatical pilot transportation vehicle
Alignment system.
Background technology
In recent years, with the fast development of Intelligent logistics industry, automatical pilot transportation vehicle (Automated Guided
Vehicle, AGV) with its operating efficiency it is high, the advantages such as human cost, work circumstances safe can be reduced, obtained more and more extensive
Application.
Research AGV key is how it is accurately positioned and navigated, on the other hand, the mode of tradition and low cost is to use
Magnetic stripe, equipped with information such as Quick Response Code, smallpox plate features, this method motion path is controllable, safe, but to the limitation in path
It is larger;Also part uses gyroscope and accelerometer, but this method can only provide course angle information, can only be used as assisting navigation work
Tool;In addition, also there is the method that part uses laser SLAM, although this method can provide high-precision location information, price is non-
Chang Anggui.
Therefore, it can meet that being accurately positioned navigation and can enough reduces cost, it is necessary to study one kind with AGV extensive use
AGV Position Fixing Navigation Systems.
The content of the invention
The utility model provides a kind of alignment system of automatical pilot transportation vehicle, to realize the height to automatical pilot transportation vehicle
Precision positions and navigation.
In a first aspect, the utility model embodiment provides a kind of alignment system of automatical pilot transportation vehicle, including accelerate
Spend meter, gyroscope, magnetometer, photoelectric encoder, ultrasonic probe, camera and microcontroller;The accelerometer, the top
Spiral shell instrument, the magnetometer, the photoelectric encoder, the ultrasonic probe and the camera connect with the microcontroller respectively
Connect;Wherein:
The accelerometer, the acceleration of motion of the car body for measuring the automatical pilot transportation vehicle;
The gyroscope, for measuring the angular velocity of satellite motion of car body;
The magnetometer, for measuring the abundance in car body surrounding magnetic field;
The photoelectric encoder, shape is encoded for measuring the rotation information of car body drive device, and by the rotation information
Into corresponding photoelectric pulse signal;
The ultrasonic probe, for measuring the relative distance of vehicle bottom and ground;
The camera, for obtaining the ground image data of vehicle bottom;
The microcontroller, for handling the acceleration, the angular speed, the abundance in the magnetic field, the photoelectricity
Pulse signal, the relative distance and the ground image data obtain location data.
Further, the photoelectric encoder is on the rotating spindle of the driving wheel of the automatical pilot transportation vehicle;
The ultrasonic probe is located at the bottom of the car body, and towards ground;
The camera is located at the bottom of the car body, and towards ground.
Further, the accelerometer is 3 axis MEMS accelerometer;
The gyroscope is three axis MEMS gyro;
The magnetic force is calculated as 3 axis MEMS magnetometer;
The photoelectric encoder, including incremental encoder, absolute type encoder and hybrid absolute value encoder;
The camera is wide-angle camera.
Further, the accelerometer, the gyroscope and the magnetometer by SPI or I2C interface with it is described micro-
Controller connects.
Further, the photoelectric encoder is connected by I/O circuit with the microcontroller.
Further, the ultrasonic probe is connected by serial interface circuit with the microcontroller.
Further, the camera is connected by usb circuit with the microcontroller.
Second aspect, the utility model embodiment additionally provide a kind of automatical pilot transportation vehicle, including described in first aspect
Position Fixing Navigation System.
The alignment system for the automatical pilot transportation vehicle that the utility model embodiment provides, by using accelerometer, gyro
Instrument, magnetometer, photoelectric encoder, ultrasonic probe and camera, it can comprehensive, multi-facetedly obtain and be transported with homing guidance
The related data such as the current pose of car, position, overcome the deficiency that tradition uses single-sensor method;Simultaneously to getting
Data handled, so as to more be accurately obtained the information such as the current posture of automatical pilot transportation vehicle, position, realize
To the high accuracy positioning of automatical pilot transportation vehicle, while also contribute to the precision navigation of automatical pilot transportation vehicle.
Brief description of the drawings
Fig. 1 is a kind of structural representation of the alignment system of automatical pilot transportation vehicle in the utility model embodiment one;
Fig. 2 is a kind of flow chart of localization method for automatical pilot transportation vehicle in the utility model embodiment two;
Fig. 3 is a kind of structural representation of automatical pilot transportation vehicle in the utility model embodiment three;
Embodiment
The utility model is described in further detail with reference to the accompanying drawings and examples.It is understood that herein
Described specific embodiment is used only for explaining the utility model, rather than to restriction of the present utility model.Further need exist for
It is bright, for the ease of description, the part related to the utility model rather than entire infrastructure are illustrate only in accompanying drawing.
Embodiment one
Fig. 1 is a kind of structural representation of the alignment system for automatical pilot transportation vehicle that the utility model embodiment one provides
Figure.As shown in figure 1, the alignment system includes:It is accelerometer 110, gyroscope 120, magnetometer 130, photoelectric encoder 140, super
Sonic probe 150, camera 160 and microcontroller 170.Accelerometer 110, gyroscope 120, magnetometer 130, photoelectric encoder
140th, ultrasonic probe 150, camera 160 are connected with microcontroller 170 respectively.
In the present embodiment, accelerometer 110, gyroscope 120 and magnetometer 130 preferably can by SPI or I2C interface with
Microcontroller 170 is attached;Photoelectric encoder 140 can be preferably attached by I/O circuit and microcontroller 170;Ultrasound
Ripple probe 150 can be preferably attached by serial interface circuit and microcontroller 170;Camera 160 can preferably pass through
Usb circuit is attached with microcontroller 170.
Wherein, accelerometer 110, the acceleration of motion of the car body for measuring automatical pilot transportation vehicle;Gyroscope 120,
For measuring the angular velocity of satellite motion of car body;Magnetometer 130, for measuring the abundance of car body surrounding magnetic field;Photoelectric encoder
140, encode to form corresponding photoimpact letter for measuring the rotation information of car body drive device, and by the rotation information
Number;Ultrasonic probe 150, for measuring the relative distance of vehicle bottom and ground;Camera 160, for obtaining vehicle bottom
Ground image data;Microcontroller 170, for handling acceleration, angular speed, the abundance in magnetic field, photoelectric pulse signal, institute
State relative distance and the ground image data obtain location data.
In the present embodiment, the installation site of accelerometer 110, gyroscope 120 and magnetometer 130 in car body is without spy
It is different to limit, as long as not influenceing its normal work, both car body can be installed on independently of microcontroller;Again can be with microcontroller
Device is installed on car body after being integrated into an entirety, now, can improve the integrated level of each part of alignment system, reduce alignment system
The difficulty of installation.Photoelectric encoder 140 obtains the rotation information relevant with wheel due to needing, to facilitate subsequent microcontroller
170 calculate movement velocity, travel distance and the steering angle of car body, should be installed in the drive device of car body, can preferably install
In on the rotating spindle of drive device intrinsic motivation or on the rotating spindle of driving wheel.Ultrasonic probe 150 and camera 160 are excellent
Choosing is mountable to the bottom of car body, and is set both facing to ground;Herein it should be noted that ultrasonic probe 150 and shooting
First 160 should be close proximity in the position of underbody, can be with to ensure the intersection point of ultrasonic wave that ultrasonic probe 150 sends and ground
The center of circle being similar in the ground areas imaging of camera 160, facilitates follow-up data to handle.
In the present embodiment, by using accelerometer, gyroscope, magnetometer, photoelectric encoder, ultrasonic probe and take the photograph
As head, the data related to the current pose of automatical pilot transportation vehicle, position etc. can be obtained comprehensive, multi-facetedly, are overcome
Tradition uses the deficiency of single-sensor method;The data got are handled simultaneously, so as to more accurately obtain
To information such as the current posture of automatical pilot transportation vehicle, positions, the high accuracy positioning to automatical pilot transportation vehicle is realized, simultaneously
Also contribute to the precision navigation of automatical pilot transportation vehicle.
On the basis of above-described embodiment, further, accelerometer 110 preferably can be 3 axis MEMS accelerometer;
Gyroscope 120 preferably can be three axis MEMS gyro;Magnetometer 130 preferably can be 3 axis MEMS magnetometer;Photoelectric coding
Device 140 preferably can be incremental encoder, absolute type encoder and hybrid absolute value encoder etc.;Camera 160 is preferred
It can be wide-angle camera.
In the present embodiment, 3 axis MEMS accelerometer, three axis MEMS gyro and the measurable X of 3 axis MEMS magnetometer,
Y, the data of tri- axial directions of Z, with ensure survey data it is comprehensively accurate;The image range that wide-angle camera can collect is wide, can
Increase the validity of institute's altimetric image data, to improve the utilization rate of view data.
Exemplary, 3 axis MEMS accelerometer, three axis MEMS gyro in the alignment system of automatical pilot transportation vehicle
The abundance for measuring obtained body movement acceleration, angular speed and magnetic field is sent out by SPI interface with 3 axis MEMS magnetometer
Give the microcontroller of the system;The incremental encoder being installed on car body left and right sidesing driving wheel main shaft, will be with car body driving wheel
Rotation information related photoelectric pulse signal microcontroller is sent to by I/O circuit;It is installed on underbody and surpassing towards ground
Sonic probe, the relative distance of the vehicle bottom measured and ground is sent to microcontroller by serial line interface;It is installed on
The ground image data of vehicle bottom are sent to microcontroller by underbody and towards the camera on ground by usb circuit.
The microcontroller 170 is receiving acceleration, angular speed, the abundance in magnetic field, photoelectric pulse signal, relative distance and surface map
As after data, handling above-mentioned data, obtaining the location data of automatical pilot transportation vehicle.In addition, alignment system also includes
The data outputting module (not shown) being connected with microcontroller, microcontroller are obtained above-mentioned processing by data outputting module
Location data export master control system to automatical pilot transportation vehicle, for automatical pilot transportation vehicle master control system to leading automatically
Draw transport vehicle and carry out positioning in real time and navigation.Data outputting module can also be with accelerometer 110, gyroscope 120, magnetometer
130 and microcontroller 170 be integrated into the car body that automatical pilot transportation vehicle is installed on after an entirety, improve each portion of alignment system
The integrated level of part, reduce the difficulty of alignment system installation.
Embodiment two
Fig. 2 is a kind of flow for localization method for automatical pilot transportation vehicle that the utility model embodiment two provides
Figure, this method can be performed by the microcontroller of the alignment system in the various embodiments described above, including:
Step 210, initial data is received, initial data includes acceleration, angular speed, the abundance in magnetic field, photoimpact
Signal, vehicle bottom and the relative distance on ground and ground image data.
In the present embodiment, microcontroller receives initial data, and the initial data is by the alignment system in the various embodiments described above
In accelerometer, gyroscope, magnetometer, photoelectric encoder, ultrasonic probe and camera obtain and send respectively.
Step 220, data scaling is carried out to initial data, merge or mutually compensates for processing acquisition location data.
In the present embodiment, received by microcontroller by accelerometer, gyroscope, magnetometer, photoelectric encoder, ultrasonic wave
Comprehensive and multi-faceted, related to the current pose of automatical pilot transportation vehicle, position etc. number that probe and camera are sent
According to, overcome tradition use single-sensor data deficiency;Data scaling, fusion or phase are carried out to the data got simultaneously
Mutual compensation deals, so as to more be accurately obtained the information such as the current posture of automatical pilot transportation vehicle, position, realize pair
The high accuracy positioning of automatical pilot transportation vehicle, while also contribute to the precision navigation of automatical pilot transportation vehicle.
On the basis of above-described embodiment, further, step 220 specifically includes following steps:
(1) attitude data fusion is carried out to acceleration, angular speed and the abundance in magnetic field, obtains the attitude data of car body.
In the present embodiment, the motion state of car body can more accurately be judged using the attitude information of car body, therefore,
Attitude data can be carried out using attitude data blending algorithm to acceleration signal, angular velocity signal and magnetic field variation signal to melt
Close, to obtain attitude data, wherein, the attitude data includes the angle of pitch, yaw angle and the roll angle of car body.
In the present embodiment, attitude data blending algorithm is preferably but not limited to extended pattern Kalman filter.
(2) ground view data is demarcated using relative distance, obtains the location variation of car body in the horizontal plane.
In this example, its relative distance with ground that can preferably be measured according to ultrasonic probe, and combine camera
The angle of visual field, calculate the ultimate range on the ground that camera can photograph.The ground got using the distance to camera
Face view data is demarcated, you can the True Ground Range corresponding to each pixel in ground image data is obtained, so far,
Complete the demarcation to view data.
In the motion process of car body, camera can carry out IMAQ with sample frequency set in advance to ground, excellent
Choosing can utilize image characteristics extraction, in the view data for adjacent two frame that camera is got, select same feature
Point is as a reference point, and determines in adjacent two field pictures data, the pixel number that target point moves relative to reference point, according to
True Ground Range corresponding to pixel number and pixel, you can determine the location variation of car body.
(3) photoelectric pulse signal is utilized, obtains movement velocity, travel distance and the steering angle of car body.
Exemplary, photoelectric encoder is arranged on car body left and right sidesing driving wheel, in car body in motion process, installed in a left side
Photoelectric encoder in right driving wheel, the rotation information of left and right sidesing driving wheel is gathered respectively, and by the information with photoelectric pulse signal
Form be sent to microcontroller.Microcontroller using the photoelectric pulse signal calculate the movement velocity of car body, travel distance and
Steering angle, wherein, steering angle refers to yaw angle, i.e. the car body corner on left and right directions in the horizontal plane.
In the present embodiment, car body is in linear motion, and the data being calculated using photoelectric pulse signal are included
The movement velocity and travel distance of car body;When angular deflection occurs in motion process for car body, calculated using photoelectric pulse signal
Obtained data include movement velocity, travel distance and the steering angle of car body.
(4) carry out car body skidding using location variation and photoelectric pulse signal to detect, obtain car body skidding and judge data.
In the present embodiment, the location variation that is obtained using ground image data, it may be determined that position of the car body with respect to ground
Move;Utilize photoelectric pulse signal, it may be determined that the rotating speed of wheel, so that it is determined that distance of the wheel with respect to ground rotation.Car body is not
During generation skidding, using ground image data obtain location variation with using photoelectric pulse signal obtain traveling away from
From equal.Once skidding occurs for car body, the two is no longer equal.
In order to judge whether car body is in slipping state, it is necessary to utilize location variation and photoelectric pulse signal to carry out car body
Skid and detect, specifically, skidding detection includes:If detecting, photoelectric pulse signal changes, and location variation is constant, it is determined that car
Body skids.
In the present embodiment, when skidding occurs for car body, in the ground image data that camera collects, adjacent two frame
The pixel number between target point and reference point in image is constant, i.e., the position of the car body obtained by ground image data becomes
Change amount is 0;And driving wheel then can be constantly in rotary state due to the driving effect of drive device, photoelectric encoder is persistently sent out
Photoelectric pulse signal is sent, the travel distance of the car body obtained by photoelectric pulse signal is not 0, it is clear that in this case, photoelectricity
Pulse signal confidence level is relatively low.Therefore, by contrasting photoelectric pulse signal and location variation, you can judge whether car body is in
Slipping state, when detecting that photoelectric pulse signal changes, and when location variation is constant, determine that car body is in slipping state;When
Detect that photoelectric pulse signal changes, and when location variation also changes, determine that car body is not in slipping state.
(5) skidded using car body and judge that data carry out mutually compensating for handling to photoelectric pulse signal and attitude data, obtained
Photoelectric pulse signal and attitude data after overcompensation.
In the present embodiment, it is preferred that skidded according to car body and judge data, phase is carried out to photoelectric pulse signal and attitude data
Mutually the method for compensation deals is:Respectively photoelectric pulse signal and attitude data, which set one and skidded by car body, judges data dynamic
The reliability coefficient of adjustment.Specifically, when it is determined that car body is not in slipping state, photoelectric pulse signal and attitude data can
Row degree coefficient is all higher, preferably can be set as the numerical value between 0.90-1.00;When it is determined that car body is in slipping state,
The reliability coefficient of photoelectric pulse signal is relatively low, preferably can be set as the numerical value between 0.00-0.10, attitude data it is credible
It is high to spend coefficients comparison, preferably can be set as the numerical value between 0.90-1.00.
(6) course angle fusion is carried out to the photoelectric pulse signal after dynamic adjusts and attitude data, obtains car body
Course angle.
In the present embodiment, the reliability coefficient of photoelectric pulse signal is the movement velocity of car body, travel distance and steering angle
Reliability coefficient, therefore, by reliability coefficient with obtained by photoelectric pulse signal the movement velocity of car body, travel distance and
Steering angle matches, and obtains that there is the movement velocity of reliability coefficient, travel distance and steering angle to match.
In the present embodiment, course angle is equal to the steering angle of car body, yaw angle, by the steering angle with reliability coefficient with
Yaw angle with reliability coefficient carries out course angle fusion, obtains the course angle of car body, wherein, course angle blending algorithm is excellent
Select but be not limited to complementary type Kalman filter.
(7) Co-factor propagation is carried out to location variation and course angle, obtains the change in location data of car body.
In the present embodiment, Co-factor propagation is carried out to location variation and course angle combination gait of march, wherein, Co-factor propagation
Algorithm, preferably can be complementary type Kalman filter, wherein, complementary parameter is that location variation and course angle are combined and had
The displacement that the gait of march of reliability coefficient obtains.To location variation and course angle and combine gait of march progress Co-factor propagation
Afterwards, the change in location data of car body be can obtain.
By above-mentioned data scaling, merge or mutually compensate for processing after, be finally available from the positioning of dynamic guide transport lorry
Data, including:Acceleration, movement velocity, the car body of car body, which skid, judges data, course angle and change in location data, wherein, fortune
Dynamic speed is the movement velocity with reliability coefficient.
Embodiment three
Fig. 3 is a kind of structural representation for automatical pilot transportation vehicle that the utility model embodiment three provides.Such as Fig. 3 institutes
Show, automatical pilot transportation vehicle 300 includes the alignment system 310 in embodiment one.
In the present embodiment, alignment system 310 is connected by data outputting module with master control system, can preferably be used wireless
The mode of connection, master control system receives the location data that alignment system 310 is sent, and combines default navigation way, can be right
Car body is accurately positioned and assisting navigation.
In addition, the automatical pilot transportation vehicle also includes memory 320, obtained in the course of the work for storing alignment system
The Various types of data got.
Exemplary, automatical pilot transportation vehicle works in indoor environment, in motion process, the acceleration in its alignment system
Degree meter, gyroscope, magnetometer, photoelectric encoder, ultrasonic probe and camera obtain respectively the acceleration of car body, angular speed,
The abundance in magnetic field, the photoelectric pulse signal related to the rotating speed of driving wheel, relative distance and ground image data with ground,
And it is sent to microcontroller and memory.
Microcontroller is handled each data received using the localization method in the various embodiments described above, specifically:
The attitude data of car body, including the angle of pitch of car body, driftage are obtained by acceleration, angular speed and the abundance in magnetic field
Angle and roll angle, because car body is mainly used in loading and the transport of goods, typically it will not pitch and turn on one's side, it is corresponding
The angle of pitch and roll angle can be smaller, therefore, in acquired attitude data, the attitude angle to play a leading role is yaw angle.
After obtaining the attitude data of car body, car body is accurately positioned in order to realize, it is also necessary to which the position for obtaining car body becomes
Change data, the change in location data are determined jointly by the relative distance with ground and ground image data.Utilize the phase with ground
The angle of visual field adjusted the distance with camera itself, ground view data is demarcated, obtain the ground corresponding to each pixel
Actual range, so, by contrasting the pixel number that target point moves relative to reference point in adjacent two field pictures data, just
The location variation of car body can be obtained.
Typically, discounting for other factors, get the attitude data of above-mentioned car body and location variation data it
Afterwards, you can complete the positioning of car body.But in car body traveling process, often because the phenomenon skidded occurs in a variety of causes,
Again because car body is in homing guidance state, when skidding occurs, it timely can not obtain and all handle.
Based on this, photoelectric encoder is set in alignment system, the photoelectric encoder is installed on the rotation of left and right sidesing driving wheel
On main shaft, the photoelectric pulse signal related to left and right sidesing driving wheel rotation information is obtained.And it is derived from the movement velocity, OK of car body
Enter distance and steering angle.
Car body is in normal motion, and location variation is also becoming while photoelectric pulse signal changes
Change, once car body skids, then location variation no longer changes, but in the process, photoelectric pulse signal still exists
Change, now, the Reliability ratio of the signal is relatively low.
When car body is in slipping state, it is necessary to which attitude data and change in location data to car body compensate correction,
To obtain more accurately location data.
Data are judged to when judging that car body is in slipping state according to skidding, respectively photoelectric pulse signal and posture number
According to setting one by car body skid judge data dynamic adjustment reliability coefficient, when skidding when, photoelectric pulse signal it is credible
It is relatively low to spend coefficient ratio, 0.05 can be set to, the reliability coefficient of attitude data is higher, can be set to 0.95, utilizes complementary type card
Thalmann filter is carried out to the yaw angle in the steering angle and attitude data by being obtained with reliability coefficient photoelectric pulse signal
Course angle merges, and obtains the relatively accurate course angular data after compensation correction.
Because photoelectric pulse signal has reliability coefficient, then thus obtained gait of march also has reliability coefficient.
Position is carried out using complementary type Kalman filter to the displacement obtained by location variation and course angle combination gait of march to melt
Close, obtain the relatively accurate change in location data after compensation correction.
Data after treatment are sent to the master control of automatical pilot transportation vehicle by microcontroller by data outputting module
System and memory, acceleration of the transmitted location data including car body, movement velocity, car body, which skid, judges data, course
Angle and change in location data, wherein, movement velocity is the movement velocity with reliability coefficient.
Master control system can realize that being accurately positioned for car body is alarmed with sipping fault using location data, and in car body row
During entering, master control system can also be used location data and carry out assisting navigation to car body.
Pay attention to, above are only preferred embodiment of the present utility model and institute's application technology principle.Those skilled in the art's meeting
Understand, the utility model is not limited to specific embodiment described here, can carried out for a person skilled in the art various bright
Aobvious change, readjust and substitute without departing from the scope of protection of the utility model.Therefore, although passing through above example
The utility model is described in further detail, but the utility model is not limited only to above example, is not departing from
In the case that the utility model is conceived, other more equivalent embodiments can also be included, and the scope of the utility model is by appended
Right determine.
Claims (8)
1. a kind of alignment system of automatical pilot transportation vehicle, it is characterised in that including accelerometer, gyroscope, magnetometer, photoelectricity
Encoder, ultrasonic probe, camera and microcontroller;The accelerometer, the gyroscope, the magnetometer, the light
Photoelectric coder, the ultrasonic probe and the camera are connected with the microcontroller respectively;Wherein:
The accelerometer, the acceleration of motion of the car body for measuring the automatical pilot transportation vehicle;
The gyroscope, for measuring the angular velocity of satellite motion of car body;
The magnetometer, for measuring the abundance in car body surrounding magnetic field;
The photoelectric encoder, for measuring the rotation information of car body drive device, and the rotation information encoded to be formed pair
The photoelectric pulse signal answered;
The ultrasonic probe, for measuring the relative distance of vehicle bottom and ground;
The camera, for obtaining the ground image data of vehicle bottom;
The microcontroller, for handling the acceleration, the angular speed, the abundance in the magnetic field, the photoimpact
Signal, the relative distance and the ground image data obtain location data.
2. system according to claim 1, it is characterised in that
The photoelectric encoder is on the rotating spindle of the driving wheel of the automatical pilot transportation vehicle;
The ultrasonic probe is located at the bottom of the car body, and towards ground;
The camera is located at the bottom of the car body, and towards ground.
3. system according to claim 1 or 2, it is characterised in that
The accelerometer is 3 axis MEMS accelerometer;
The gyroscope is three axis MEMS gyro;
The magnetic force is calculated as 3 axis MEMS magnetometer;
The photoelectric encoder, including incremental encoder, absolute type encoder and hybrid absolute value encoder;
The camera is wide-angle camera.
4. system according to claim 1, it is characterised in that
The accelerometer, the gyroscope and the magnetometer are connected by SPI or I2C interface with the microcontroller.
5. system according to claim 1, it is characterised in that
The photoelectric encoder is connected by I/O circuit with the microcontroller.
6. system according to claim 1, it is characterised in that
The ultrasonic probe is connected by serial interface circuit with the microcontroller.
7. system according to claim 1, it is characterised in that
The camera is connected by usb circuit with the microcontroller.
8. a kind of automatical pilot transportation vehicle, it is characterised in that including the Position Fixing Navigation System described in claim any one of 1-7.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201720905462.7U CN206959855U (en) | 2017-07-25 | 2017-07-25 | A kind of alignment system of automatical pilot transportation vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201720905462.7U CN206959855U (en) | 2017-07-25 | 2017-07-25 | A kind of alignment system of automatical pilot transportation vehicle |
Publications (1)
Publication Number | Publication Date |
---|---|
CN206959855U true CN206959855U (en) | 2018-02-02 |
Family
ID=61381334
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201720905462.7U Active CN206959855U (en) | 2017-07-25 | 2017-07-25 | A kind of alignment system of automatical pilot transportation vehicle |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN206959855U (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108459606A (en) * | 2018-03-29 | 2018-08-28 | 哈尔滨理工大学 | A kind of Intelligent tracing racing balance car based on neural network |
-
2017
- 2017-07-25 CN CN201720905462.7U patent/CN206959855U/en active Active
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108459606A (en) * | 2018-03-29 | 2018-08-28 | 哈尔滨理工大学 | A kind of Intelligent tracing racing balance car based on neural network |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111033176B (en) | Map information providing system | |
CN107228663A (en) | The alignment system and method for a kind of automatical pilot transportation vehicle | |
CN106123908B (en) | Automobile navigation method and system | |
Rose et al. | An integrated vehicle navigation system utilizing lane-detection and lateral position estimation systems in difficult environments for GPS | |
Su et al. | GR-LOAM: LiDAR-based sensor fusion SLAM for ground robots on complex terrain | |
CN107615201B (en) | Self-position estimation device and self-position estimation method | |
CN104597905B (en) | Route tracking method for magnetic navigation AGV | |
CN110307850A (en) | Reckoning localization method and automated parking system | |
JP4756931B2 (en) | Digital lane mark creation device | |
CN107422730A (en) | The AGV transportation systems of view-based access control model guiding and its driving control method | |
CN111044073B (en) | High-precision AGV position sensing method based on binocular laser | |
CN112014849B (en) | Unmanned vehicle positioning correction method based on sensor information fusion | |
Yoshida et al. | A sensor platform for outdoor navigation using gyro-assisted odometry and roundly-swinging 3D laser scanner | |
US20050125108A1 (en) | Motion estimation method and system for mobile body | |
CN109933056A (en) | A kind of robot navigation method and robot based on SLAM | |
Zhang et al. | Lidar-IMU and wheel odometer based autonomous vehicle localization system | |
CN110398251B (en) | Trackless navigation AGV positioning system based on multi-sensor fusion and positioning method thereof | |
CN109141410A (en) | The Multi-sensor Fusion localization method of AGV integrated navigation | |
CN110763224A (en) | Navigation method and navigation system for automatic guided transport vehicle | |
CN108036792A (en) | A kind of data fusion method of odometer for mobile robot and measurement pose | |
CN110864692A (en) | Pose determination method of heading machine | |
CN112710301B (en) | High-precision positioning method and system for automatic driving vehicle | |
CN111857121A (en) | Patrol robot walking obstacle avoidance method and system based on inertial navigation and laser radar | |
CN117234203A (en) | Multi-source mileage fusion SLAM downhole navigation method | |
Lamon et al. | 3D position tracking in challenging terrain |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
GR01 | Patent grant | ||
GR01 | Patent grant |