CN103632062A - Method and device for determining uphill and downhill running states of vehicle by utilizing acceleration sensor and gyroscope - Google Patents
Method and device for determining uphill and downhill running states of vehicle by utilizing acceleration sensor and gyroscope Download PDFInfo
- Publication number
- CN103632062A CN103632062A CN201310656432.3A CN201310656432A CN103632062A CN 103632062 A CN103632062 A CN 103632062A CN 201310656432 A CN201310656432 A CN 201310656432A CN 103632062 A CN103632062 A CN 103632062A
- Authority
- CN
- China
- Prior art keywords
- value
- vehicle
- new
- turning
- 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.)
- Granted
Links
Images
Landscapes
- Gyroscopes (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
- Navigation (AREA)
Abstract
The invention discloses a method and a device for determining uphill and downhill running states of a vehicle by utilizing an acceleration sensor and a gyroscope. The method comprises the following steps of 1, acquiring data such as vehicle speed, a gyroscope reading and accelerometer readings, wherein the vehicle speed is V(t), the gyroscope reading is gyro(t), and the accelerometer readings are ax(t), ay(t) and az(t), and correspond to three directions of a tri-axis accelerometer respectively; 2, calculating turning angular speed according to the gyroscope reading; 3, measuring a mounting angle; 4, calculating a suspension corrected value by using a suspension correction coefficient; 5, calculating a turning corrected value; 6, calculating a real-time slope and an average slope, and judging a slope type. According to the method and the device, a current slope state of the vehicle can be more accurately judged.
Description
Technical field
The present invention relates to vehicle electric field, particularly a kind of method and apparatus that utilizes acceleration transducer and gyro to carry out Vehicle Driving Cycle climb and fall condition judgement.
Background technology
Vehicle is when static, and by the measurement data of accelerometer, the impact of cancellation accelerometer established angle just can calculate the gradient of vehicle present position afterwards easily.Vehicle in motion, can be because the variation of the speed of a motor vehicle makes the measured value of accelerometer be subject to the impact of vehicle acceleration and deceleration, and because vehicle suspension is elastic system, the acceleration and deceleration meeting of vehicle produces obviously impact to suspension angle, and then have influence on the measured value of accelerometer.On the other hand, vehicle, can be because of the cause of running attitude when turning, and turning centripetal force has a component making progress at axle for vehicle, and then has influence on the measured value of accelerometer.
In prior art, when the gradient of identification vehicle present position, owing to not considering the impact of accelerometer established angle, make to install when not accurate enough when accelerometer, can cause the gradient precision that calculates not high.When acceleration and deceleration are travelled, because vehicle suspension is elastic system, and the acceleration and deceleration meeting of vehicle produces obviously impact to suspension angle.Vehicle body hypsokinesis when vehicle accelerates, when vehicle deceleration, vehicle body leans forward.Because accelerometer is arranged on vehicle body, thereby the vehicle body angle of measuring will inevitably comprise the angle of vehicle suspension, therefore must on measure to angle make the impact of revising to avoid suspension angle to change.At Ackermann steer angle, can there is centripetal force, and because the front and back wheel of vehicle is not on same straight line, so centripetal force vehicle axially on have one-component, while therefore turning, to revise for the turn condition of vehicle body.Finally, simultaneously, because the climb and fall in reality continues often, the instantaneous gradient is not easy to reflect the type on the slope in reality.During for concrete application, due to the slope of the road in a reality lasting state often, rather than an instantaneous value, therefore, calculate the average instantaneous value of slope of the ratio of slope in a period of time and more can accurately reflect real situation.
Therefore, in prior art, when to vehicle climb and fall condition judgement, there is inaccurate problem.
Summary of the invention
In view of problems of the prior art, the object of the invention is to provide a kind of method and apparatus that utilizes acceleration transducer and gyro to carry out Vehicle Driving Cycle climb and fall condition judgement, thereby judges more accurately gradient state.
According to an aspect of the present invention, provide a kind of method of utilizing acceleration transducer and gyro to carry out Vehicle Driving Cycle climb and fall condition judgement, it is characterized in that comprising step:
S1, data acquisition, obtain the speed of a motor vehicle, the gyroscope value of reading, the accelerometer value of reading, wherein the speed of a motor vehicle is V (t), and gyroscope survey value is gyro (t), the accelerometer value of reading is ax (t), ay (t), az (t), respectively three directions of corresponding three axis accelerometer;
S2, according to the gyroscope value of reading, calculate turning rate;
S3, measurement established angle;
S4, use are hung correction factor and are calculated suspension modified value;
S5, calculating turning modified value;
S6, calculate the real-time gradient, mean inclination, judgement gradient type.
Preferably, in step S1, use the longer time period to calculate average accekeration, and subsequent calculations is all used this average acceleration value.
Preferably, in step S2, turning rate W=(gyro (t)-mid) * gyro_scale_factor
Wherein mid is gyro intermediate value, and gyro_scale_factor is turning scale factor.
Preferably, in step S3, the computing formula of axial established angle:
Wherein xAngle is axial established angle angle, ax (t), ay (t), az (t), the respectively measured value of three directions of corresponding accelerometer three axis accelerometer.
Preferably, in step S3, the established angle while adopting under a plurality of different temperatures this temperature of measurements and calculations, by the mode of least square fitting straight line, calculates the established angle value under different temperatures.
Preferably, in step S4, the computing formula that hangs modified value is:
change1(t)=av(t)*k1*cos(xAngle)
Wherein k1, for hanging correction factor, draws by vehicle being carried out to linear acceleration and deceleration test, and acquisition pattern is:
By manual adjustment, make accelerometer basically identical in three directions and vehicle itself;
Vehicle carries out linear acceleration and deceleration and travels, and records the accekeration ax (t) in the vehicle forward direction that acceleration measuring measures and the accekeration av (t) calculating according to speed meter;
The approximate formula that moment is hung correction factor k1 (t) is:
Preferably, hang the mean value that the k1 using in modified value computing formula can be measurement result, and identical vehicle is done one-shot measurement and calculates.
Preferably, in step S5, the computing formula of turning modified value is:
change2(t)=L*w(t)*w(t)*k2
Wherein L is vehicle axial length, and w (t) is turning rate, and k2 is turning correction factor;
The acquisition pattern of turning correction factor k2:
By manual adjustment, make accelerometer basically identical in three directions and vehicle itself;
Vehicle carries out at the uniform velocity turning driving, records the accekeration ax (t) in the vehicle forward direction that acceleration measuring measures and the turning rate w (t) going out according to gyroscope survey;
By following formula, calculate
Preferably, the mean value that the k2 using in turning modified value computing formula is measurement result, and identical vehicle is done one-shot measurement and calculates.
Preferably, the computing formula of the final instantaneous gradient
ax_new(t)=ax(t)-change1(t)+change2(t)
ay_new(t)=ay(t)
az_new(t)=az(t)-av(t)*sin(xAngle)
The computing formula of mean inclination
ax_new(t)
n=ax(t)
n-change1(t)
n+change2(t)
n
ay_new(t)
n=ay(t)
n
az_new(t)
n=az(t)
n-av(t)
n*sin(xAngle)
Preferably, in step S1, source data is done to filtering noise reduction process, for the speed of a motor vehicle, the value of reading of gyroscope and accelerometer, by simple low-pass filtering treatment, is output as filtered data.
According to a further aspect in the invention, provide a kind of device that utilizes acceleration transducer and gyro to carry out Vehicle Driving Cycle climb and fall condition judgement, it is characterized in that comprising:
Data acquisition module, be used for carrying out data acquisition, obtain the speed of a motor vehicle, the gyroscope value of reading, the accelerometer value of reading, wherein the speed of a motor vehicle is V (t), gyroscope survey value is gyro (t), the accelerometer value of reading is ax (t), ay (t), az (t), respectively three directions of corresponding three axis accelerometer;
Turning rate computing module, for calculating turning rate according to the gyroscope value of reading;
Established angle measurement module, for measuring established angle;
Hang modified value computing module, for using, hang correction factor calculating suspension modified value;
Turning modified value computing module, for calculating turning modified value;
Gradient judge module, for calculating the real-time gradient, mean inclination, judgement gradient type.
Preferably, in data acquisition module, use the longer time period to calculate average accekeration, and subsequent calculations is all used this average acceleration value.
Preferably, in turning rate computing module, turning rate
w=(gyro(t)-mid)*gyrp_scale_factor
Wherein mid is gyro intermediate value, and gyro_scale_factor is turning scale factor.
Preferably, in established angle measurement module, the computing formula of axial established angle:
Wherein xAngle is axial established angle angle, ax (t), ay (t), az (t), the respectively measured value of three directions of corresponding accelerometer three axis accelerometer.
Preferably, in established angle measurement module, the established angle while adopting under a plurality of different temperatures this temperature of measurements and calculations, by the mode of least square fitting straight line, calculates the established angle value under different temperatures.
Preferably, hang in modified value computing module, the computing formula that hangs modified value is:
change1(t)=av(t)*k1*cos(xAngle)
Wherein k1, for hanging correction factor, draws by vehicle being carried out to linear acceleration and deceleration test, and acquisition pattern is:
By manual adjustment, make accelerometer basically identical in three directions and vehicle itself;
Vehicle carries out linear acceleration and deceleration and travels, and records the accekeration ax (t) in the vehicle forward direction that acceleration measuring measures and the accekeration av (t) calculating according to speed meter;
The approximate formula that moment is hung correction factor k1 (t) is:
Preferably, hang the mean value that the k1 using in modified value computing formula can be measurement result, and identical vehicle is done one-shot measurement and calculates.
Preferably, in turning modified value computing module, the computing formula of turning modified value is:
change2(t)=L*w(t)*w(t)*k2
Wherein L is vehicle axial length, and w (t) is turning rate, and k2 is turning correction factor;
The acquisition pattern of turning correction factor k2:
By manual adjustment, make accelerometer basically identical in three directions and vehicle itself;
Vehicle carries out at the uniform velocity turning driving, records the accekeration ax (t) in the vehicle forward direction that acceleration measuring measures and the turning rate w (t) going out according to gyroscope survey;
By following formula, calculate
Preferably, the mean value that the k2 using in turning modified value computing formula is measurement result, and identical vehicle is done one-shot measurement and calculates.
Preferably, the computing formula of the final instantaneous gradient
ax_new(t)=ax(t)-change1(t)+change2(t)
ay_new(t)=ay(t)
az_new(t)=az(t)-av(t)*sin(xAngle)
The computing formula of mean inclination
ax_new(t)
n=ax(t)
n-change1(t)
n+change2(t)
n
ay_new(t)
n=ay(t)
n
az_new(t)
n=az(t)
n-av(t)
n*sin(xAngle)
Preferably, in data acquisition module, source data is done to filtering noise reduction process, for the speed of a motor vehicle, the value of reading of gyroscope and accelerometer, by simple low-pass filtering treatment, is output as filtered data.
One aspect of the present invention is calculated vehicle movement acceleration by the speed of a motor vehicle, for hanging error, revise simultaneously, by gyro, obtain on the other hand the angular velocity of turning, revise the impact of accelerometer because turning, when calculating the gradient, impact that simultaneously can cancellation established angle, and by the Gradient in statistics a period of time, judge the type on the slope in real world.
Accompanying drawing explanation
Fig. 1 is exemplified with a kind of method flow diagram that utilizes acceleration transducer and gyro to carry out Vehicle Driving Cycle climb and fall condition judgement of the embodiment of the present invention.
Fig. 2 is exemplified with a kind of structure drawing of device that utilizes acceleration transducer and gyro to carry out Vehicle Driving Cycle climb and fall condition judgement of the embodiment of the present invention.
Embodiment
For above-mentioned purpose of the present invention, feature and advantage are become apparent more, below in conjunction with the drawings and specific embodiments, the present invention is further detailed explanation.
Due to the problem that prior art exists as above-mentioned background technology is partly mentioned, the present invention is when utilizing acceleration transducer and gyro to carry out Vehicle Driving Cycle climb and fall condition judgement, can from three aspects, to it, revise respectively, that is: accelerometer established angle correction, suspension are revised and are turned and revise.
One side is due to the alignment error of accelerometer, must carry out established angle mensuration for concrete vehicle, on the other hand, more preferred, because the measured value of accelerometer self can be subject to the impact of temperature, need at different temperature, do repeatedly and measure, at the temperature not measured, can go out corresponding measurement data according to data estimation corresponding to the temperature having measured.
Fig. 1 is exemplified with a kind of method flow diagram that utilizes acceleration transducer and gyro to carry out Vehicle Driving Cycle climb and fall condition judgement of the embodiment of the present invention.
As shown in Figure 1, described method can comprise step:
S1, data acquisition, obtain the speed of a motor vehicle, the gyroscope value of reading, the accelerometer value of reading, wherein the speed of a motor vehicle is V (t), and gyroscope survey value is gyro (t), the accelerometer value of reading is ax (t), ay (t), az (t), respectively three directions of corresponding three axis accelerometer;
Preferably, for the precision problem of the speed of a motor vehicle, can calculate average acceleration with the longer time period, thereby reduce the error that the precision of the speed of a motor vehicle own is brought,
According to speed meter, calculate instantaneous acceleration
The speed that wherein V (t) is current time, V (t-1) was the speed of a motor vehicle in a upper moment, T is carved into (t) elapsed time constantly, the interval time that the speed of being defaulted as is obtained while being (t-1).
When using the longer time period,, after getting n speed, can be used for calculating interior during this period of time average acceleration value
Av (t) wherein
nfor average acceleration, the speed that V (t) is current time, V (t-n) is the speed of a motor vehicle before n the moment before, T
nfor the time of experience between V (t) and V (t-n).
The calculating of the mean value of accelerometer:
S2, according to the gyroscope value of reading, calculate turning rate;
Different chips has different account forms, and the formula herein preferably using is:
w=(gyro(t)-mid)*gyro_scale_factor
Wherein mid is gyro intermediate value, and gyro_scale_factor is turning scale factor.
S3, measurement established angle;
The computing formula of axial established angle:
Wherein xAngle is axial established angle angle, ax (t), ay (t), az (t), the respectively measured value of three directions of corresponding accelerometer three axis accelerometer.
Because the established angle of other both directions generally can be very little, so ignore herein.
Temperature can be brought impact for the value of reading of accelerometer, Different Effects depending on chip is also different, consider that the variation that accelerometer brings with temperature is linear relationship substantially, established angle in the time of can adopting under a plurality of different temperatures this temperature of measurements and calculations herein, by the mode of least square fitting straight line, calculate the established angle value under different temperatures, subsequent calculations use to established angle xAngle, all can refer to the corresponding established angle calculating under corresponding working temperature.
S4, use are hung correction factor and are calculated suspension modified value;
Because the deformation extent and the acceleration that hang are substantially linear, therefore the computing formula of instantaneous modified value is:
change1(t)=av(t)*k1*cos(xAngle)
Wherein k1, for hanging correction factor, draws by vehicle being carried out to linear acceleration and deceleration test, and acquisition pattern is:
By manual adjustment, make accelerometer basically identical in three directions and vehicle itself;
Vehicle carries out linear acceleration and deceleration and travels, and records the accekeration ax (t) in the vehicle forward direction that acceleration measuring measures and the accekeration av (t) calculating according to speed meter;
The approximate formula that moment is hung correction factor k1 (t) is:
In order to reduce complexity, the k1 using in instantaneous modified value computing formula can be the mean value of measurement result, and identical vehicle does one-shot measurement and calculate,
Average modified value
change1(t)
n=av(t)
n*k1*cos(xAngle)
S5, calculating turning modified value;
At Ackermann steer angle, can there is centripetal force, and because the front and back wheel of vehicle is not on same straight line, so centripetal force vehicle axially on have one-component, the instantaneous modified value that this component is corresponding is:
change2(t)=L*w(t)*w(t)*k2
Wherein L is vehicle axial length, and w (t) is turning rate, and k2 is turning correction factor.
Average modified value is
change2(t)
n=L*w(t)
n*w(t)
n*k2
The acquisition pattern of turning correction factor:
A. by manual adjustment, make accelerometer basically identical in three directions and vehicle itself;
B. vehicle carries out at the uniform velocity turning driving, records the accekeration ax (t) in the vehicle forward direction that acceleration measuring measures and the turning rate w (t) going out according to gyroscope survey;
C. due to the difference of the installation site of accelerometer, the difference of vehicle itself, need to measure targetedly for different vehicles.And because accelerometer not necessarily can be arranged on the axis of vehicle, so the correction factor of left-hand rotation and right-hand rotation can be different, computing formula is consistent
In order to reduce complexity, the mean value that the k2 using in instantaneous modified value computing formula is measurement result, and identical vehicle does one-shot measurement and calculates,
S6, calculate the real-time gradient, mean inclination, judgement gradient type.
The computing formula of the final instantaneous gradient
ax_new(t)=ax(t)-change1(t)+change2(t)
ay_new(t)=ay(t)
az_new(t)=az(t)-av(t)*sin(xAngle)
The computing formula of mean inclination
ax_new(t)
n=ax(t)
n-change1(t)
n+change2(t)
n
ay_new(t)
n=ay(t)
n
az_new(t)
n=az(t)
n-av(t)
n*sin(xAngle)
Preferably, can do filtering noise reduction process to source data, for the speed of a motor vehicle, the value of reading of gyroscope and accelerometer can, by simple low-pass filtering treatment, be output as filtered data.
Fig. 2 is exemplified with a kind of structure drawing of device that utilizes acceleration transducer and gyro to carry out Vehicle Driving Cycle climb and fall condition judgement of the embodiment of the present invention.
As shown in Figure 2, described device comprises:
Data acquisition module, be used for carrying out data acquisition, obtain the speed of a motor vehicle, the gyroscope value of reading, the accelerometer value of reading, wherein the speed of a motor vehicle is V (t), gyroscope survey value is gyro (t), the accelerometer value of reading is ax (t), ay (t), az (t), respectively three directions of corresponding three axis accelerometer;
Turning rate computing module, for calculating turning rate according to the gyroscope value of reading;
Established angle measurement module, for measuring established angle;
Hang modified value computing module, for using, hang correction factor calculating suspension modified value;
Turning modified value computing module, for calculating turning modified value;
Gradient judge module, for calculating the real-time gradient, mean inclination, judgement gradient type.
Because apparatus and method of the present invention are supporting execution, its ins and outs are also corresponding one by one, and the detail in embodiment of the method all can be applicable to device embodiment, repeats no longer one by one here to repeat, and protection scope of the present invention is as the criterion with claims.
It is more than the detailed description that the preferred embodiments of the present invention are carried out, but those of ordinary skill in the art is to be appreciated that, within the scope of the present invention, and guided by the spirit, various improvement, interpolation and replacement are all possible, such as use can realize functional purpose of the same race algorithm, use that different programming language (as C, C++, Java etc.) is realized etc.In these protection domains that all limit in claim of the present invention.
Claims (22)
1. utilize acceleration transducer and gyro to carry out a method for Vehicle Driving Cycle climb and fall condition judgement, it is characterized in that comprising step:
S1, data acquisition, obtain the speed of a motor vehicle, the gyroscope value of reading, the accelerometer value of reading, wherein the speed of a motor vehicle is V (t), and gyroscope survey value is gyro (t), the accelerometer value of reading is ax (t), ay (t), az (t), respectively three directions of corresponding three axis accelerometer;
S2, according to the gyroscope value of reading, calculate turning rate;
S3, measurement established angle;
S4, use are hung correction factor and are calculated suspension modified value;
S5, calculating turning modified value;
S6, calculate the real-time gradient, mean inclination, judgement gradient type.
2. the method for claim 1, is characterized in that:
In step S1, use the longer time period to calculate average accekeration, and subsequent calculations is all used this average acceleration value.
3. the method for claim 1, is characterized in that:
In step S2, turning rate w=(gyro (t)-mid) * gyro_scale_factor
Wherein mid is gyro intermediate value, and gyro_scale_factor is turning scale factor.
4. method as claimed in claim 3, is characterized in that:
In step S3, the computing formula of axial established angle:
Wherein xAmgle is axial established angle angle, ax (t), ay (t), az (t), the respectively measured value of three directions of corresponding accelerometer three axis accelerometer.
5. the method for claim 1, is characterized in that:
In step S3, the established angle while adopting under a plurality of different temperatures this temperature of measurements and calculations, by the mode of least square fitting straight line, calculates the established angle value under different temperatures.
6. method as claimed in claim 4, is characterized in that:
In step S4, the computing formula that hangs modified value is:
change1(t)=av(t)*k1*cos(xAngle)
Wherein k1, for hanging correction factor, draws by vehicle being carried out to linear acceleration and deceleration test, and acquisition pattern is:
By manual adjustment, make accelerometer basically identical in three directions and vehicle itself;
Vehicle carries out linear acceleration and deceleration and travels, and records the accekeration ax (t) in the vehicle forward direction that acceleration measuring measures and the accekeration av (t) calculating according to speed meter;
The approximate formula that moment is hung correction factor k1 (t) is:
7. method as claimed in claim 6, is characterized in that:
Hang the mean value that the k1 using in modified value computing formula can be measurement result, and identical vehicle is done one-shot measurement and calculates.
8. method as claimed in claim 6, is characterized in that:
In step S5, the computing formula of turning modified value is:
change2(t)=L*w(t)*w(t)*k2
Wherein L is vehicle axial length, and w (t) is turning rate, and k2 is turning correction factor;
The acquisition pattern of turning correction factor k2:
A. by manual adjustment, make accelerometer basically identical in three directions and vehicle itself;
B. vehicle carries out at the uniform velocity turning driving, records the accekeration ax (t) in the vehicle forward direction that acceleration measuring measures and the turning rate w (t) going out according to gyroscope survey;
C. by following formula, calculate
9. method as claimed in claim 8, is characterized in that:
The mean value that the k2 using in turning modified value computing formula is measurement result, and identical vehicle is done one-shot measurement and calculates.
10. method as claimed in claim 8, is characterized in that:
The computing formula of the final instantaneous gradient
ax_new(t)=ax(t)-change1(t)+change2(t)
ay_nwe(t)=ay(t)
az_new(t)=az(t)-av(t)*sin(xAngle)
The computing formula of mean inclination
az_new(t)
n=ax(t)
n-change1(t)
n+change2(t)
n
ay_new(t)
n=ay(t)
n
az_new(t)
n=az(t)
n-av(t)
n*sin(xAngle)
11. the method for claim 1, is characterized in that:
In step S1, source data is done to filtering noise reduction process, for the speed of a motor vehicle, the value of reading of gyroscope and accelerometer, by simple low-pass filtering treatment, is output as filtered data.
12. 1 kinds of devices that utilize acceleration transducer and gyro to carry out Vehicle Driving Cycle climb and fall condition judgement, is characterized in that comprising:
Data acquisition module, be used for carrying out data acquisition, obtain the speed of a motor vehicle, the gyroscope value of reading, the accelerometer value of reading, wherein the speed of a motor vehicle is V (t), gyroscope survey value is gyro (t), the accelerometer value of reading is ax (t), ay (t), az (t), respectively three directions of corresponding three axis accelerometer;
Turning rate computing module, for calculating turning rate according to the gyroscope value of reading;
Established angle measurement module, for measuring established angle;
Hang modified value computing module, for using, hang correction factor calculating suspension modified value;
Turning modified value computing module, for calculating turning modified value;
Gradient judge module, for calculating the real-time gradient, mean inclination, judgement gradient type.
13. devices as claimed in claim 12, is characterized in that:
In data acquisition module, use the longer time period to calculate average accekeration, and subsequent calculations is all used this average acceleration value.
14. devices as claimed in claim 12, is characterized in that:
In turning rate computing module, turning rate
w=(gyro(t)-nid)*gyro_scale_factor
Wherein mid is gyro intermediate value, and gyro_scale_factor is turning scale factor.
15. devices as claimed in claim 14, is characterized in that:
In established angle measurement module, the computing formula of axial established angle:
Wherein xAngle is axial established angle angle, ax (t), ay (t), az (t), the respectively measured value of three directions of corresponding accelerometer three axis accelerometer.
16. devices as claimed in claim 12, is characterized in that:
In established angle measurement module, the established angle while adopting under a plurality of different temperatures this temperature of measurements and calculations, by the mode of least square fitting straight line, calculates the established angle value under different temperatures.
17. devices as claimed in claim 15, is characterized in that:
Hang in modified value computing module, the computing formula that hangs modified value is:
change1(t)=av(t)*k1*cos(xAngle)
Wherein k1, for hanging correction factor, draws by vehicle being carried out to linear acceleration and deceleration test, and acquisition pattern is:
By manual adjustment, make accelerometer basically identical in three directions and vehicle itself;
Vehicle carries out linear acceleration and deceleration and travels, and records the accekeration ax (t) in the vehicle forward direction that acceleration measuring measures and the accekeration av (t) calculating according to speed meter;
The approximate formula that moment is hung correction factor k1 (t) is:
18. devices as claimed in claim 17, is characterized in that:
Hang the mean value that the k1 using in modified value computing formula can be measurement result, and identical vehicle is done one-shot measurement and calculates.
19. devices as claimed in claim 17, is characterized in that:
In turning modified value computing module, the computing formula of turning modified value is:
change2(t)=L*w(t)*w(t)*k2
Wherein L is vehicle axial length, and w (t) is turning rate, and k2 is turning correction factor;
The acquisition pattern of turning correction factor k2:
By manual adjustment, make accelerometer basically identical in three directions and vehicle itself;
Vehicle carries out at the uniform velocity turning driving, records the accekeration ax (t) in the vehicle forward direction that acceleration measuring measures and the turning rate w (t) going out according to gyroscope survey;
By following formula, calculate
20. devices as claimed in claim 19, is characterized in that:
The mean value that the k2 using in turning modified value computing formula is measurement result, and identical vehicle is done one-shot measurement and calculates.
21. devices as claimed in claim 19, is characterized in that:
The computing formula of the final instantaneous gradient
ax_new(t)=ax(t)-change1(t)+changee(t)
ay_new(t)=ay(t)
az_new(t)=az(t)-av(t)*sin(xAngle)
The computing formula of mean inclination
ax_new(t)
n=ax(t)
n-change1(t)
n+change2(t)
n
ay_new(t)
n=ay(t)
n
az_new(t)
n=az(t)
n-av(t)
n*sin(xAngle)
22. devices as claimed in claim 12, is characterized in that:
In data acquisition module, source data is done to filtering noise reduction process, for the speed of a motor vehicle, the value of reading of gyroscope and accelerometer, by simple low-pass filtering treatment, is output as filtered data.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310656432.3A CN103632062B (en) | 2013-12-06 | 2013-12-06 | Method and device for determining uphill and downhill running states of vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310656432.3A CN103632062B (en) | 2013-12-06 | 2013-12-06 | Method and device for determining uphill and downhill running states of vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103632062A true CN103632062A (en) | 2014-03-12 |
CN103632062B CN103632062B (en) | 2017-01-25 |
Family
ID=50213101
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310656432.3A Expired - Fee Related CN103632062B (en) | 2013-12-06 | 2013-12-06 | Method and device for determining uphill and downhill running states of vehicle |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103632062B (en) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104071111A (en) * | 2014-07-15 | 2014-10-01 | 吉林大学 | Full trailer train instability prevention real-time monitoring and early warning system |
CN104482919A (en) * | 2014-12-10 | 2015-04-01 | 陕西法士特齿轮有限责任公司 | Commercial vehicle dynamic slope test system and commercial vehicle dynamic slope test method |
CN104537209A (en) * | 2014-12-09 | 2015-04-22 | 上海交通大学 | Method for judging vehicle running road types based on hidden Markov model |
CN105416296A (en) * | 2015-12-07 | 2016-03-23 | 重庆云途交通科技有限公司 | Driving behavior analysis method based on three-axis accelerometer |
CN105523084A (en) * | 2015-12-07 | 2016-04-27 | 厦门雅迅网络股份有限公司 | Method for detecting turning angle of vehicle based on three-axis acceleration sensor |
CN105912818A (en) * | 2016-05-06 | 2016-08-31 | 深圳市安智车米汽车信息化有限公司 | Method and apparatus for eliminating accelerated speed influencing vehicle driving direction during driving-up/down |
CN106467103A (en) * | 2015-08-13 | 2017-03-01 | 厦门雅迅网络股份有限公司 | A kind of Intelligent oil-saving control method of vehicle and system |
CN106585849A (en) * | 2016-11-21 | 2017-04-26 | 天津逍悦达科技有限公司 | Method for achieving intelligent assistance for bicycle through three-axis acceleration sensor |
CN106768638A (en) * | 2017-01-19 | 2017-05-31 | 河南理工大学 | A kind of passenger car height of center of mass real-time estimation device and evaluation method |
CN107036630A (en) * | 2017-04-27 | 2017-08-11 | 深圳市思拓通信系统有限公司 | A kind of automatic recognition system and method for vehicle drive prior-warning device setting angle |
CN107132377A (en) * | 2017-06-13 | 2017-09-05 | 南京越博动力系统股份有限公司 | The measurement apparatus and computational methods of a kind of vehicle acceleration and the residing gradient |
CN107585210A (en) * | 2016-07-07 | 2018-01-16 | 厦门雅迅网络股份有限公司 | A kind of method and device for detecting steering wheel for vehicle corner |
PL126698U1 (en) * | 2017-10-12 | 2019-04-23 | Politechnika Warszawska | Measuring wheel with the elevation measuring function |
CN109839122A (en) * | 2017-11-29 | 2019-06-04 | 高德信息技术有限公司 | A kind of determination method and apparatus of vehicle running state |
CN111327755A (en) * | 2018-12-14 | 2020-06-23 | 西安博瑞集信电子科技有限公司 | Intelligent vehicle driving state identification system and method based on mobile phone |
CN111337051A (en) * | 2020-03-17 | 2020-06-26 | 北京百度网讯科技有限公司 | Method and device for calibrating forward axis of vehicle accelerometer |
CN114280332A (en) * | 2021-12-31 | 2022-04-05 | 成都路行通信息技术有限公司 | Three-axis acceleration sensor correction method |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050216146A1 (en) * | 2004-03-23 | 2005-09-29 | Continental Teves, Inc. | Body state estimation of a vehicle |
CN101995261A (en) * | 2009-08-10 | 2011-03-30 | 索尼公司 | Method of determining vehicle route and navigation system |
-
2013
- 2013-12-06 CN CN201310656432.3A patent/CN103632062B/en not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050216146A1 (en) * | 2004-03-23 | 2005-09-29 | Continental Teves, Inc. | Body state estimation of a vehicle |
CN101995261A (en) * | 2009-08-10 | 2011-03-30 | 索尼公司 | Method of determining vehicle route and navigation system |
Non-Patent Citations (4)
Title |
---|
YAZID SEBSADJI等: ""Road slope and vehicle dynamics estimation"", 《AMERICAN CONTROL CONFERENCE, 2008》, 13 June 2008 (2008-06-13), pages 4603 - 4608, XP031296785 * |
张小龙: ""车辆主动安全性能道路试验系统及评价方法研究"", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》, vol. 2007, no. 4, 15 April 2007 (2007-04-15), pages 035 - 3 * |
朱唯奕: ""基于GPS技术的车辆安全性研究"", 《中国优秀硕士学位论文全文数据库基础科学辑》, vol. 2013, no. 3, 15 March 2013 (2013-03-15), pages 008 - 124 * |
高婷婷等: ""一种低成本动态车载导航坡度识别方法"", 《系统仿真技术》, vol. 5, no. 4, 31 October 2009 (2009-10-31), pages 226 - 231 * |
Cited By (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104071111B (en) * | 2014-07-15 | 2016-06-08 | 吉林大学 | The full extension anti-unstability Real-Time Monitoring of automobile train and early warning system |
CN104071111A (en) * | 2014-07-15 | 2014-10-01 | 吉林大学 | Full trailer train instability prevention real-time monitoring and early warning system |
CN104537209A (en) * | 2014-12-09 | 2015-04-22 | 上海交通大学 | Method for judging vehicle running road types based on hidden Markov model |
CN104537209B (en) * | 2014-12-09 | 2017-04-05 | 上海交通大学 | Determination methods based on the vehicle travel type of HMM |
CN104482919A (en) * | 2014-12-10 | 2015-04-01 | 陕西法士特齿轮有限责任公司 | Commercial vehicle dynamic slope test system and commercial vehicle dynamic slope test method |
CN106467103A (en) * | 2015-08-13 | 2017-03-01 | 厦门雅迅网络股份有限公司 | A kind of Intelligent oil-saving control method of vehicle and system |
CN106467103B (en) * | 2015-08-13 | 2019-11-05 | 厦门雅迅网络股份有限公司 | A kind of the Intelligent oil-saving control method and system of vehicle |
CN105416296B (en) * | 2015-12-07 | 2017-12-05 | 招商局重庆交通科研设计院有限公司 | A kind of driving behavior analysis method based on three axis accelerometer meters |
CN105416296A (en) * | 2015-12-07 | 2016-03-23 | 重庆云途交通科技有限公司 | Driving behavior analysis method based on three-axis accelerometer |
CN105523084A (en) * | 2015-12-07 | 2016-04-27 | 厦门雅迅网络股份有限公司 | Method for detecting turning angle of vehicle based on three-axis acceleration sensor |
CN105523084B (en) * | 2015-12-07 | 2019-12-27 | 厦门雅迅网络股份有限公司 | Method for detecting vehicle turning angle based on three-axis acceleration sensor |
CN105912818A (en) * | 2016-05-06 | 2016-08-31 | 深圳市安智车米汽车信息化有限公司 | Method and apparatus for eliminating accelerated speed influencing vehicle driving direction during driving-up/down |
CN107585210A (en) * | 2016-07-07 | 2018-01-16 | 厦门雅迅网络股份有限公司 | A kind of method and device for detecting steering wheel for vehicle corner |
CN107585210B (en) * | 2016-07-07 | 2020-06-19 | 厦门雅迅网络股份有限公司 | Method and device for detecting steering wheel angle of vehicle |
CN106585849A (en) * | 2016-11-21 | 2017-04-26 | 天津逍悦达科技有限公司 | Method for achieving intelligent assistance for bicycle through three-axis acceleration sensor |
CN106768638B (en) * | 2017-01-19 | 2019-04-30 | 河南理工大学 | A kind of passenger car height of center of mass real-time estimating method |
CN106768638A (en) * | 2017-01-19 | 2017-05-31 | 河南理工大学 | A kind of passenger car height of center of mass real-time estimation device and evaluation method |
CN107036630A (en) * | 2017-04-27 | 2017-08-11 | 深圳市思拓通信系统有限公司 | A kind of automatic recognition system and method for vehicle drive prior-warning device setting angle |
CN107132377A (en) * | 2017-06-13 | 2017-09-05 | 南京越博动力系统股份有限公司 | The measurement apparatus and computational methods of a kind of vehicle acceleration and the residing gradient |
PL126698U1 (en) * | 2017-10-12 | 2019-04-23 | Politechnika Warszawska | Measuring wheel with the elevation measuring function |
CN109839122A (en) * | 2017-11-29 | 2019-06-04 | 高德信息技术有限公司 | A kind of determination method and apparatus of vehicle running state |
CN111327755A (en) * | 2018-12-14 | 2020-06-23 | 西安博瑞集信电子科技有限公司 | Intelligent vehicle driving state identification system and method based on mobile phone |
CN111337051A (en) * | 2020-03-17 | 2020-06-26 | 北京百度网讯科技有限公司 | Method and device for calibrating forward axis of vehicle accelerometer |
CN111337051B (en) * | 2020-03-17 | 2022-02-01 | 阿波罗智联(北京)科技有限公司 | Method and device for calibrating forward axis of vehicle accelerometer |
CN114280332A (en) * | 2021-12-31 | 2022-04-05 | 成都路行通信息技术有限公司 | Three-axis acceleration sensor correction method |
CN114280332B (en) * | 2021-12-31 | 2024-04-23 | 成都路行通信息技术有限公司 | Triaxial acceleration sensor correction method |
Also Published As
Publication number | Publication date |
---|---|
CN103632062B (en) | 2017-01-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103632062A (en) | Method and device for determining uphill and downhill running states of vehicle by utilizing acceleration sensor and gyroscope | |
CN102168977B (en) | Use the wheel alignment diagnosis of GPS | |
US7463953B1 (en) | Method for determining a tilt angle of a vehicle | |
ES2317897T3 (en) | ADAPTIVE FILTER MODEL FOR AUTOMOTIVE VEHICLE SENSOR SIGNS. | |
CN104360366B (en) | Dead reckoning and GPS (global positioning system) combined positioning method | |
US11383727B2 (en) | Vehicle operation based on vehicular measurement data processing | |
CN105109490B (en) | Method for judging sharp turn of vehicle based on three-axis acceleration sensor | |
JP2001356131A (en) | Estimation method and device for lateral acceleration and executing method of brake operation | |
JPH07502825A (en) | Dynamic calibration method and device for differential odometer | |
CN103743921B (en) | Based on self-adaptation speed measuring system and the method for inertial sensor | |
JP2019523176A (en) | How to determine the driving state variable | |
CN106153069B (en) | Attitude rectification device and method in autonomous navigation system | |
CN107380169B (en) | Online prediction method and system for automobile steering control characteristics | |
CN103712622A (en) | Gyroscopic drift estimation compensation method and device based on rotation of inertial measurement unit | |
JP2015189300A (en) | Vehicle body roll angle estimation apparatus | |
CN107782307A (en) | A kind of SINS/DR integrated navigation systems odometer abnormal data post-processing approach | |
RU2013157331A (en) | METHOD FOR ASSESSING RAILWAY VEHICLE SPEED | |
JP6215915B2 (en) | Speed calculation device and speed calculation method | |
CN115060257A (en) | Vehicle lane change detection method based on civil-grade inertia measurement unit | |
CN103391871B (en) | For the method and apparatus determining the obliquity of vehicle | |
KR101332651B1 (en) | Apparatus for measuring steering wheel angle | |
CN104833529A (en) | Vehicle performance test system based on inertial navigation and test method thereof | |
JP7186919B2 (en) | Method and apparatus for determining vehicle wheel imbalance | |
Huttner et al. | Offset and misalignment estimation for the online calibration of an MEMS-IMU using FIR-filter modulating functions | |
US9791277B2 (en) | Apparatus and method for measuring velocity of moving object in a navigation system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
DD01 | Delivery of document by public notice |
Addressee: Beijing Qiantu Fangyuan Software Technology Co., Ltd. Document name: Notification that Application Deemed not to be Proposed |
|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170125 Termination date: 20181206 |
|
CF01 | Termination of patent right due to non-payment of annual fee |