CN206959855U - A kind of alignment system of automatical pilot transportation vehicle - Google Patents

A kind of alignment system of automatical pilot transportation vehicle Download PDF

Info

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
Application number
CN201720905462.7U
Other languages
Chinese (zh)
Inventor
林焯华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangzhou Alubi Electronic Technology Co Ltd
Original Assignee
Guangzhou Alubi Electronic Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Guangzhou Alubi Electronic Technology Co Ltd filed Critical Guangzhou Alubi Electronic Technology Co Ltd
Priority to CN201720905462.7U priority Critical patent/CN206959855U/en
Application granted granted Critical
Publication of CN206959855U publication Critical patent/CN206959855U/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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

A kind of alignment system of automatical pilot transportation vehicle
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.
CN201720905462.7U 2017-07-25 2017-07-25 A kind of alignment system of automatical pilot transportation vehicle Active CN206959855U (en)

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)

* Cited by examiner, † Cited by third party
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

Cited By (1)

* Cited by examiner, † Cited by third party
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