The present invention relates to the technical field of onboard devices for detecting data relating to motion and driving parameters of a transport vehicle. In particular, the present invention relates to a calibration method of the positioning of an onboard device according to the preamble of claim 1.
Calibration methods are known in which, during an initial installation step of an onboard device for the acquisition and the remote transmission of data relating to motion and driving parameters of a vehicle, the accelerometric sensor included in or connected to the onboard device must be mounted according to one or more predefined positions (direction and orientation) or positions dependent on the fulfillment of certain conditions.
The accelerometric sensor is able to measure the acceleration along a plurality of axes, usually three, and may be internal to the onboard device or connected to it by means of a wiring or a short-range wireless connection.
In order to represent acceleration variation events of a vehicle, it is necessary to convert the data read by the accelerometric sensor from the Cartesian reference system integral to the sensor itself to a predefined reference system linked to the vehicle, so as to correctly interpret directions and positions of the detected events.
A left-handed, three-axis reference system integral with the vehicle is conventionally considered and the inertial point of view is used, that is, of who is on board the vehicle.
The accelerometric sensor also has three detection axes (x′, y′, z′) and usually has a right-handed configuration. The axes of the accelerometric sensor x′, y′, z′ installed in a non-predefined manner but in the most effective manner to be firmly fixed to the chassis of the vehicle, must therefore be recalibrated one by one so as to be oriented consistently with the left-handed reference system of the vehicle (x, y, z).
The selected vehicle reference system includes three axes arranged as follows:
To prevent an installer from positioning the accelerometric sensor in an incorrect position, it is known to arrange a control system which prevents the activation of the device if the acceleration values at rest, along the axes of the accelerometric sensor which should be parallel to axes x and y of the vehicle, are not sufficiently low to consider the accelerometric sensor as being positioned exactly horizontally.
The known method described above, understandably, ensures the correct orientation of the z axis but does not ensure the correctness of the determination of its direction, and especially does not ensure the correct orientation of axes x and y.
This limitation does not therefore allow determining with certainty whether an event measured along the x axis or the y axis actually corresponds to an abrupt braking, to an abrupt acceleration or an abrupt curve, and it does not allow properly reconstructing the dynamics of an accident in which the vehicle has been involved.
In addition, the correctness of the installation is only entrusted to the respect of the directions specified by the installer, therefore the installation is not very reliable and requires a long working time by the installer.
Additionally, such a solution needs the accelerometric sensor to be external to the onboard device which would be difficult to install in its entirety with this constraint. The mandatory presence of a wiring is therefore required between the onboard device and the accelerometric sensor, since there are two hardware components to be fixed (onboard device and accelerometer), which increases the installation costs of the apparatus.
Finally, the accelerometric sensor coupled to the onboard device must always be installed according to the same orientation on any vehicle, but this is not always possible.
The present invention therefore aims to provide a satisfactory solution to the problems described above, while avoiding the drawbacks of prior art.
According to the present invention, such an object is achieved by a calibration method of the positioning of an onboard device for the detection of data relating to motion and driving parameters of a vehicle having the features recited in claim 1.
Particular embodiments are the subject of the dependent claims, whose content is to be understood as an integral part of the present description.
Further objects of the invention are an onboard device and a computer program as claimed.
In summary, the invention relates to two embodiment variants of a calibration method of the positioning of an onboard device for the acquisition and the remote transmission of data relating to motion and driving parameters of a vehicle including at least one accelerometric sensor, arranged in order to provide accurate indications about the displacement dynamics of the vehicle.
The two variants of the method are based on the same initial mathematical considerations and are specific for motor vehicles and motorcycles.
The variants of the method can be carried out at an elaboration module embedded in the onboard device or at a remote elaboration center. Moreover, variants of installation are also possible for the accelerometric sensor, on board of the onboard device itself or external, but connected thereto via a short-range communication channel of any nature.
The present invention is based on the principle of calibrating the positioning of the onboard device including or associated with an accelerometric sensor installed on a vehicle according to a random orientation, by means of the determination of a transformation matrix (R), adapted to put in relation the accelerations measured along a triad of axes of the coordinate system of the accelerometric sensor x′, y′, z′ with corresponding accelerations along a triad of axes in the vehicle coordinate system x, y, z.
Further features and advantages of the invention will appear more clearly from the following detailed description of an embodiment thereof, given by way of non-limiting example with reference to the accompanying drawing, in which:
Before explaining a plurality of embodiments of the invention in detail, it should be noted that the invention is not limited in its application to the construction details and to the configuration of the components presented in the following description or shown in the drawings. The invention can take other embodiments and be implemented or practically carried out in different ways. It should also be understood that the phraseology and terminology are for descriptive purpose and are not to be construed as limiting. The use of “include” and “comprise” and variations thereof are intended as including the elements cited thereafter and their equivalents, as well as additional elements and equivalents thereof.
The calibration method of the positioning of an onboard device for the acquisition and the remote transmission of data relating to motion and driving parameters of a vehicle, wherein the device has a first plurality of axes of a reference coordinate system of the vehicle x, y, z and comprises at least one accelerometric sensor S adapted to detect the accelerations to which the vehicle is subjected along a second plurality of axes of a reference coordinate system of the accelerometric sensor x′, y′, z′ angularly arranged with respect to the first plurality of axes x, y, z of the reference coordinate system of the vehicle with a plurality of rotation angles αx,αy,αz, respectively, comprises the following steps:
In the embodiment described herein, each plurality of axes of the reference coordinate system of the vehicle x, y, z and the plurality of axes of a reference coordinate system of the accelerometric sensor x′, y′, z′ is composed by three axes respectively. The calibration method, although based on the same basic mathematical considerations, differs in the 2 cases of positioning calibration on motor vehicles and motorcycles.
Calibration of the Positioning on Motor Vehicles
A first step consists in acquiring the acceleration values generated by the force of gravity G acting on the vehicle along the axes of the reference coordinate system of the accelerometric sensor x′, y′, z′, when the vehicle is stopped in a substantially horizontal position, by means of the accelerometric sensor S.
A second step consists in acquiring, by means of said accelerometric sensor S, the acceleration values generated by a plurality of events suffered by the vehicle along the axes of the reference coordinate system of the accelerometric sensor x′, y′, z′, whose value exceeds a predetermined acceleration threshold value. This acquisition step takes place in the initial motion phases of the vehicle and the plurality of events consists of a series of abrupt acceleration and braking of the vehicle having a sufficiently high strength to be considered as significant events.
A further step consists in determining the travel direction of the vehicle on the basis of a prevailing direction in which the accelerations generated by the plurality of events suffered by the vehicle along the axes of the reference coordinate system of the accelerometric sensor x′, y′, z′ have been acquired. The plurality of events includes abrupt acceleration, abrupt braking, abrupt turns and vertical stresses suffered by the vehicle.
The method ends with the determination of a transformation matrix R, which puts in relation the accelerations measured along the axes of the coordinate system of the accelerometric sensor x′, y′, z′ with corresponding accelerations along the axes in the coordinate system of the vehicle x, y, z. The matrix comprises the values of the rotation angles αx,αy,αz, wherein the first rotation angle αx and the second rotation angle αy are derived on the basis of acceleration values of the force of gravity detected along the axes of the reference coordinate system of the accelerometric sensor x′, y′, z′ when the vehicle is stopped in a substantially horizontal position, and the third rotation angle αz is derived on the basis of the determined travel direction of the vehicle in the step described above.
αx indicates the rotation angle about the x axis; αy indicates the rotation angle about the y axis; αz indicates the rotation angle about the z axis.
Below is a detailed description of a preferred embodiment of the invention.
In order to detect impact or accident events, or acceleration variation events of a vehicle, it is necessary to consider a reference system integral with the vehicle, of left-hand type, using the vehicle point of view (inertial).
A left-handed system integral with the vehicle is illustrated in
A three-axis accelerometric sensor is included or at least connected to the onboard device. Said accelerometric sensor has a triad of axes, normally right-handed, which must be reversed one by one to move to the inertial point of view as in the reference system integral with the vehicle.
The reference system integral with the vehicle contemplates the following arrangement of three axes:
A series of equations must be illustrated to achieve a change of the reference system in space.
Considering the left-handed three-dimensional coordinate space in
Said rotation is shown in
Expressing the Cartesian coordinates in polar form:
The new coordinates (Px′, Py′) are given by:
In matrix form, these relationships become:
By extending the matrix found in the three-dimensional space:
Likewise, the transformation matrices for the other elementary rotations are determined: rotation about the y axis and a rotation about the x axis.
Any transformation of a three-dimensional Cartesian reference system that has no translational or deforming components can be traced back to a combination of 3 rotations about the axes, composed in a sequential manner. The rotation matrices for each rotation, are:
A method for verifying the correctness of the identified matrices using considerable angles is illustrated hereinafter.
Considering a null rotation, the rotation matrix about the x axis must be the identity and this is actually achieved:
If the rotation is instead by π/2, a simple transformation of the unit vectors must be obtained:
(1, 0, 0)T becomes (1, 0, 0)T, i.e. the unit vector x0 remains unchanged, (0, 1, 0)T becomes (0, 0, 1)T, i.e. the unit vector y0 becomes z0 in the new reference system, (0, 0, 1)T becomes (0, −1, 0)T, i.e. the unit vector z0 becomes −y0; these transformations correspond to what expected, the matrix Rx is therefore correct.
Considering a null rotation, the rotation matrix about axis y must be the identity and this is actually achieved:
If the rotation is instead by π/2, a simple transformation of the unit vectors must be obtained:
(1, 0, 0)T becomes (0, 0, −1)T, i.e. the unit vector x0 becomes −z0, (0, 1, 0)T becomes (0, 1, 0)T, i.e. y0 remains unchanged, (0, 0, 1)T becomes (1, 0, 0)T, i.e. the unit vector z0 becomes x0; these transformations correspond to what expected, the matrix Ry is therefore correct.
Considering a null rotation, the rotation matrix about axis z must be the identity and this is actually achieved:
If the rotation is instead by π/2, a simple transformation of the unit vectors must be obtained:
(1, 0, 0)T becomes (0, 1, 0)T, i.e. the unit vector x0 becomes y0, (0, 1, 0)T becomes (−1, 0, 0)T, i.e. y0 becomes −x0, (0, 0, 1)T becomes (0, 0, 1)T, i.e. the unit vector z0 remains unchanged.
As mentioned above, a generic rotation in space such as to make a passage between 3 Cartesian reference systems can be obtained as a composition of simple rotations.
Proceeding to the composition of Rx and Ry, we get:
Instead, the composition of the three single rotations that represents any rotation in space xyz is given by the following rotation matrix
Calculating R as Rx·Ry·Rz means applying in a sequence:
The composition of the single rotations is not a commutative operation and to switch from the ideal reference system xyz, integral with the vehicle, to the real reference system z′y′z′, integral with the accelerometric sensor, the following relationship applies:
It should be noted that both triads are left-handed.
In addition, to perform the opposite operation, that is, to convert the measured values in the values integral with the vehicle, the inverse must be calculated. The rotation in space is an isometry (i.e. it preserves angles and modules), therefore R is orthogonal, and then the inverse coincides with the transposed.
Starting from the rest position of the sensor, it is possible to determine the plane in which it moves, i.e. derive two of the three rotation angles.
At rest, we have: (x0′, y0′, z0′)T=R(0, 0, 1)T, whereby:
x
0=sin αy (10)
y
0′=−sin αx cos αy (11)
z
0′=cos αx cos αy (12)
The following simple reverse formulas find solutions in the range +/−90°:
The following formulas, instead, do not have this limitation: by simultaneously using equations (11, 12) dividing member by member, we obtain
whereby:
αx=−arctan 2(y0′,z0′) (15)
using equations (11) and (12), we calculate:
y
0′2+z0′2=sin2 αx cos2 αy+cos2 αx cos2 αy=cos2 αy
from the previous one and from (10), it follows that:
and so:
αy=atan 2(x0,√{square root over (y0′2+z0′2)}) (16)
In the preferred embodiment described herein, the steps of search of plane xy integral with the vehicle and of search of the travel direction are set out in detail.
The search step of plane xy integral with the vehicle occurs when the instrument panel of the vehicle is turned off, and in turn comprises the steps of:
The search step of the travel direction includes the steps of:
2Δv=|vi−vf|>max(R)*durata*35/2,
where 35=9.8 m/s2*3.6 and the duration is expressed in seconds;
In the particular case in which the vehicle is a motorcycle, all the foregoing considerations are applied up to formula (16), but then one proceeds in a different way to calculate a, as described hereinafter.
By measuring the gravity vector with the motorcycle inclined laterally by an angle γ: (x, y, z)T (0, j, k)T.
j and k may be derived taking into account that the triangle formed by the gravity vector before and after the tilting is isosceles in both reference systems.
In particular, considering the measurement system x′, y′, z′ by the accelerometric sensor, the base of the triangle measures:
B=√{square root over ((x1′−x0′)2+(y1′−y0′)2+(z1′−z0′)2)} (17)
On the other hand, it is known that
Therefore, j is sin γ and k equal to −cos γ.
From relationship
it follows that x1′=−j cos αy sin αz+k sin αy, from which we derive
To summarize:
and then:
It should be noted that the proposed embodiment for the present invention in the foregoing discussion has a purely illustrative and non-limiting nature of the present invention. A man skilled in the art can easily implement the present invention in different embodiments which however do not depart from the principles outlined herein and are therefore included in the present patent.
Finally, the invention also relates to a computer program, in particular a computer program on or in an information medium or memory, adapted to implement the method of the invention. This program can use any programming language, and be in the form of source code, object code, or intermediate code between source code and object code, for example in a partially compiled form, or in any other desired form in order to implement a method according to the invention.
The information medium may be any entity or device capable of storing the program. For example, the medium may comprise a storage medium, such as a ROM, for example a CD ROM or a microelectronic circuit ROM, or a magnetic recording medium, such as a floppy disk or a hard disk.
On the other hand, the information medium may be a medium that can be transmitted, such as an electrical or optical signal, which can be routed through an electrical or optical cable, by radio signals or by other means. The program according to the invention may in particular be downloaded over an Internet type network.
Of course, the principle of the invention being understood, the manufacturing details and the embodiments may widely vary compared to what described and illustrated by way of a non-limiting example only, without departing from the scope of the invention as defined in the appended claims.
Number | Date | Country | Kind |
---|---|---|---|
102016000068808 | Jul 2016 | IT | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/IB2017/053952 | 6/30/2017 | WO | 00 |