Vehicular behavior determination device and vehicular behavior determination method
First Claim
Patent Images
1. A vehicular behavior determination device which determines a behavior of a vehicle, comprising:
- a first arithmetic processor, which determines a parameter representing the behavior of the vehicle;
a second arithmetic processor, which calculates a posture vector representing a posture of the vehicle in a global coordinate system on the basis of a determination result determined by the first arithmetic processor; and
a third arithmetic processor, which calculates an angular velocity vector representing an angular velocity of the vehicle around each of 3 orthogonal axes in a vehicular coordinate system on the basis of a temporal variation mode of the posture vector calculated by the second arithmetic processor;
wherein the second arithmetic processor calculates an ith posture vector (i=1, 2,
3) which represents a posture of each of the 3 orthogonal axes of the vehicular coordinate system in the global coordinate system as the posture vector; and
the third arithmetic processor obtains a rotational main axis vector which represents a direction of a rotational main axis in the global coordinate system by combining 3 rotational axis vectors for making a previous ith posture vector match with a current ith posture vector, calculates a first-order angular velocity vector which represents an angular velocity of the vehicle around each of the 3 orthogonal axes in the global coordinate system on the basis of the obtained rotational main axis vector, the previous ith posture vector and the current ith posture vector, and thereafter calculates a second-order angular velocity vector which represents the angular velocity of the vehicle around each of the 3 orthogonal axes in the vehicular coordinate system as the angular velocity vector on the basis of the first-order angular velocity vector and the ith posture vector.
1 Assignment
0 Petitions
Accused Products
Abstract
According to a vehicular behavior determination device (100) of the present invention, an angular velocity vector ω(k) which represents an angular velocity around each of 3 axes of a vehicle (1) can be determined in high accuracy on the basis of a temporal variation mode of a posture vector psti(k) (i=x, y, z) which represents a posture of the vehicle (1) in a global coordinate system in an attempt to curtail a manufacture cost and size of the vehicle (1) by avoiding the usage of a 3-axis gyro sensor which is relatively expensive in price and large in size.
-
Citations
5 Claims
-
1. A vehicular behavior determination device which determines a behavior of a vehicle, comprising:
-
a first arithmetic processor, which determines a parameter representing the behavior of the vehicle; a second arithmetic processor, which calculates a posture vector representing a posture of the vehicle in a global coordinate system on the basis of a determination result determined by the first arithmetic processor; and a third arithmetic processor, which calculates an angular velocity vector representing an angular velocity of the vehicle around each of 3 orthogonal axes in a vehicular coordinate system on the basis of a temporal variation mode of the posture vector calculated by the second arithmetic processor; wherein the second arithmetic processor calculates an ith posture vector (i=1, 2,
3) which represents a posture of each of the 3 orthogonal axes of the vehicular coordinate system in the global coordinate system as the posture vector; andthe third arithmetic processor obtains a rotational main axis vector which represents a direction of a rotational main axis in the global coordinate system by combining 3 rotational axis vectors for making a previous ith posture vector match with a current ith posture vector, calculates a first-order angular velocity vector which represents an angular velocity of the vehicle around each of the 3 orthogonal axes in the global coordinate system on the basis of the obtained rotational main axis vector, the previous ith posture vector and the current ith posture vector, and thereafter calculates a second-order angular velocity vector which represents the angular velocity of the vehicle around each of the 3 orthogonal axes in the vehicular coordinate system as the angular velocity vector on the basis of the first-order angular velocity vector and the ith posture vector. - View Dependent Claims (2, 3, 5)
-
-
4. A vehicular behavior determination method of determining a behavior of a vehicle, comprising steps of:
-
a first arithmetic processing for determining a parameter representing the behavior of the vehicle; a second arithmetic processing for calculating a posture vector representing a posture of the vehicle in a global coordinate system on the basis of a determination result determined by the first arithmetic processing; and a third arithmetic processing for calculating an angular velocity vector representing an angular velocity of the vehicle around each of 3 orthogonal axes in a vehicular coordinate system on the basis of a temporal variation mode of the posture vector calculated by the second arithmetic processing; wherein the second arithmetic processing comprises calculating an ith posture vector (i=1, 2,
3) which represents a posture of each of the 3 orthogonal axes of the vehicular coordinate system in the global coordinate system as the posture vector; andthe third arithmetic processing comprises obtaining a rotational main axis vector which represents a direction of a rotational main axis in the global coordinate system by combining 3 rotational axis vectors for making a previous ith posture vector match with a current ith posture vector, calculating a first-order angular velocity vector which represents an angular velocity of the vehicle around each of the 3 orthogonal axes in the global coordinate system on the basis of the obtained rotational main axis vector, the previous ith posture vector and the current ith posture vector, and thereafter calculating a second-order angular velocity vector which represents the angular velocity of the vehicle around each of the 3 orthogonal axes in the vehicular coordinate system as the angular velocity vector on the basis of the first-order angular velocity vector and the ith posture vector.
-
Specification