Body state estimation of a vehicle
First Claim
Patent Images
1. A system for estimating body states of a vehicle comprising:
- a first linear accelerometer and a second linear accelerometer mounted to the vehicle in separate locations from each other, the first and second linear accelerometers being configured to measure the acceleration of the vehicle in a first direction and generate measured first and second linear acceleration signals based on the acceleration of the vehicle in the first direction, the measured first and second linear acceleration signals defining a first set of linear acceleration signals;
a third linear accelerometer and a fourth linear accelerometer mounted to the vehicle in separate locations from each other, the third and fourth linear accelerometers being configured to measure the acceleration of the vehicle in a second direction and generate measured third and fourth linear acceleration signals based on the acceleration of the vehicle in the second direction, wherein the second direction is different from the first direction, the measured third and fourth linear acceleration signals defining a second set of linear acceleration signals;
a signal adjuster configured to transform the first and second sets of linear acceleration signals from a sensor coordinate system to a body coordinate system associated with the vehicle; and
an estimating filter configured to receive the transformed first and second sets of linear acceleration signals from the signal adjuster and process at least one of the transformed first and second sets of linear acceleration signals into at least one of a roll rate, a roll angle and a yaw rate, based on at least one of the following equations;
Ay,meas=ÿ
v+{dot over (r)}vdxtoYA+{umlaut over (θ
)}vdztoRA+rvu;
a)
Az,meas=−
g+{umlaut over (θ
)}vdytoRA; and
b)
Ax,meas=−
{dot over (r)}vdytoYA,
c)where;
Ax,meas=acceleration in an x-direction;
Ay,meas=acceleration in a y-direction;
Az,meas=acceleration in a z-direction;
ÿ
v=lateral acceleration of the vehicle;
{dot over (r)}v=angular acceleration about a yaw axis of the vehicle;
dxtoYA=the distance along the x axis from one of the linear accelerometers to the yaw axis of the vehicle;
{umlaut over (θ
)}v=angular acceleration about a roll axis of the vehicle;
dztoRA=the distance along the z axis from one of the linear accelerometers to the roll axis of the vehicle;
rv=yaw rate of the vehicle;
u=longitudinal vehicle speed;
g=gravitational acceleration;
dytoRA=the distance along the y axis from one of the linear accelerometers to the roll axis of the vehicle; and
dytoYA=the distance along the y axis from one of the linear accelerometers to the yaw axis.
2 Assignments
0 Petitions
Accused Products
Abstract
The present invention features a system and method for estimating body states of a vehicle. The system includes at least two sensors mounted to the vehicle. The sensors generate measured vehicle state signals corresponding to the dynamics of the vehicle. A signal adjuster transforms the measured vehicle states from a sensor coordinate system to a body coordinate system associated with the vehicle. A filter receives the transformed measured vehicle states from the signal adjuster and processes the measured signals into state estimates of the vehicle, such as, for example, the lateral velocity, yaw rate, roll angle, and roll rate of the vehicle.
71 Citations
14 Claims
-
1. A system for estimating body states of a vehicle comprising:
-
a first linear accelerometer and a second linear accelerometer mounted to the vehicle in separate locations from each other, the first and second linear accelerometers being configured to measure the acceleration of the vehicle in a first direction and generate measured first and second linear acceleration signals based on the acceleration of the vehicle in the first direction, the measured first and second linear acceleration signals defining a first set of linear acceleration signals; a third linear accelerometer and a fourth linear accelerometer mounted to the vehicle in separate locations from each other, the third and fourth linear accelerometers being configured to measure the acceleration of the vehicle in a second direction and generate measured third and fourth linear acceleration signals based on the acceleration of the vehicle in the second direction, wherein the second direction is different from the first direction, the measured third and fourth linear acceleration signals defining a second set of linear acceleration signals; a signal adjuster configured to transform the first and second sets of linear acceleration signals from a sensor coordinate system to a body coordinate system associated with the vehicle; and an estimating filter configured to receive the transformed first and second sets of linear acceleration signals from the signal adjuster and process at least one of the transformed first and second sets of linear acceleration signals into at least one of a roll rate, a roll angle and a yaw rate, based on at least one of the following equations;
Ay,meas=ÿ
v+{dot over (r)}vdxtoYA+{umlaut over (θ
)}vdztoRA+rvu;
a)
Az,meas=−
g+{umlaut over (θ
)}vdytoRA; and
b)
Ax,meas=−
{dot over (r)}vdytoYA,
c)where; Ax,meas=acceleration in an x-direction; Ay,meas=acceleration in a y-direction; Az,meas=acceleration in a z-direction; ÿ
v=lateral acceleration of the vehicle;{dot over (r)}v=angular acceleration about a yaw axis of the vehicle; dxtoYA=the distance along the x axis from one of the linear accelerometers to the yaw axis of the vehicle; {umlaut over (θ
)}v=angular acceleration about a roll axis of the vehicle;dztoRA=the distance along the z axis from one of the linear accelerometers to the roll axis of the vehicle; rv=yaw rate of the vehicle; u=longitudinal vehicle speed; g=gravitational acceleration; dytoRA=the distance along the y axis from one of the linear accelerometers to the roll axis of the vehicle; and dytoYA=the distance along the y axis from one of the linear accelerometers to the yaw axis. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A system for estimating body states of a vehicle comprising:
-
a first linear accelerometer and a second linear accelerometer mounted to the vehicle in separate locations from each other, the first and second linear accelerometers being configured to measure the acceleration of the vehicle in a first direction and generate measured first and second linear acceleration signals based on the acceleration of the vehicle in the first direction, the measured first and second linear acceleration signals defining a first set of linear acceleration signals; a third linear accelerometer and a fourth linear accelerometer mounted to the vehicle in separate locations from each other, the third and fourth linear accelerometers being configured to measure the acceleration of the vehicle in a second direction and generate measured third and fourth linear acceleration signals based on the acceleration of the vehicle in the second direction, wherein the second direction is different from the first direction, the measured third and fourth linear acceleration signals defining a second set of linear acceleration signals; and a filter configured to process the first and second sets of linear acceleration signals using a model to generate at least one of a roll angle, a roll rate, and a yaw rate, the model being a model of the vehicle dynamics and the linear accelerometers, the model being based in part on distances along at least one of an x-axis, a y-axis, and a z-axis from each of the linear accelerometers to at least one of a yaw axis and a roll axis of the vehicle, the first linear accelerometer being located a first distance from the center of gravity of the vehicle, and the second linear accelerometer being located a second distance from the center of gravity of the vehicle, the third linear accelerometer being located a third distance from the center of gravity of the vehicle, and the fourth linear accelerometer being located a fourth distance from the center of gravity of the vehicle, wherein the model is based on at least one of the following equations;
Ay,meas=ÿ
v+{dot over (r)}vdxtoYA+{umlaut over (θ
)}vdztoRA+rvu;
a)
Az,meas=−
g+{umlaut over (θ
)}vdytoRA; and
b)
Ax,meas=−
{dot over (r)}vdytoYA,
c)where; Ax,meas=acceleration in an x-direction; Ay,meas=acceleration in a y-direction; Az,meas=acceleration in a z-direction; ÿ
v=lateral acceleration of the vehicle;{dot over (r)}v=angular acceleration about a yaw axis of the vehicle; dxtoYA=the distance along the x axis from one of the linear accelerometers to the yaw axis of the vehicle; {umlaut over (θ
)}v=angular acceleration about a roll axis of the vehicle;dztoRA=the distance along the z axis from one of the linear accelerometers to the roll axis of the vehicle; rv=yaw rate of the vehicle; u=longitudinal vehicle speed; g=gravitational acceleration; dytoRA=the distance along the y axis from one of the linear accelerometers to the roll axis of the vehicle; and dytoYA=the distance along the y axis from one of the linear accelerometers to the yaw axis. - View Dependent Claims (9, 10, 11, 12, 13, 14)
-
Specification