CN100516773C - Vehicle carried road slope angle measuring system and vehicle carried road slope angle measuring method - Google Patents
Vehicle carried road slope angle measuring system and vehicle carried road slope angle measuring method Download PDFInfo
- Publication number
- CN100516773C CN100516773C CNB2004101040318A CN200410104031A CN100516773C CN 100516773 C CN100516773 C CN 100516773C CN B2004101040318 A CNB2004101040318 A CN B2004101040318A CN 200410104031 A CN200410104031 A CN 200410104031A CN 100516773 C CN100516773 C CN 100516773C
- Authority
- CN
- China
- Prior art keywords
- gps
- formula
- angle
- motor vehicle
- vehicle
- 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
Images
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
The present invention provides a vehicle carried road slope angle measuring system and a vehicle carried road slope angle measuring method. The vehicle carried road slope angle measuring system compriThis invention provides a vehicle path grade angle measuring system and its measuring method. The measuring system includes: GPS speed measuring instrument, which is used to measure the flashy verticases a GPS speed measuring instrument, a front suspension displacement sensor, a rear suspension displacement sensor and an electronic control unit, wherein the GPS speed measuring instrument is used fl velocity Vv and horizontal velocity Vh of the vehicles; the front suspension position sensing device installed at the front suspension of the vehicle, which is used to measure the related flashy disor measuring a vertical speed V v and a horizontal speed V h of a motor vehicle at some instant in running; the front suspension displacement sensor is arranged on a front suspension of a motor vehiclplacement Zf of the body at the front suspension that is perpendicular to the path; the back suspension position sensing installed at the back suspension, which is used to measure the related flashy de and is used for measuring the displacement Z f of a vehicle body on the front suspension in a direction vertical to a road plane at the instant; the rear suspension displacement sensor is arranged oisplacement Zf of the body at the back suspension that is perpendicular to the path; the electric control cell, which connects with the CPS speed measuring instrument, the front suspension position sen a rear suspension of a motor vehicle and is used for measuring the displacement Z r of a vehicle body on the rear suspension in a direction vertical to a road plane at the instant; the electronic consing device and the back suspension position sensing device to obtain the value of Vv, Vh, Zf, Zr, and it computes the path grade angel theta according to the formula (1), (2) and (3). alphaGPS=arctantrol unit is electrically connected with the GPS speed measuring instrument, the front suspension displacement sensor and the rear suspension displacement sensor in order to obtain values of Vv, Vh, n(Vv/Vh) (1); gamma=arctan((Zf-Zr)/L) (2); theta=alphaGPS-gamma (3). Zf and Zr, and a road slope angle theta is calculated accordingly to the following formulas (1), (2) and (3): alpha<GPS>=arctan(Vv/Vh) (1); gamma=arctan((Zf-Zr)/L) (2); theta=alpha<GPS>-gamma (3).
Description
Technical field
The present invention relates to a kind of vehicle-mounted road grade angle measuring system and vehicle-mounted road grade angle measuring method of the angle of gradient of road being measured when being used for motor vehicle and going up a slope.
Background technology
Can obtain the better driving performance when motor vehicle is travelled on sloping road, the measurement mechanism that the road grade angle is calculated need be installed on vehicle body.The patent No. is to disclose a kind of device that can measure the road grade angle in 6714851 the United States Patent (USP), but this apparatus structure more complicated, a plurality of sensors such as steering wheel angle sensor, acceleration transducer and wheel speed sensor need be installed in whole automotive system, its cost height, and include the angle of pitch of motor vehicle in the measured road grade angle that draws.The angle of pitch is meant respectively regards motor vehicle former and later two wheels on same straight line as a particle, connects resulting straight line of two particles and domatic angle and is the angle of pitch.Because the angle of pitch be can not ignore, therefore the measured road grade value that draws of this device is inaccurate, and its precision is not high.
Summary of the invention
An object of the present invention is to provide a kind of simple in structure, can carry out the vehicle-mounted road grade angle measuring system accurately measured to the road grade angle.Another object of the present invention provides a kind of method of the road grade angle being measured by described measuring system.
According to a first aspect of the invention, provide a kind of vehicle-mounted road grade angle measuring system, it comprises:
The GPS speed measuring instrumentation, it is used for measuring the motor vehicle that travels at certain vertical speed V in a flash
vAnd horizontal velocity V
h
Be installed in the front suspension displacement transducer at motor vehicle front suspension place, the vehicle body of the front suspension position when being used to measure described moment is along the displacement Z perpendicular to the road plane direction
f
Be installed in the rear suspension displacement transducer at motor vehicle rear suspension place, the vehicle body of the rear suspension position when being used to measure described moment is along the displacement Z perpendicular to the road plane direction
r
Electronic control unit (ECU), it is electrically connected to obtain described vertical speed V with described GPS speed measuring instrumentation
vWith horizontal velocity V
h, be electrically connected with described front suspension displacement transducer with the vehicle body that obtains described front suspension position along displacement Z perpendicular to the road plane direction
f, be electrically connected with described rear suspension displacement transducer with the vehicle body that obtains described rear suspension position along displacement Z perpendicular to the road plane direction
r, and calculate road grade angle θ according to following formula (1), (2) and (3):
α
GPS=arctan(V
v/V
h) (1)
γ=arctan((Z
f-Z
r)/L) (2)
θ=α
GPS-γ (3)
In the formula, γ is the angle of pitch of motor-driven vehicle going when gradient road surface, the road grade angle of θ for needing to measure, α
GPSBe the angle of pitch and road grade angle sum that the speed of being measured by the GPS speed measuring instrumentation calculates by formula (1), L is the distance between front suspension displacement transducer and the rear suspension displacement transducer.
Described GPS speed measuring instrumentation is preferably mounted on the roof of motor vehicle.
Described electronic control unit comprises data reception module and data processing module; Data reception module is used for receiving described vertical speed V from described GPS speed measuring instrumentation
vWith horizontal velocity V
h, and the vehicle body that receives described front suspension position respectively from described forward and backward suspension displacement sensor is along the displacement Z perpendicular to the road plane direction
fWith the vehicle body of described rear suspension position along displacement Z perpendicular to the road plane direction
rDescribed data processing module is used for according to the V that receives
v, V
h, Z
f, Z
r, and, calculate road grade angle θ by formula (1), (2) and (3) by the value of the determined L in installation site of forward and backward suspension displacement sensor.
By the road grade angle that records, just can motor vehicle travelling on sloping road be control effectively by the drive control module of motor vehicle.
In the measuring process of reality, because may there be measured deviation (noise) in the GPS speed measuring instrumentation, so the α that records
GPSAnd the relation between the α of reality can be expressed as following formula (4):
α
GPS=α+η(4)
η is the noise in the GPS measuring process in the formula.
For measurement road angle of gradient θ more accurately, according to of the present invention preferred embodiment a kind of, a gyroscope also has been installed at the barycenter place of motor vehicle, it is electrically connected with described electronic control unit (ECU), is used for the rate of pitch q of measuring machine motor-car.Remember that gyrostatic rate of pitch measured value is q
Gyro, then there is following relationship formula (5):
In the formula
The motor vehicle rate of pitch that expression is actual, q
BiasBe gyrostatic deviation, ∈ is the noise (white Gaussian noise) in the gyroscope survey process.
The form of (5) formula matrix of being write as is got:
In the formula: α is actual road grade angle and motor vehicle angle of pitch sum,
The motor vehicle rate of pitch that expression is actual, q
BiasBe gyrostatic measured deviation,
Expression gyroscope deviation is rate over time, q
GyroBe the gyroscope survey value of motor vehicle rate of pitch, ε is a white Gaussian noise.
Equally also can be write (4) formula as matrix form
Can construct a pitching Kalman filter algorithm by formula (6) and formula (7), its state vector x=[α q
Bias]
T, measuring vector is y=α
GPS, state-transition matrix Φ=, gating matrix Ψ=[10]
T, measure matrix H=[10].Like this, just can estimate α angle and gyrostatic deviation q comparatively exactly
BiasBy the α in the α angle replacement formula (3) that records thus
GPS, calculate angle of pitch γ by formula (2) simultaneously, just can calculate road grade angle θ by formula (3).
In addition, according to this preferred embodiment, when GPS speed measuring instrumentation cisco unity malfunction, can establish the q in the formula (5)
BiasBe 0 with ∈, so just can be by rate of pitch value q by gyroscope survey
GyroEstimate the α angle roughly, by with the α in this α angle replacement formula (3)
GPS, calculate angle of pitch γ by formula (2) simultaneously, just can estimate road grade angle θ by formula (3).Therefore, though GPS speed measuring instrumentation cisco unity malfunction, by of the present invention this preferred embodiment, also can estimate, thereby motor vehicle travelling on sloping road control effectively the road grade angle.
According to a second aspect of the invention, provide a kind of method of the road grade angle being measured by described measuring system, this method comprises:
Record the motor vehicle that on sloping road, travels by the GPS speed measuring instrumentation at certain vertical speed V in a flash
vAnd horizontal velocity V
h
The vehicle body of the front suspension position when recording described moment by the front suspension displacement transducer that is installed in motor vehicle front suspension place is along the displacement Z perpendicular to the road plane direction
f
The vehicle body of the rear suspension position when recording described moment by the rear suspension displacement transducer that is installed in motor vehicle rear suspension place is along the displacement Z perpendicular to the road plane direction
r
(ECU) receives described V by electronic control unit
v, V
h, Z
f, Z
rValue, and calculate road grade angle θ by following formula (1), (2) and (3):
α
GPS=arctan(V
v/V
h) (1)
γ=arctan((Z
f-Z
r)/L) (2)
θ=α
GPS-γ (3)
The inventive method a kind of preferred embodiment in, record the rate of pitch q of motor vehicle by the gyroscope that is installed in motor vehicle barycenter place
Gyro, calculate actual α and gyrostatic deviation q by the pitching Kalman filter algorithm by following formula (6) and (7)
Bias, calculate angle of pitch γ by formula (2) simultaneously, again by with the α in this α replacement formula (3)
GPSAnd calculate road grade angle θ by formula (3).
When GPS speed measuring instrumentation cisco unity malfunction, can establish the q in the formula (5)
BiasBe 0 with ∈, so just can be by rate of pitch value q by gyroscope survey
GyroEstimate the α angle roughly, by with the α in this α angle replacement formula (3)
GPS, calculate angle of pitch γ by formula (2) simultaneously, just can estimate road grade angle θ by formula (3).Therefore, though GPS speed measuring instrumentation cisco unity malfunction, by of the present invention this preferred embodiment, also can estimate, thereby motor vehicle travelling on sloping road control effectively the road grade angle.
Description of drawings
Fig. 1 is the structured flowchart according to angle of gradient measuring system of the present invention;
Fig. 2 be motor vehicle on sloping road situation and according to the installation site synoptic diagram of each parts of angle of gradient measuring system of the present invention;
Fig. 3 is the workflow diagram of electronic control unit (ECU);
Fig. 4 is the processing block diagram of the Kalman filtering during n at any one time.
Embodiment
Below in conjunction with accompanying drawing the specific embodiment of the present invention is described in detail.
As depicted in figs. 1 and 2, vehicle-mounted road grade angle measuring system of the present invention comprises a vehicle GPS speed measuring instrumentation 20 that is positioned at the motor vehicle roof, be installed in gyroscope 50 that motor vehicle barycenter (GC) locates, be installed in the front suspension displacement transducer 30 on the motor vehicle front suspension and be installed in rear suspension displacement transducer 40 on the motor vehicle rear suspension, and electronic control unit (ECU) 60 and drive control module 70. Displacement transducer 30,40 and gyroscope 50 all are electrically connected with electronic control unit (ECU) 60.Drive control module 70 is electrically connected with electronic control unit, and the road grade angle that is used for providing according to electronic control unit (ECU) 60 control effectively to motor vehicle travelling on sloping road.Described electronic control unit (ECU) 60 and drive control module 70 can be parts that is integrated on the motor vehicle master control borad.
Described GPS speed measuring instrumentation and described forward and backward suspension displacement sensor and gyroscope are the existing conventional equipments of prior art, it can obtain from the commercial goods, for example VBOX of the Aquarius 5002unit of Thales Navigation company or Racelogic company etc.
Principle of work of the present invention is as follows:
As shown in Figure 2, be on the road of θ in the angle of gradient, be that the roof of the motor vehicle 10 of u is equipped with GPS speed measuring instrumentation 20 in travel direction, the motor vehicle that can be obtained by this GPS speed measuring instrumentation 20 to travel on sloping road is at certain vertical speed V in a flash
vAnd horizontal velocity V
hAfter the data reception module of electronic control unit (ECU) 60 obtains this speed, calculate the measured value α of GPS speed measuring instrumentation according to formula (1) by its data processing module
GPS, this α
GPSShould be road grade angle θ and motor vehicle angle of pitch η sum.
α
GPS=arctan(V
v/V
h) (1)
In the formula: V
vAnd V
hBe respectively vertical speed and the horizontal velocity that the GPS speed measuring instrumentation measures.
The vehicle body of the front suspension position when simultaneously, the front suspension displacement transducer 30 that is installed in motor vehicle front suspension place records described moment is along the displacement Z perpendicular to the road plane direction
f, the vehicle body of the rear suspension position when the rear suspension displacement transducer 40 that is installed in motor vehicle rear suspension place records described moment is along the displacement Z perpendicular to the road plane direction
r, the data reception module of electronic control unit (ECU) 60 receives described Z
fAnd Z
rValue, and owing to be known by the value of the determined L in installation site of forward and backward suspension displacement sensor, so the data processing module of electronic control unit (ECU) 60 can calculate the angle of pitch γ of motor-driven vehicle going when the gradient road surface according to following formula (2):
γ=arctan((Z
f-Z
r)/L) (2)
Because α
GPSBe road grade angle θ and motor vehicle angle of pitch η sum, so the data processing module of electronic control unit (ECU) 60 can calculate road grade angle θ according to following formula (3).
θ=α
GPS-γ (3)
In the measuring process of reality, because may there be measured deviation (noise) in GPS speed measuring instrumentation 20, so the α that records
GPSAnd the relation between the α of reality can be expressed as following formula (4):
α
GPS=α+η (4)
η is the noise in the GPS measuring process in the formula.
For measurement road angle of gradient θ more accurately, locate also to have installed a gyroscope 50 at the barycenter (GC) of motor vehicle, it is electrically connected with described electronic control unit (ECU) 60, is used for the rate of pitch q of measuring machine motor-car.Remember that gyrostatic rate of pitch measured value is q
Gyro, then there is following relationship formula (5):
Q in the formula
BiasBe gyrostatic deviation, ∈ is the noise in the gyroscope survey process.
The form of (5) formula matrix of being write as is got:
Equally also can be write as (4) formula matrix form and be got:
Formula (6) can be write a Chinese character in simplified form into following form with (7) and get:
y=Hx+η (9)
Being write formula (8) and (9) as discrete form gets:
x[n+1]=Φx[n]+Ψu[n]+ε[n] (10)
y[n]=Hx[n]+η[n] (11)
In the formula: x=[α q
Bias]
T, y=[α
GPS],
Ψ=[10]
T, H=[10], u=[q
Gyro], ∈ and η are separate Gaussian random vector, just white Gaussian noise.
For the System State Model that single input-list of shape such as formula (10) and formula (11) formation is exported, can carry out optimal estimation to vector x with Kalman filtering algorithm.
Kalman filtering is a kind of known mathematical algorithm, and its mathematical principle is as follows:
The state model of shape such as formula (10) and (11), its Kalman filtering satisfies following recurrence equation:
A. measure and upgrade
K[n]=P[n|n-1]H
T(HP[n|n-1]H
T+R[n])
-1 (13)
P[n|n]=(I-K[n]H)P[n|n-1] (14)
B. the time upgrades
P[n+1|n]=ΦP[n|n]Φ
T+Q[n] (16)
More than in 5 formula:
Expression utilizes n measuring value y[n constantly] updating value of the x that upgrades, the optimum estimate of constantly x being carried out at n just, as shown in Figure 4;
I is a unit matrix;
K[n] be kalman gain matrix;
Q[n] be the covariance matrix of plant noise ∈ [n], be Q[n]=E (ε [n] ε [n]
T);
R[n] be the covariance matrix of measurement noise η [n], be R[n]=E (η [n] η [n]
T);
P[n|n] and P[n|n-1] be the error covariance matrix, they are defined as
X[n wherein] be illustrated in the n actual value of x constantly, the implication of symbol E () is to ask the expectation value of expression formula in the bracket.
As given 0 constantly initial value x[1|0] and P[1|0] after, 5 formula of the Kalman filtering algorithm that just can iterate, i.e. formula (12)~formula (16), thus can estimate the x value of the best constantly at arbitrary n, as shown in Figure 4.
Like this, just can estimate x comparatively exactly, i.e. α angle and gyrostatic deviation q through after the Kalman filtering
BiasBy the α in the α angle replacement formula (3) that records thus
GPS, calculate angle of pitch γ by formula (2) simultaneously, just can calculate road grade angle θ by formula (3).
In addition, when GPS speed measuring instrumentation cisco unity malfunction, can establish the q in the formula (5)
BiasBe 0 with ∈, so just can be by rate of pitch value q by gyroscope survey
GyroEstimate the α angle roughly, by with the α in this α angle replacement formula (3)
GPS, calculate angle of pitch γ by formula (2) simultaneously, just can estimate road grade angle θ by formula (3).Therefore, even GPS speed measuring instrumentation cisco unity malfunction by gyroscope provided by the invention, also can be estimated the road grade angle.
By the road grade angle θ that obtains, drive control module 70 can be regulated driving force according to the motor vehicle kinetics equation, makes motor vehicle also can obtain good driveability on the ramp.
Fig. 3 is the workflow diagram of electronic control unit (ECU).In the step S200 of Fig. 3, ECU 60 obtains signal from GPS speed measuring instrumentation 20, gyroscope 50, front suspension displacement transducer 30 and rear suspension displacement transducer 40; In step S300, calculate the GPS measured value α at α angle according to formula (1)
GPSIn step S400, utilize result and pitching Kalman filter algorithm among the step S300 to calculate the estimated value at α angle by formula (6) and formula (7); In step S500, calculate the angle of pitch γ of automobile according to formula (2); In step S600, calculate the angle of gradient θ of road according to formula (3).
Claims (5)
1, a kind of vehicle-mounted road grade angle measuring system, it comprises:
The GPS speed measuring instrumentation, it is used for measuring the motor vehicle that travels at certain vertical speed V in a flash
vAnd horizontal velocity V
h
Be installed in the gyroscope at motor vehicle barycenter place, it is electrically connected with described electronic control unit, is used for the rate of pitch q of measuring machine motor-car
Gyro
Be installed in the front suspension displacement transducer at motor vehicle front suspension place, the vehicle body of the front suspension position when being used to measure described moment is along the displacement Z perpendicular to the road plane direction
f
Be installed in the rear suspension displacement transducer at motor vehicle rear suspension place, the vehicle body of the rear suspension position when being used to measure described moment is along the displacement Z perpendicular to the road plane direction
r
Electronic control unit, it is electrically connected to obtain described vertical speed V with described GPS speed measuring instrumentation
vWith horizontal velocity V
h, be electrically connected with described front suspension displacement transducer with the vehicle body that obtains described front suspension position along displacement Z perpendicular to the road plane direction
f, be electrically connected with described rear suspension displacement transducer with the vehicle body that obtains described rear suspension position along displacement Z perpendicular to the road plane direction
r, and calculate actual α and gyrostatic deviation q by the pitching Kalman filter algorithm by following formula (1), (6) and (7)
Bias, calculate angle of pitch γ by formula (2) simultaneously, again by with the α in this α replacement formula (3)
GPSAnd calculate road grade angle θ by formula (3):
α
GPS=arctan(V
v/V
h) (1)
γ=arctan((Z
f-Z
r)/L) (2)
θ=α
GPS-γ (3)
In the formula, γ is the angle of pitch of motor-driven vehicle going when gradient road surface, the road grade angle of θ for needing to measure, α
GPSBe the motor vehicle angle of pitch and road grade angle sum that the described speed of being measured by the GPS speed measuring instrumentation calculates by formula (1), L is the distance between front suspension displacement transducer and the rear suspension displacement transducer;
In the formula: α is actual road grade angle and motor vehicle angle of pitch sum,
The motor vehicle rate of pitch that expression is actual, q
BiasBe gyrostatic measured deviation,
Expression gyroscope deviation is rate over time, q
GyroBe the gyroscope survey value of motor vehicle rate of pitch, ε is a white Gaussian noise;
In the formula: η is 1 * 1 white Gaussian noise.
2, vehicle-mounted road grade angle measuring system according to claim 1, wherein said GPS speed measuring instrumentation is installed on the roof of motor vehicle.
3, vehicle-mounted road grade angle measuring system according to claim 1, wherein said electronic control unit comprises data reception module and data processing module; Described data reception module is used for receiving described vertical speed V from described GPS speed measuring instrumentation
vWith horizontal velocity V
h, and the vehicle body that receives described front suspension position respectively from described forward and backward suspension displacement sensor is along the displacement Z perpendicular to the road plane direction
fWith the vehicle body of described rear suspension position along displacement Z perpendicular to the road plane direction
rDescribed data processing module is used for according to the V that receives
v, V
h, Z
f, Z
r, and, calculate road grade angle θ by formula (1), (2) and (3) by the value of the determined L in installation site of forward and backward suspension displacement sensor.
4, a kind of method of the road grade angle being measured by the described measuring system of claim 1, this method comprises:
Record the motor vehicle that on sloping road, travels by the GPS speed measuring instrumentation at certain vertical speed V in a flash
vAnd horizontal velocity V
h
Record the rate of pitch q of motor vehicle by the gyroscope that is installed in motor vehicle barycenter place
Gyro
The vehicle body of the front suspension position when recording described moment by the front suspension displacement transducer that is installed in motor vehicle front suspension place is along the displacement Z perpendicular to the road plane direction
f
The vehicle body of the rear suspension position when recording described moment by the rear suspension displacement transducer that is installed in motor vehicle rear suspension place is along the displacement Z perpendicular to the road plane direction
r
Receive described V by electronic control unit
v, V
h, Z
f, Z
r, q
GyroValue, and calculate actual α and gyrostatic deviation q by the pitching Kalman filter algorithm by (1) in the following formula, (6) and (7)
Bias, calculate angle of pitch γ by formula (2) simultaneously, again by with the α in this α replacement formula (3)
GPSAnd calculate road grade angle θ by formula (3):
α
GPS=arctan(V
v/V
h) (1)
γ=arctan((Z
f-Z
r)/L) (2)
θ=α
GPS-γ (3)
In the formula: α is actual road grade angle and motor vehicle angle of pitch sum,
The motor vehicle rate of pitch that expression is actual, q
BiasBe gyrostatic measured deviation,
Expression gyroscope deviation is rate over time, q
GyroBe the gyroscope survey value of motor vehicle rate of pitch, ε is a white Gaussian noise;
In the formula: η is 1 * 1 white Gaussian noise.
5, the method that the road grade angle is measured according to claim 4 is characterized in that, when GPS speed measuring instrumentation cisco unity malfunction, by formula
Estimate the α angle, calculate angle of pitch γ by formula (2) simultaneously, again by with the α in this α angle replacement formula (3)
GPSAnd estimate road grade angle θ by formula (3).
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2004101040318A CN100516773C (en) | 2004-12-31 | 2004-12-31 | Vehicle carried road slope angle measuring system and vehicle carried road slope angle measuring method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2004101040318A CN100516773C (en) | 2004-12-31 | 2004-12-31 | Vehicle carried road slope angle measuring system and vehicle carried road slope angle measuring method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1800780A CN1800780A (en) | 2006-07-12 |
CN100516773C true CN100516773C (en) | 2009-07-22 |
Family
ID=36810915
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CNB2004101040318A Active CN100516773C (en) | 2004-12-31 | 2004-12-31 | Vehicle carried road slope angle measuring system and vehicle carried road slope angle measuring method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100516773C (en) |
Families Citing this family (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101968352B (en) * | 2010-09-15 | 2012-08-22 | 奇瑞汽车股份有限公司 | Detection device and detection method of pitch angle of vehicle body |
CN102252659B (en) * | 2011-06-10 | 2013-03-27 | 中国汽车工程研究院股份有限公司 | Car-mounted road surface gradient measuring method based on laser sensor |
CN102700551B (en) * | 2012-05-31 | 2015-05-20 | 清华大学 | Method for estimating gradient of road surface in real time in vehicle running process |
CN102826044B (en) * | 2012-09-07 | 2014-10-08 | 东风汽车有限公司 | Slope safety driving system of vehicle |
CN103353299B (en) * | 2013-06-20 | 2015-07-08 | 西安交通大学 | High-precision vehicle-mounted road grade detection device and method |
CN103852064B (en) * | 2014-03-28 | 2016-03-09 | 安徽农业大学 | A kind of vehicle-mounted real-time testing system of road grade and method of testing thereof |
CN105136116B (en) * | 2015-07-20 | 2017-09-05 | 安徽江淮汽车集团股份有限公司 | A kind of vehicle-mounted road grade real-time testing system and method for testing |
CN105416294B (en) * | 2015-12-26 | 2018-03-09 | 吉林大学 | A kind of Heavy Duty Truck method for parameter estimation |
US10234568B2 (en) * | 2016-05-12 | 2019-03-19 | GM Global Technology Operations LLC | GNSS vehicle location involving overlapping roads |
CN106515739B (en) * | 2016-12-20 | 2019-03-05 | 江苏大学 | A kind of electric car ramp identification device and method |
CN106548651A (en) * | 2017-01-17 | 2017-03-29 | 吉林大学 | A kind of On-line testing method of vehicle traveling road ahead fine information |
CN111141258B (en) * | 2018-11-05 | 2022-03-08 | 厦门雅迅网络股份有限公司 | Road gradient measuring method and computer readable storage medium |
CN110832274A (en) * | 2018-11-21 | 2020-02-21 | 深圳市大疆创新科技有限公司 | Ground slope calculation method, device, equipment and storage medium |
CN111307113A (en) * | 2019-02-21 | 2020-06-19 | 中国第一汽车股份有限公司 | Vehicle-mounted real-time road transverse gradient measuring device and measuring method thereof |
CN112368592A (en) * | 2019-11-05 | 2021-02-12 | 深圳市大疆创新科技有限公司 | Method for detecting radar installation state, movable platform, equipment and storage medium |
CN111060071B (en) * | 2019-12-16 | 2022-07-08 | 中公高科养护科技股份有限公司 | Road slope measuring method and system |
CN112684803B (en) * | 2021-03-11 | 2021-06-11 | 上海擎朗智能科技有限公司 | Control method and device for mobile robot, mobile robot and storage medium |
-
2004
- 2004-12-31 CN CNB2004101040318A patent/CN100516773C/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN1800780A (en) | 2006-07-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100516773C (en) | Vehicle carried road slope angle measuring system and vehicle carried road slope angle measuring method | |
US10643473B2 (en) | Vehicle and method for collision avoidance assistance | |
CN102556075B (en) | Vehicle operating state estimation method based on improved extended Kalman filter | |
CN101405174B (en) | Avoidance operation calculation device, avoidance control device, vehicle with each of the devices, avoidance operation calculation method, and avoidance control method | |
US7222007B2 (en) | Attitude sensing system for an automotive vehicle relative to the road | |
US7451033B2 (en) | Lateral and longitudinal velocity determination for an automotive vehicle | |
EP3527057B1 (en) | Monitoring steering conditions of an off-road vehicle | |
CN103407451B (en) | A kind of road longitudinal and additional forces method of estimation | |
US7054723B2 (en) | Information presentation controlling apparatus and method based on driver's mental fatigue | |
US6829524B2 (en) | Method and apparatus for estimating yaw rate in a wheeled vehicle and stability system | |
US8494710B2 (en) | System and method for identifying a spatial relationship for use in calibrating accelerometer data | |
CN104061899B (en) | A kind of vehicle side inclination angle based on Kalman filtering and angle of pitch method of estimation | |
EP2295989B1 (en) | Velocity calculating device, velocity calculating method, and navigation device | |
US6725140B2 (en) | Method and apparatus for determining lateral velocity of a motor vehicle in closed form for all road and driving conditions | |
CN107560612A (en) | For the system and method for the Angle Position for determining the vehicles | |
CN103661366A (en) | Vehicle curve overturn prevention system and method thereof | |
CN102416956A (en) | Soft measurement method for automobile mass center slip angle and tire slip angle | |
CN103625475B (en) | A kind of vehicle side inclination angle based on recurrence least square and pitch angle method of estimation | |
CN101655504A (en) | Vehicle speed estimation method of motor vehicle self-adaption cruise system | |
CN103217158B (en) | A kind of method improving vehicle-mounted SINS/OD integrated navigation precision | |
CN1862232B (en) | System and method for estimating side drift angle of motor vehicle | |
CN107618505A (en) | A kind of control system and method for improving automatic parking success rate | |
CN114435471A (en) | System and method for estimating hitch angle | |
CN110316197A (en) | Tilt evaluation method, inclination estimation device and the non-transitory computer-readable storage media for storing program | |
CN111006884B (en) | Method for measuring wheel axle slip angle and slip stiffness based on Fourier transform |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |