CN106292660B - Balance car course corrections device and method based on odometer and gray-scale sensor - Google Patents
Balance car course corrections device and method based on odometer and gray-scale sensor Download PDFInfo
- Publication number
- CN106292660B CN106292660B CN201610635588.7A CN201610635588A CN106292660B CN 106292660 B CN106292660 B CN 106292660B CN 201610635588 A CN201610635588 A CN 201610635588A CN 106292660 B CN106292660 B CN 106292660B
- Authority
- CN
- China
- Prior art keywords
- balance car
- gray
- path
- odometer
- wheeled balance
- 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
- 238000012937 correction Methods 0.000 title claims abstract description 119
- 238000000034 method Methods 0.000 title claims abstract description 24
- 230000007246 mechanism Effects 0.000 claims abstract description 4
- 241001269238 Data Species 0.000 claims description 8
- 230000006870 function Effects 0.000 claims description 6
- 238000005303 weighing Methods 0.000 claims description 4
- 230000006698 induction Effects 0.000 description 5
- 238000005245 sintering Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000007689 inspection Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 229910015335 Ni2In Inorganic materials 0.000 description 1
- 230000033228 biological regulation Effects 0.000 description 1
- 239000003086 colorant Substances 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000001681 protective effect Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0253—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Motorcycle And Bicycle Frame (AREA)
Abstract
The present invention relates to a kind of balance car course corrections device and method based on odometer and gray-scale sensor, device is arranged on two-wheeled balance car, including controller interconnected and two-wheeled balance car driving mechanism, two odometers, two gray-scale sensors and multiple correction zones, two odometers and two gray-scale sensors are connect with controller respectively, the revolver and right wheel of two-wheeled balance car respectively install an odometer and a gray-scale sensor, each correction zone includes two and is not parallel to each other also disjoint colour band, colour band fixes on the ground, and intersect with the standard routes of two-wheeled balance car.Compared with prior art, the present invention judges two-wheeled balance truck position and posture using gray-scale sensor and odometer, to be compared to deviate with normal data, carry out course corrections, do not need to be laid with track or colour band in system-wide section, real-time is good, be easily installed, be at low cost, be not easy it is affected by environment.
Description
Technical field
The present invention relates to a kind of course corrections methods of two-wheeled balance car, are based on odometer and gray scale more particularly, to one kind
The two-wheeled balance car course corrections device and method of sensor.
Background technique
In recent years, two-wheeled balance car because of its movement flexibly, intelligent control, it is easy to operate, save the energy, the spies such as environmentally protective
Point in the modern means of communication using more and more extensive, such as daily walking-replacing tool, the inspection of police's public security, advertisement a surname
Pass, assist shooting etc..However, two-wheeled balance car is automatic at it as a member in family, robot other than its manned function
Patrol robot can be substituted in many instances after carrying certain sensors on the basis of the basic functions such as walking, attitude regulation
Complete many tasks, such as power station inspection, community security, daily patrol, environmental monitoring, military surveillance.
At this stage, the sensors such as odometer, gyroscope, magnetic compass are usually used in robot localization under outdoor environment, but because of it
There are obvious shortcomings, are not used alone generally, are usually used in conjunction with other sensors, carry out information fusion.Patrol robot
It generallys use and carries odometer, visual sensor, ultrasonic sensor, laser range finder, magnetic navigation sensor, GPS, infrared ray
The modes such as sensor realize the functions such as its path planning, independent navigation, positioning, detection route.
When robot is after avoidance or when because of other reasons offset patrol path, as taken correction and adjustment to arrange not in time
Apply, error constantly accumulates during traveling, is not only unable to complete successfully patrol mission, also will increase robot enter into dead end or
The degree of danger to collide.Therefore during robot patrol its practical running route is compared with predefined paths and
It is corrected in time after assessment and adjustment is vital.Usually location information is carried out using the sensor carried thereon to adopt
Collection carries out the tracking and adjustment in path by position estimation and Obstacle Position or track location information.Currently, most of wheeled
Patrol robot is mainly based upon what visual sensor, infrared sensor or magnetic navigation sensor were designed and developed, and view-based access control model passes
The robot accuracy of identification of sensor is high, but vision positioning algorithm is complicated, and real-time is poor, and influences vulnerable to ambient light, operation
It is unstable;The lower, strong antijamming capability based on infrared sensor price, recognition speed is fast, but accuracy of identification is not high, it usually needs
Arrange that continuous road surface colour band flag information carrys out guided robot and advances in system-wide section;Magnetic navigation sensor is also required in system-wide section
It is laid with track or colour band, and under many practical applications, it is desirable that guide rail, track, colour band rail etc. are laid in patrol system-wide section
It is unpractical.
In the prior art, stereoscopic vision mode, cost are all made of for the course corrections during mobile robot patrol
Higher, real-time is poor and easily affected by environment, and also there has been no the course corrections sides used when going on patrol specifically for two-wheeled balance car
Method is used for manufacturer.
Summary of the invention
It can be balanced in two-wheeled it is an object of the present invention to overcome the above-mentioned drawbacks of the prior art and provide a kind of
Preassigned route is returned it to after vehicle avoidance or offset path balances bus or train route based on the two-wheeled of odometer and gray-scale sensor
Diameter means for correcting and method.
The purpose of the present invention can be achieved through the following technical solutions:
A kind of two-wheeled balance car course corrections device based on odometer and gray-scale sensor, including control interconnected
Device and two-wheeled balance car driving mechanism, further include two odometers, two gray-scale sensors and multiple correction zones, and described two
Odometer and two gray-scale sensors are connect with controller respectively, and the revolver and right wheel of two-wheeled balance car respectively install an odometer
With a gray-scale sensor, each correction zone includes two and is not parallel to each other also disjoint colour band, and the ribbon position is solid
It is fixed, and intersect with the standard routes of two-wheeled balance car,
Two-wheeled balance car presses memory route from the off, and memory path is generated according to standard routes, when two-wheeled is flat
Weighing apparatus vehicle is travelled to correction zone, and when gray-scale sensor senses that wheel presses through colour band, controller reads the real time data of odometer, root
The deviation between current Actual path and standard routes is calculated according to the normal data of real time data and the correction zone, and according to inclined
Difference carries out course corrections, and two-wheeled balance car is made to return to standard routes, then proceedes to traveling to next correction zone or terminates traveling,
Wherein, in each correction zone, there are four normal data and four real time datas, normal data acquisition methods include: two-wheeled balance
Vehicle is strictly travelled along standard routes from starting point, in corrected area when colour band, is made by the data that controller records two odometers
For the normal data of the correction zone.
The device further includes the charging pile being arranged on two-wheeled balance car path, and the charging pile is flat as two-wheeled
The starting point for the vehicle traveling that weighs.
It is a kind of that path being carried out based on the two-wheeled balance car course corrections device of odometer and gray-scale sensor using described
The method of correction, comprising the following steps:
S1, two-wheeled balance car start from the off, by memory route, two-wheeled balance car traveling Actual path with
There are deviations between standard routes;
S2, when wheel presses through colour band, the gray-scale sensor on the wheel sends signal to controller, and controller reads the vehicle
The real time data of odometer on wheel, and return step S2, until controller reads four real time datas, the reality in the correction zone
When reading data finish;
S3, controller calculate between two-wheeled balance car current Actual path and standard routes according to four real time datas
Deviation, and course corrections are judged whether to, if so, entering step S4, otherwise continuing by memory route and returning
Step S2, or terminate traveling;
S4, two-wheeled balance car pause traveling, calculates correction parameter according to deviation and is moved to standard road according to correction parameter
Diameter is then proceeded to by memory route and return step S2.
In the step S3, if deviation is less than setting value, without course corrections, two-wheeled balance car continues towards standard
Route and return step S2, if current correction area is the last one correction zone, without course corrections, two-wheeled balance car
Terminate traveling, otherwise enters step S4.
In the step S4, in i-th of correction zone, the deviation between currently practical path and standard routes includes angle
Deviation θiWith orientation deviation delta di, calculating formula is respectively as follows:
θi=βAi-αAi
Wherein, βAiFor the angle between the colour band pressed through and currently practical path for the first time of wheel in i-th of correction zone,
αAiFor the angle in i-th of correction zone between the wheel first time colour band pressed through and standard routes, αBiFor in i-th of correction zone
Angle between the colour band that wheel presses through for the second time and standard routes, Δ Li1For i-th of correction zone internal standard path and two colors
The distance between band intersection point, Δ Li2For the distance between Actual path and two colour band intersection points in i-th of correction zone;
Correction parameter Δ yiWithCalculating formula be respectively as follows:
Δyi=Δ Lmi sinθi-Δdi
Wherein, Δ LmiFor in i-th of correction zone, intersection point is arrived between the colour band that currently practical path and wheel press through for the second time
The distance between point to be corrected on Actual path, sgn (*) are sign function;
Two-wheeled balance car is moved to standard routes according to correction parameter method particularly includes: two-wheeled balance car direction is counterclockwise
Rotate φiAfter angle, advance along straight line where orientation to standard routes | Δ yi|, the rotation of another mistake hour handsAngle,
Standard routes and correct posture are returned to, the orientation is vertical with standard routes direction.
The distance between i-th of correction zone internal standard path and two colour band intersection points Δ Li1Calculating formula are as follows:
Wherein, LLiFor the mileage record value of balance car revolver revolver odometer within by this period between two colour bands,
LRiFor the mileage record value of balance car right wheel right wheel odometer within by this period between two colour bands;
The distance between Actual path and two colour band intersection points Δ L in i-th of correction zonei2Computing Principle and Δ Li1It is identical.
Compared with prior art, the invention has the following advantages that
(1) in such a way that colour band is set in correction zone, two-wheeled balance car is judged using gray-scale sensor and odometer
Position and posture carry out course corrections to be compared to deviate with normal data, do not need to be laid with color in system-wide section
Band, real-time is good, is easily installed, does not need human-computer interaction.
(2) gray-scale sensor is by electromagnetic interference influence, and the paving mode flexibility of colour band is high, easy to maintain and without broken
Bad road surface, cost is relatively low.
(2) starting point travelled using charging pile as two-wheeled balance car, without separately setting starting point, save the cost is easily managed, and
Meet two-wheeled balance car charging needs.
(3) in each correction zone, due to the special disposing way of two colour bands, it is ensured that odometer reads four in real time altogether
Data, to guarantee the reliability calculated.
(4), only need to be by rotation twice and primary displacement when course corrections, and angle and shift value are clear, can return to
Standard routes and correct posture.
Detailed description of the invention
Fig. 1 is that the present embodiment two-wheeled balance car standard routes generate and go on patrol course corrections flow chart;
Fig. 2 is the driving path and correction zone position view of the present embodiment two-wheeled balance car;
Fig. 3 is in the present embodiment, two-wheeled balance car calculated at corrected area between driving path and colour band angle and
The schematic diagram of mileage value;
Fig. 4 is to calculate current patrol path (path 2) in the present embodiment and the angle in preassigned path (path 1) is inclined
The geometric representation of difference and orientation deviation;
Fig. 5 is in the present embodiment, and preassigned path (path 1) and current patrol path (path 2) relative position are in
Under second situation, the angular deviation in path 2 and path 1 and the geometric representation of orientation deviation are calculated;
Fig. 6 (a), Fig. 6 (b) are preassigned path (path 1) and current patrol path (path 2) phase in the present embodiment
In the case of being in the third to position, the angular deviation in path 2 and path 1 and the geometric representation of orientation deviation are calculated;
Fig. 7 (a), Fig. 7 (b) are preassigned path (path 1) and current patrol path (path 2) phase in the present embodiment
In the case of being in the 4th kind to position, the angular deviation in path 2 and path 1 and the geometric representation of orientation deviation are calculated;
Fig. 8 is to converse the geometric representation of correction parameter in point to be corrected in the present embodiment;
Appended drawing reference: 101 be charging pile;10 be sintering;1 is first correction zone;2 be second correction zone;I is
I correction zone;K is k-th correction zone.
Specific embodiment
The present invention is described in detail with specific embodiment below in conjunction with the accompanying drawings.The present embodiment is with technical solution of the present invention
Premised on implemented, the detailed implementation method and specific operation process are given, but protection scope of the present invention is not limited to
Following embodiments.
Embodiment
A kind of two-wheeled balance car course corrections device based on odometer and gray-scale sensor, including control interconnected
Device and two-wheeled balance car driving mechanism, further include two odometers, two gray-scale sensors, charging pile and multiple correction zones, and two
A odometer and two gray-scale sensors are connect with controller respectively, and the revolver and right wheel of two-wheeled balance car respectively install a mileage
Meter and a gray-scale sensor, each correction zone are not parallel to each other also disjoint colour band, colour band including two and are fixed on ground
On, and intersect with the standard routes of two-wheeled balance car, charging pile is arranged on two-wheeled balance car path, balances garage as two-wheeled
The starting point sailed.
Two-wheeled balance car presses memory route from the off, and memory path is generated according to standard routes, when two-wheeled is flat
Weighing apparatus vehicle is travelled to correction zone, and when gray-scale sensor senses that wheel presses through colour band, controller reads the real time data of odometer, root
The deviation between current Actual path and standard routes is calculated according to the normal data of real time data and the correction zone, and according to inclined
Difference carries out course corrections, and two-wheeled balance car is made to return to standard routes, then proceedes to traveling to next correction zone or terminates traveling,
Wherein, in each correction zone, there are four normal data and four real time datas, normal data acquisition methods include: two-wheeled balance
Vehicle is strictly travelled along standard routes from starting point, in corrected area when colour band, is made by the data that controller records two odometers
For the normal data of the correction zone.
A kind of use carries out course corrections based on the two-wheeled balance car course corrections device of odometer and gray-scale sensor
Method, comprising the following steps:
S1, two-wheeled balance car start from the off, by memory route, two-wheeled balance car traveling Actual path with
There are deviations between standard routes;
S2, when wheel presses through colour band, the gray-scale sensor on the wheel sends signal to controller, and controller reads the vehicle
The real time data of odometer on wheel, and return step S2, until controller reads four real time datas, the reality in the correction zone
When reading data finish;
S3, controller calculate between two-wheeled balance car current Actual path and standard routes according to four real time datas
Deviation, and course corrections are judged whether to, if so, entering step S4, otherwise continuing by memory route and returning
Step S2, or terminate traveling;
S4, two-wheeled balance car pause traveling, calculates correction parameter according to deviation and is moved to standard road according to correction parameter
After diameter, then proceed to by memory route and return step S2.
As shown in Figure 1, in preassigned travel segment (dashed path surrounded in figure by a circle bar-shaped frame, have arrow)
One sintering and K correcting area are set, a charging pile 1 is installed in sintering, 1 position of charging pile is predetermined as balance car
The starting point of standard routes and patrol path.Pasting two on ground in each correcting area can be incuded by gray-scale sensor
The straight line colour band of identification, is denoted as A respectivelyiAnd Bi(i=1,2 ..., K), as shown in Fig. 2, colour band AiStarting point and terminating point
It is located at roadbed two sides, colour band BiStarting point and terminating point be also located at roadbed two sides, two colour bands are not parallel also not
Intersection, constitutes different any angles from two sides roadbed respectively.The left and right two-wheeled of balance car carries an odometer respectively
With a gray-scale sensor, when wheel marches to certain colour band, the gray-scale sensor induction on the wheel identifies colour band, and returns
Back to one signal of balance car, the odometer on the wheel will record the mileage at the moment at this time.
The first step, after booting, two-wheeled balance car is advanced since starting point along preassigned path, by each correction
Qu Shi records related data, and balance car direction of travel is obtained by calculation respectively between two colour bands in the correction zone
Parameter i=1 is arranged in the mileage value by advancing between two colour bands in angle and balance car.The specific method is as follows.
As shown in Fig. 3, it is assumed that balance car or so two-wheeled spacing is DLR, balance car direction of travel is always perpendicular to two-wheeled wheel
Axis direction.When balance car passes through i-th of correction zone, it is assumed that right wheel first reaches colour band Ai, i.e. balance car advances to position xA1When,
Gray-scale sensor induction in right wheel recognizes colour band Ai, it is L that the odometer in right wheel, which records current mileage value, at this timeRi1, when flat
Weighing apparatus vehicle continues to revolver and reaches colour band AiWhen, i.e., balance car advances to position xA2When, the gray-scale sensor induction on revolver
Recognize colour band Ai, the odometer on revolver and right wheel records current mileage value L respectively at this timeLi1And LRi2, right wheel during this period
Traveling mileage is
LAi=LRi2-LRi1
According to geometrical relationship in figure, balance car direction of travel and colour band A can be calculatediBetween angle αAiFor
Balance car continues on, similarly, when right wheel reaches colour band BiWhen, i.e., balance car advances to position xB1When, in right wheel
Gray-scale sensor induction recognize colour band Bi, the odometer in right wheel records current mileage value LRi3, when revolver reaches colour band Bi
When, i.e., balance car advances to position xB2When, the gray-scale sensor induction on revolver recognizes colour band Bi, at this time on revolver and right wheel
Odometer record current mileage value L respectivelyLi2And LRi4, during this period right wheel traveling mileage be
LBi=LRi4-LRi3
Balance car direction of travel and colour band B is calculatediBetween angle αBiFor
And balance car is being the average value of left and right wheels travel distance by the travel distance between two colour bands, as
Therefore, according to the available balance car of above method when by each correction zone its direction of travel respectively with this
Angle α in correction zone between two colour bandsAi、αBiAnd balance car is in the mileage value Δ L by advancing between two colour bandsi1。
Second step, balance car are advanced according to odometer record value by memory path since starting point, reach i-th of correction
Qu Shi, as shown in Fig. 4, path in graphs 1 are preassigned path, according to the record in the first step as a result, path 1 and colour band
Ai, colour band BiBetween angle be respectively αAiAnd αBi, path 1 is in the mileage value by advancing between two colour bands | Mi1Mi2| it is Δ
Li1。
Path 2 is current patrol path, according to the available balance car direction of travel of calculation method similar in the first step
Angle and balance car between two colour bands in the correction zone is in the mileage value by advancing between two colour bands.Remember path 2 with
Colour band Ai, colour band BiBetween angle be respectively βAiAnd βBi, path 2 is in the mileage value by advancing between two colour bands | Ni1Ni2|
For Δ Li2。
Third step calculates angular deviation and orientation deviation between path 2 and path 1.The specific method is as follows.
Geometrical relationship in 4 with reference to the accompanying drawings, the angular deviation θ between path 2 and path 1iFor
θi=βAi-αAi
In △ OiMi1Mi2In, ∠ Mi1OiMi2=αBi- αAi, by sine
I.e.
In △ RiNi1Ni2In, ∠ Ni1RiNi2=αAi, ∠ RiNi1Ni2=π-βAi, by sine
I.e.
Have again
Simultaneous above equation can obtain balance car and march to colour band BiWhen, path 2 and deviation delta of the path 1 in orientation
diFor
It should be noted that provide in attached drawing 4 is βAi> αAiThe case where, i.e. θi> 0 is, it is specified that angle is counterclockwise
Positive direction, the direction Oy is orientation positive direction in figure, at this time orientation deviation delta d between path 2 and path 1i> 0, i.e. path 2
With colour band BiIntersection point compared to path 1 and colour band BiIntersection point on azimuth axis coordinate value it is bigger.
As shown in Fig. 5, as between path 2 and path 1 relationship make βAi< αAiThe case where, i.e. θi< 0 is calculated former at this time
Reason and formula are identical as a kind of upper situation, orientation deviation delta d between the path 2 being only calculated and path 1i< 0, i.e. road
Diameter 2 and colour band BiIntersection point compared to path 1 and colour band BiIntersection point on azimuth axis coordinate value it is smaller.
In addition, there is also the third situations: θi< 0, Δ di> 0, as shown in Fig. 6 (a), 6 (b);And the 4th total situation:
θi> 0, Δ di< 0, as shown in Fig. 7 (a), 7 (b).
Therefore, according to the angular deviation θ between the available balance car path 2 of above method and path 1iIt is inclined with orientation
Poor Δ di。
4th step judges whether to need course corrections according to deviation obtained in upper step, is such as not required to correct, then after continuing
Into;It such as needs to correct, then correction parameter is conversed according to balance car current location, continued on after correcting position and posture.Tool
The calculating of body correction parameter and course corrections method are as follows.
As shown in Fig. 8, it is assumed that march to Ei1When balance car stop advance prepare course corrections, write down at this time by odometer
| Ni2Ei1| it is Δ Lmi, then have
It is more than simultaneous that two formulas can obtain
Δyi=Δ di-ΔLmi sinθi
I.e. correction course is that balance car rotates counterclockwise φiAlong orientation traveling Δ y after angleiRotation clockwise again afterwards
Turn 90 °, return on preassigned path 1 at this time, and is correct posture.
Assuming that balance reaches Ei2When stop advance prepare course corrections, correction parameter calculate it is as follows
Δyi=(| Ni2Ei2|-|Ni2Ti|)sinθi=Δ Lmisinθi-Δdi
Correction course is that balance car rotates counterclockwise φiAlong orientation negative direction traveling Δ y after angleiAfterwards when another mistake
Needle is rotated by 90 °, and is returned on preassigned path 1 at this time, and is correct posture.
According to orientation positive direction specified in upper step and angle positive direction, above-mentioned two situations can be summarized as follows
Correction parameter is
Wherein, sgn () indicates sign function, i.e., is positive in bracket, then functional value is 1;It is negative in bracket, then functional value
It is -1;It is 0 in bracket, then functional value is 0.Correction course is that balance car direction rotates φiAlong orientation traveling Δ y after angleiAfterwards
Direction rotates againAngle returns on preassigned path 1 at this time, and is correct posture.
It is still set up for attached drawing 6 and two kinds of above-mentioned bearing calibrations of situation in attached drawing 7.
5th step, enables i=i+1, repeats step 2~step 4 when marching to next correction zone, until i=K+1, complete
At all course corrections in patrol path 2, terminates epicycle and go on patrol process.
Claims (4)
1. a kind of two-wheeled balance car course corrections device based on odometer and gray-scale sensor, including controller interconnected
With two-wheeled balance car driving mechanism, which is characterized in that the device further includes two odometers, two gray-scale sensors and more
A correction zone, two odometers and two gray-scale sensors are connect with controller respectively, the revolver of two-wheeled balance car and
Right wheel respectively installs an odometer and a gray-scale sensor, and each correction zone includes two and is not parallel to each other also disjoint color
Band, the ribbon position are fixed, and are intersected with the standard routes of two-wheeled balance car,
Two-wheeled balance car presses memory route from the off, and memory path is generated according to standard routes, when two-wheeled balance car
Traveling is to correction zone, and when gray-scale sensor senses that wheel presses through colour band, controller reads the real time data of odometer, according to reality
When data and the normal data of the correction zone calculate the deviation between current Actual path and standard routes, and according to deviation into
Row course corrections make two-wheeled balance car return to standard routes, then proceed to traveling to next correction zone or terminate traveling,
In, normal data acquisition methods include: that two-wheeled balance car is strictly travelled along standard routes from starting point, colour band in corrected area
When, normal data of the data of two odometers as the correction zone is recorded by controller,
Use the side that course corrections are carried out based on the two-wheeled balance car course corrections device of odometer and gray-scale sensor
Method, comprising the following steps:
S1, two-wheeled balance car start from the off, by memory route, the Actual path and standard of two-wheeled balance car traveling
There are deviations between path;
S2, when wheel presses through colour band, the gray-scale sensor on the wheel sends signal to controller, and controller is read on the wheel
The real time data of odometer, and return step S2, until controller reads four real time datas, the real-time number in the correction zone
It is finished according to reading;
S3, controller calculate inclined between two-wheeled balance car current Actual path and standard routes according to four real time datas
Difference, and course corrections are judged whether to, if so, entering step S4, otherwise continue by memory route and return step
S2, or terminate traveling;
S4, two-wheeled balance car pause traveling, calculates correction parameter according to deviation and is moved to standard routes according to correction parameter, so
After continue by memory route and return step S2;
In i-th of correction zone, the deviation between currently practical path and standard routes includes angular deviation θiWith orientation deviation delta
di, calculating formula is respectively as follows:
θi=βAi-αAi
Wherein, βAiFor the angle in i-th of correction zone between the wheel first time colour band pressed through and currently practical path, αAiIt is
Angle in i correction zone between the wheel first time colour band pressed through and standard routes, αBiFor wheel second in i-th of correction zone
Angle between the secondary colour band pressed through and standard routes, Δ Li1For the standard routes and two colour band intersection points in i-th of correction zone
The distance between, Δ Li2For the distance between Actual path and two colour band intersection points in i-th of correction zone;
The distance between i-th of correction zone internal standard path and two colour band intersection points Δ Li1Calculating formula are as follows:
Wherein, LLiFor the mileage record value of balance car revolver revolver odometer within by this period between two colour bands, LRiFor
The mileage record value of balance car right wheel right wheel odometer within by this period between two colour bands;
The distance between Actual path and two colour band intersection points Δ L in i-th of correction zonei2Calculating formula are as follows:
Wherein, L'LiFor in Actual path when driving, balance car revolver revolver mileage within by this period between two colour bands
The mileage record value of meter, L'RiFor when driving, balance car right wheel is right within by this period between two colour bands in Actual path
Take turns the mileage record value of odometer.
2. a kind of two-wheeled balance car course corrections device based on odometer and gray-scale sensor according to claim 1,
It is characterized in that, the device further includes the charging pile being arranged on two-wheeled balance car path, the charging pile is as two
Take turns the starting point of balance car traveling.
3. a kind of two-wheeled balance car course corrections device based on odometer and gray-scale sensor according to claim 1,
It is characterized in that, if deviation is less than setting value, without course corrections, two-wheeled balance car continues court in the step S3
Standard routes traveling and return step S2, if current correction area is the last one correction zone, without course corrections, two-wheeled is flat
Weighing apparatus vehicle terminates to travel, and otherwise enters step S4.
4. a kind of two-wheeled balance car course corrections device based on odometer and gray-scale sensor according to claim 1,
It is characterized in that, in the step S4, correction parameter Δ yiWithCalculating formula be respectively as follows:
Δyi=Δ Lmi sinθi-Δdi
Wherein, Δ LmiFor in i-th of correction zone, intersection point is to practical between the colour band that currently practical path and wheel press through for the second time
The distance between point to be corrected on path, sgn (*) are sign function;
Two-wheeled balance car is moved to standard routes according to correction parameter method particularly includes: two-wheeled balance car direction rotates counterclockwise
φiAfter angle, advance along straight line where orientation to standard routes | Δ yi|, the rotation of another mistake hour handsAngle returns to
Standard routes and correct posture, the orientation are vertical with standard routes direction.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610635588.7A CN106292660B (en) | 2016-08-05 | 2016-08-05 | Balance car course corrections device and method based on odometer and gray-scale sensor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610635588.7A CN106292660B (en) | 2016-08-05 | 2016-08-05 | Balance car course corrections device and method based on odometer and gray-scale sensor |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106292660A CN106292660A (en) | 2017-01-04 |
CN106292660B true CN106292660B (en) | 2019-06-11 |
Family
ID=57665596
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610635588.7A Active CN106292660B (en) | 2016-08-05 | 2016-08-05 | Balance car course corrections device and method based on odometer and gray-scale sensor |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106292660B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107085430A (en) * | 2017-05-24 | 2017-08-22 | 深圳优地科技有限公司 | A kind of optimization method of wheeled robot parameter adjustment, device and system |
CN107463178A (en) * | 2017-09-13 | 2017-12-12 | 湖南同惠智能科技有限公司 | A kind of path detection and control device for automatic Guided Vehicle |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997040398A2 (en) * | 1996-04-25 | 1997-10-30 | Sirf Technology, Inc. | Spread spectrum receiver with multi-bit correlator |
CN102269995A (en) * | 2011-06-22 | 2011-12-07 | 重庆大学 | Variable structure control method of wheeled mobile robot |
CN104848851A (en) * | 2015-05-29 | 2015-08-19 | 山东鲁能智能技术有限公司 | Transformer substation patrol robot based on multi-sensor data fusion picture composition and method thereof |
CN105511456A (en) * | 2014-09-23 | 2016-04-20 | 苏州宝时得电动工具有限公司 | Control method for automatic walking equipment, and automatic work system |
CN105607635A (en) * | 2016-01-05 | 2016-05-25 | 东莞市松迪智能机器人科技有限公司 | Panoramic optic visual navigation control system of automatic guided vehicle and omnidirectional automatic guided vehicle |
-
2016
- 2016-08-05 CN CN201610635588.7A patent/CN106292660B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997040398A2 (en) * | 1996-04-25 | 1997-10-30 | Sirf Technology, Inc. | Spread spectrum receiver with multi-bit correlator |
CN102269995A (en) * | 2011-06-22 | 2011-12-07 | 重庆大学 | Variable structure control method of wheeled mobile robot |
CN105511456A (en) * | 2014-09-23 | 2016-04-20 | 苏州宝时得电动工具有限公司 | Control method for automatic walking equipment, and automatic work system |
CN104848851A (en) * | 2015-05-29 | 2015-08-19 | 山东鲁能智能技术有限公司 | Transformer substation patrol robot based on multi-sensor data fusion picture composition and method thereof |
CN105607635A (en) * | 2016-01-05 | 2016-05-25 | 东莞市松迪智能机器人科技有限公司 | Panoramic optic visual navigation control system of automatic guided vehicle and omnidirectional automatic guided vehicle |
Also Published As
Publication number | Publication date |
---|---|
CN106292660A (en) | 2017-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107246868B (en) | Collaborative navigation positioning system and navigation positioning method | |
US10867409B2 (en) | Methods and systems to compensate for vehicle calibration errors | |
CN109946732B (en) | Unmanned vehicle positioning method based on multi-sensor data fusion | |
US11024055B2 (en) | Vehicle, vehicle positioning system, and vehicle positioning method | |
CN106441319B (en) | A kind of generation system and method for automatic driving vehicle lane grade navigation map | |
CN104537829B (en) | A kind of intelligent transportation Physical Simulation Platform and the localization method for the intelligent transportation Physical Simulation Platform | |
CN105737820B (en) | A kind of Indoor Robot positioning navigation method | |
CN106123908B (en) | Automobile navigation method and system | |
CN107085938B (en) | The fault-tolerant planing method of intelligent driving local path followed based on lane line and GPS | |
CN110307850A (en) | Reckoning localization method and automated parking system | |
CN108955688A (en) | Two-wheel differential method for positioning mobile robot and system | |
CN106338991A (en) | Robot based on inertial navigation and two-dimensional code and positioning and navigation method thereof | |
CN110361008B (en) | Positioning method and device for automatic parking of underground garage | |
CN108628324A (en) | Unmanned vehicle navigation method, device, equipment based on map vector and storage medium | |
CN103207634A (en) | Data fusion system and method of differential GPS (Global Position System) and inertial navigation in intelligent vehicle | |
CN101201255A (en) | Vehicle combined navigation system based on intelligent navigation algorithm | |
CN108961811A (en) | Parking lot vehicle positioning method, system, mobile terminal and storage medium | |
CN205121338U (en) | AGV navigation based on image recognition and wireless network | |
CN104952278B (en) | A kind of parking lot Vehicle positioning system and method based on map | |
CN108036792A (en) | A kind of data fusion method of odometer for mobile robot and measurement pose | |
CN109927721A (en) | Lane maintains to follow system | |
JP2023532482A (en) | System and method for detecting open doors | |
CN110763224A (en) | Navigation method and navigation system for automatic guided transport vehicle | |
CN108279026A (en) | A kind of AGV inertial navigation systems and method based on T-type RFID beacons | |
CN115027482A (en) | Fusion positioning method in intelligent driving |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |