The present application claims priority to French Patent Application Serial No. 08/05020, filed on Sep. 12, 2008, the contents of which are hereby incorporated by reference in its entirety.
The present invention relates to a method and a device for generating motion controls for a mobile platform of a vehicle simulator.
Most of the time, pilots of vehicles such as airplanes, trucks and helicopters, are trained by virtue of simulators reproducing behaviors of the vehicle. The objective of a simulator is notably to reproduce a virtual environment representing a real setting in which the vehicle is deploying and also the control station of the vehicle. The simulator therefore generally comprises a driver station at the center of an audiovisual device making it possible to reproduce an outside environment. This type of simulator, a so-called motionless simulator, does not reproduce the motions of the vehicle. Motionless simulators give rise, for the pilot using them, to sensations of slowness. These sensations of slowness are related to an inertia of the simulated vehicle which seems to be less reactive than a real vehicle. The sensation of slowness is particularly prejudicial when training pilots to react rapidly if faced with a dangerous situation. For example, tracking a trajectory with a motionless simulator requires corrections of low frequency, with a large amplitude, this hardly being realistic. Moreover, long duration training may induce nauseous states for drivers.
In order to alleviate the aforesaid drawbacks, most vehicle simulators use mobile simulation platforms to reproduce attitudes and accelerations of the simulated vehicle. The mobile platforms allow more realistic reproduction of sensations felt by a driver of a vehicle in a real situation. The performance of the drivers, thus trained, is thereby enhanced relative to the use of a motionless simulator.
Mobile platforms can have up to six degrees of freedom, including three degrees in rotation and three degrees in translation. These degrees of freedom make it possible to reproduce motions of pitch, roll, yaw, surge, sway and heave, depending on the simulated vehicle. A standard kinematics of a mobile platform is that of the Stewart platform, implementing six hydraulic or electric actuators in order to move a vehicle control cabin. This type of platform with motion can only imperfectly reproduce the sensations felt by the driver. Indeed, physical constraints, related to a maximum elongation of the actuators, limits the field of the drivers possible perceptions. For example, a typical value of maximum elongation for actuators used in aircraft simulators is one and a half meters. This maximum elongation does not make it possible to simulate accelerations of long duration for example. However, the human brain being particularly sensitive to variation in acceleration, that is to say to the third derivative of position, more satisfactory physiological effects can be obtained with limited actuator lengths, by using for example artifices. Certain artifices make it possible notably to reproduce long-duration effects. For example, pitching the nose of the cabin up, carried out with an angular velocity below a threshold of human perception, gives an impression of linear acceleration prolonged by the effect of the weight of the body on the back of the pilot's seat.
Mobile platforms are controlled by control algorithms which take account of the physical limitations of the platform. Simulation platform control algorithms make it possible to generate controls to be applied by the platform so as to carry out a motion of the control cabin in accordance with instructions originating from simulation software. Control algorithms have evolved little over the last thirty years, notably, the algorithm used to produce a control for the platform generally comprises the following steps:
The result of these operations is an acceleration provided to the mobile platform in the form of a control.
The control behaves as a filter whose coefficients are determined in an empirical manner. In addition to reproducing to within a scale factor the accelerations of the real vehicle at the level of the pilot's head, the objective of the control . is also to bring the platform back to a neutral position. The calculation of the load factors and the filtering serve to optimize the sensation produced by the motions of the platform. The gain makes it possible to reduce the amplitude of the motions of the platform so as to avoid driving the actuators into mechanical bumpers. Driving the actuators into the bumpers results notably in premature wear of the actuators, which are particularly expensive to replace. The existing algorithms make it possible to bound the values of the controls to be taken into account by the platform so as to reduce the amplitude of the motion of the platform. The controls of the motion of the platform lead to unsatisfactory reproduction of sensations. Moreover, to guarantee that the platform will not bump, safety margins are taken into account in calculating the control. The safety margins restrict the domain of use as a function of the mechanical capabilities of the system notably in terms of usable length of actuators and therefore in terms of feeling of the acceleration by the pilot.
A possible improvement can consist in defining bounds of use of the platform as a function of the domain of use of the real vehicle such as the flight domain for an aircraft. Globally, the performance induced by the use of this improvement is not satisfactory in regard to reproduction of sensations as well as in terms of compliance with the mechanical constraints of the platform.
An aim of the invention is notably to alleviate the aforesaid drawbacks. For this purpose, the subject of the invention is a method for calculating motion controls for a mobile platform of a vehicle simulator. The method uses notably, as input, accelerations calculated by software for simulating the behavior of the vehicle. The method comprises notably the following steps:
The positions of the platform can be defined by the positions of the geometric center of the platform and by the lengths of the actuators moving the platform.
The length of the actuators can be scaled by a first scaling function scaling(l), for example such that:
where
The scaling of the positions can take account of limitations on rate of elongation of the actuators of the platform.
The limitations on rate of elongation of the actuators can be taken into account using a second scaling function scalingν(ν), for example such that:
where
The accelerations provided by the simulation software can be compared with a threshold value below which the accelerations are no longer perceived by a human being. Only the accelerations above the threshold value give for example a control to be applied by the mobile platform.
The third calculation of the acceleration controls can apply a Newton algorithm in an iterative manner.
The subject of the present invention is also a device for calculating motion controls for a mobile platform of a vehicle simulator. The device according to the invention comprises notably:
The second block can comprise:
The positions of the platform can be defined by the positions of the geometric center of the platform and by the lengths of the actuators of the platform.
The length of the actuators can be scaled by a first scaling function scaling(l), for example such that:
where
The scaling of the positions can take account of limitations on rate of elongation of the actuators of the platform.
The limitations on rate of elongation of the actuators can be taken into account using a second scaling function scalingν(ν) for example such that:
where
The main advantages of the invention are notably that it is simple and inexpensive to implement and can be adapted to multiple mobile simulation platforms.
Other characteristics and advantages of the invention will become apparent with the aid of the description which follows, given by way of nonlimiting illustration and with regard to the appended drawings which represent:
a: a schematic of various possible steps of calculating a direct kinematics of the actuators of the mobile simulation platform;
b: a schematic representation of a mobile deck of a Stewart platform;
c: a schematic representation of a fixed deck of a Stewart platform;
a: a first function for scaling the acceleration control;
b: a second function for scaling the acceleration control;
Training to drive a vehicle uses notably simulation software 1 making it possible to reproduce virtually the movements of the vehicle as well as the evolution of the environment of the vehicle in the course of the movements. The simulation software 1 makes it possible for example to take account of the controls of a pilot of the vehicle so as to cause the simulated vehicle to deploy accordingly, while reproducing the real behavior of the vehicle in a similar case. The simulation software 1 calculates a software acceleration 2 characteristic of the real motion of the vehicle. Next a first module 3 calculates an acceleration control to be applied to the platform while taking account of the mechanical constraints 4 of the platform. The acceleration control thus calculated takes the form of a calculated acceleration 5, provided to the simulation platform 6, which applies it so as to execute the acceleration control 7.
The acceleration control 7 can be calculated by dividing the input acceleration by a factor so as to guarantee compliance with the physical constraints of the simulation platform.
This type of acceleration control calculation according to the prior art does not make it possible to ensure realistic representation of the accelerations felt by a pilot of a real vehicle. Indeed, the accelerations that can be implemented are limited and therefore do not make it possible to reproduce an acceleration of long duration, for example. Moreover, the platform system is not used in an optimal manner. Indeed, significant zones of incursion of the actuators are never invoked so as to guard against the wearing of the actuators by avoiding bringing them to an end-of-stroke bumper. Moreover, the acceleration division factor takes no account of very strong and sudden accelerations which may thus damage the platform system.
Simulation software 1 provides one or more accelerations Uak of the simulated vehicle, also dubbed software accelerations. In the course of a first step 21 of thresholding of the software acceleration Uak, the modulus of the acceleration Uak of the simulated vehicle is compared with the modulus of a threshold acceleration Uthresh. The threshold acceleration Uthresh corresponds to an acceleration value short of which the acceleration of the simulated vehicle is not perceived by a human being. When the modulus of the acceleration Uak is strictly greater than the modulus of the threshold acceleration Uthresh, the acceleration used as input to the calculation of an acceleration control is the difference between the acceleration of the simulated vehicle Uak and the threshold acceleration Uthresh. When the modulus of the acceleration Uak is less than or equal to the modulus of the threshold acceleration Uthresh, then the acceleration used as input to the calculation of an acceleration control is zero. In this case, no control is calculated.
A second step 22 of the method 20 according to the invention is a step of calculating an acceleration control 22, termed the optimal control, as a function of the input acceleration, defined in the course of the first step 21. The calculation of the optimal control 22 uses a mathematical model, in the form of a transfer function. The mathematical model represents a human perception of the attitudes and accelerations of the real vehicle, by way of various organs of the inner ear. Such a mathematical model of sensations can use the model developed by R. Telban and F. Cardullo to apply a procedure termed optimal control notably described in the following publication: “Motion Cueing Algorithms: A human centered approach, State University of New York at Binghampton, NASA Langley Research Center Hampton, Va.”. Other mathematical models of perception can also be used without it being necessary to modify the method 20 according to the invention. The procedure for calculating the optimal control uses a filter applied to the acceleration defined in the course of the first step 21. The filter makes it possible to obtain an acceleration to be imposed on the simulation platform so as to reproduce sensations close to the accelerations felt in a real case.
A third step 23 of the method 20 according to the invention is a direct kinematics calculation step 23. The direct kinematics makes it possible to pass from a calculated control acceleration, the optimal control calculated in the course of the second step 22, to the positions of actuators which propel the mobile platform. The kinematics calculation makes it possible to determine the following kinematic data:
A fourth step 24 of the method 20 according to the invention is a step 24 of scaling the lengths calculated in the course of the direct kinematics step 23. The scaling step 24 makes it possible to ensure compliance with the physical constraints of the mobile platform. The lengths of the actuators must, indeed, remain between a minimum length and a maximum length, achievable by the mobile platform. The scaling of the actuator lengths can be carried out by using for example a scaling function: scaling(l) such that:
where
Compliance with the physical constraints of the mobile platform also requires that the rates of displacement of the platform be constrained. The rates of displacement of the platform correspond to the rates of application of the lengths of the actuators calculated in the course of the direct kinematics step 23. The rates of displacement of the platform can be constrained by using a function for scaling the rates taking the rate of displacement of the mobile platform as parameter:
where
The scaled lengths and rates of elongation are then compatible with the mechanical limits of the mobile platform. The scaling step 24 therefore advantageously makes it possible to introduce, into the method according to the invention for calculating the optimal control, a simulation of the kinematics of the platform so as to avoid situations in which the actuators would reach an end of stroke. This advantageously makes it possible to preserve the lifetime of the actuators and therefore of the mobile platform system. Avoiding situations where the actuators are at the end of their stroke makes it possible, advantageously, to avoid unrealistic spurious sensations caused by impacts of the actuators on elastomers damping the ends of stroke of the actuators.
A fifth step 25 is an inverse kinematics calculation step 25 which makes it possible, by using a Newton algorithm in an iterative manner, to pass back from the actuator lengths, calculated in the course of the scaling step 24, to the position of the centroid of the mobile platform, and then to the control accelerations Usk necessary for the displacement of the mobile platform. The control accelerations Usk then allow displacement of the platform with actuator lengths corrected as a function of the performance of the platform.
A first functional block 30 can be a block which ensures the calculation of the optimal control as a function of the accelerations of a vehicle 35 such as the software accelerations Usk. The calculation of the optimal control 30 comprises notably the first and second steps 21, 22 of the method according to the invention.
A second functional block 31 comprises various processing modules 32, 33, 34, ensuring that the optimal control calculated by the first functional block 30 complies with the physical constraints of the platform. The second functional block 31 comprises notably:
The direct kinematics module 32 and inverse kinematics module 34 depend solely on the geometry of the mobile platform. The direct kinematics module 32 and inverse kinematics module 34 are therefore adaptable to any type of simulator with motion without it being necessary to modify the functional architecture of the program implementing the method 20 according to the invention.
The filter for calculating the optimal control can notably be determined in the following manner:
Generally a human being is sensitive, when subjected to an acceleration, to a force termed the specific force {right arrow over (f)}PS. The specific force {right arrow over (f)}PS can be defined for the pilot of the simulated vehicle by taking the pilot's head as point of application of the specific force {right arrow over (f)}PS. The specific force can be defined by the following formula:
{right arrow over (f)}PS={right arrow over (a)}PS−{right arrow over (g)} (1003)
where {right arrow over (a)}PS denotes the acceleration at the level of the pilot's head, and {right arrow over (g)} represents the gravitational force.
The acceleration {right arrow over (a)}PS can be expressed in the following manner:
{right arrow over (a)}PS={right arrow over (a)}S++2.{right arrow over (ω)}S{right arrow over ({dot over (R)}+{right arrow over ({dot over (ω)}S{right arrow over (R)}+{right arrow over (ω)}S({right arrow over (ω)}S{right arrow over (R)}) (1004)
by taking:
we obtain:
And therefore:
{right arrow over (g)} can thereafter be expressed in the reference frame of the simulator by using a matrix Tmob-fix for passing between the terrestrial relative reference frame and the mobile reference frame of the simulator:
We then obtain:
The specific force can therefore be expressed thus:
Among the systems available to a human being for ensuring his balance and his mobility is the vestibular system. The vestibular system is one of the main sensory systems for perceiving a movement and an orientation with respect to the vertical. Sensory receptors of the vestibular system are situated in the inner ear. The vestibular system makes it possible notably to evaluate a rate of displacement on the basis of an acceleration measured at the level of the inner ear of a human being. Indeed, the inner ear behaves like an instrument for measuring:
A model of semi-circular canals can notably be described by the following relation:
and a model of otoliths can be described by the relation:
with:
On the basis of the models of the vestibular system (1010), (1011), it is possible to construct a global model of feeling of the acceleration by a pilot of the simulated vehicle moved by the mobile platform.
Several models of feeling can be constructed, the model described below is given by way of example.
Initially, it is possible to consider a global model of feeling in two dimensions, one dimension being along a first horizontal axis x and another dimension being along a second horizontal axis y for example. The acceleration Uak calculated by the simulation software can be expressed thus:
In two dimensions, the otolith model (1011) becomes for example:
with fx=ax+RZ·{umlaut over (θ)}g sin(θ)=f (1014), where G0, A0, B0, B1 are constants.
By considering that: sin(θ)=θ expression (1013) becomes:
Expression (1014) can then be put into the following form:
In order to obtain a state representation of {circumflex over (f)}1, we put:
and we seek A, B, C, D, E, F such that:
Expression (1018) becomes: {circumflex over (f)}1=x1+x2+x3+x4 (1019)
and expression (1017) becomes:
Solving the system (118) gives:
Then, expression (1019) gives:
To obtain a state representation of {circumflex over (f)}2, we put:
and we seek A, B, C, D, E, F such that:
Expression (129) then gives: {circumflex over (f)}2=x2 (1030) and expression (1028) gives:
Solving the system of equations (1031), we obtain:
Arbitrarily fixing two parameters, we obtain:
Finally, the state representation of {circumflex over (f)} is deduced from the expression
{circumflex over (f)}={circumflex over (f)}1+{circumflex over (f)}2.
The matrices relating to {circumflex over (f)} are:
The set of matrices (1035) is one of the possible state representations for the semi-circular canal model. Other representations can be used notably by modifying the values of the parameters fixed in an arbitrary manner.
In two dimensions, the semi-circular canal model (1010) becomes for example:
Knowing that
and that {dot over (ω)}y=p·ωy (1037) then expression (1036) becomes:
Next we seek to express expression (1038) in the following manner:
Expanding expression (1038), we obtain the following expression:
Next, we put:
and we seek A, B, C, D, E, F such that:
Equation (1043) gives: {circumflex over (ω)}=x2 (1044) and equation (1042) gives:
Solving the system (1044), we obtain:
and then:
Next we arbitrarily fix two of the variables A, B, C, D, E, F in order to solve the system (1046), thus obtaining, for example:
and then:
The matrix set (1048) is one of the possible state representations for the semi-circular canal model. Other representations can be obtained by modifying the values of the parameters ascribed in an arbitrary manner.
Grouping together the state representations of the semi-circular canal and otolith models, we obtain for example:
A representation of the global system incorporating the feeling of linear and angular accelerations by the pilot can thus take the form:
Once the representation of the global system has been determined, the optimal control is determined by choosing and minimizing a constraining criterion:
The representation of the global feeling system (1050) then becomes:
and then:
An additional group of terms, namely the speed and the position of the centroid of the mobile platform, is then introduced: xd=1({dot over (x)}s xs) (1054)
The following state representation is thus obtained:
Putting
and using the system (1055), we obtain:
The systems of equations (1056) and (1057) therefore define a state representation of the system to be solved in order to minimize the errors (1051).
It is then possible to define a minimization criterion that can, for example, be expressed in the following manner:
where Qd and Rd are positive semi-definite matrices and R a positive definite matrix.
The behavior of the real vehicle being unknown and given that in order to apply the procedure for the optimal acceleration control it is necessary to know a trajectory of the system in the state space, it is assumed that the displacement command for the real vehicle is constant between two instants of sampling of the trajectory of the system.
The minimization criterion (1058) can then be written in the following form:
Expression (1059) for the minimization criterion comprises:
the expression for the minimization criterion (1059) becomes:
with the matrix Q non-negative definite and the matrix R positive definite.
If we choose t1 fairly large, thus corresponding to an infinite horizon, then expression (1061) for the minimization criterion becomes:
To solve the system, we use the procedure for the optimal control which amounts to maximizing a Hamiltonian of the system defined by:
Hamilton's canonical equations are as follows:
The second Hamilton canonical equation
gives:
{dot over (λ)}=tC·Q·C·x−tA·λ (1066)
and maximizing the Hamiltonian gives: uS=R−1·tB·λ (1067).
Expression (1067) represents the optimal control.
It is then possible to define a system relating x and λ in the following manner:
This is a case of a pursuit problem since e=yA−yS is arbitrary. We can therefore put: λ(t)=K(t)·x(t)+k(t) (1069). By considering that e(t) is constant since uA is constant, we can then consider that when T is very large, K and k are constants, hence:
λ=K·x+k (1070)
The system (1068) then becomes:
Replacing {dot over (x)} by its value, we then obtain:
(K·A+tA·K+K·B·R−1·tB·K−tC·Q·C)·x=−(K·B·R−1·tB·k+K·D·uA+tA·k), (1072)
for all x(t), hence:
Therefore K is a solution of the first equation of the system (1073): K·A+tA·+K+K·B·R−1 ·iB·K−tC·Q·C=0 the so-called Ricatti equation.
k can therefore be written in the following form:
k=−(K·B·R−1·tB+tA)−1·K·D·uA (1074)
Let us put: M=−(K·B·R−1·tB+tA)−1·K·D (1075)
We therefore obtain k=M·ua (1075′), the optimal control is then given by: uS=R−1 ·tB·(K·x+M·uA) (1076)
i.e. according to the expression for M: uS=R−1·tB·(K·x+M·uA) (1077)
Substituting the expression for uS into equation (1071), we obtain a differential equation making it possible to determine an evolution of the state vector x as a function of the input control ua:
Next we deduce from this an expression for a filter W(s) to be applied to the input control ua such that: uS=Ws×ua
W(s)=R−1·tB·K·[s·I−(A+B·R−1·tB·K)]−1·(B·R−1·tB·M +D)+R−1·tB·M (1079)
The control us represents an optimal acceleration to be provided to the mobile platform so as to ensure a realistic displacement of the platform minimizing the error in sensation felt by the pilot of the simulated vehicle with respect to a pilot of a real vehicle.
It is also possible to consider a model of feeling in three dimensions, for a mobile platform system having six degrees of freedom. In this case, the acceleration used as input can be represented in the following manner:
The three-dimensional semi-circular canal model is given by the following expression:
with:
The three-dimensional otolith model is given by the following expression:
Within the framework of an approximation for small angles and assuming that the pilot is vertically in line with the centroid of the mobile platform, that is to say RX=RY=0, the specific force may then be written:
We can define us as a given comprising accelerations at the level of the centroid of the mobile platform:
us=[{dot over (ω)}x {dot over (ω)}y {dot over (ω)}z ax ay az]′=[u(1)u(2)u(3)u(4)u(5)u(6)]′ (1083)
We can thus express fP as a function of us:
In the expression obtained (1084) the specific forces fP are decoupled along the three axes. Indeed, if we write:
fP=[fpx fpy fpz],u1=[{umlaut over (θ)}{umlaut over (x)}]′,u2=[{umlaut over (φ)}ÿ]′,u3=[{umlaut over (ψ)}{umlaut over (z)}]′(1085)
Then, we have: fpx=f(u1), fpy=f(u2), fpz=f(u3). It is therefore possible to apply the solution procedure for the optimal control used in the two-dimensional case for the specific forces along the x and y axes. For the specific force along the z axis, it is possible for example to use a simple reproduction of the accelerations.
We consider a state system such as constructed previously:
The system (1086) must then be discretized to obtain a discrete-time acceleration control filter. Obtaining a discrete-time filter makes it possible to forecast the instant at which the physical limits of the platform will be attained. The discretized system (1086) then becomes:
With:
If k is a time-step number, the criterion to be minimized, becomes in the three-dimensional case:
The Hamiltonian associated with the minimization criterion (1088) is given by the expression:
The canonical equations corresponding to the expression for the Hamiltonian (1089) are as follows:
Maximization of the Hamiltonian therefore gives:
−R·usk+B1T·λk+1=0usk=R−1·B1T·λk+1 (1090)
The system relating x and λ is then:
If N is assumed to be large, in a stationary case with infinite horizon, we therefore have:
λk=K·xk+k∀k≧1 (1093)
The system (1092) then becomes:
By substitution, we obtain the following equation:
[(tC·Q·C+K)−tA1·K·(I−B1·R−1·tB1·K)−1·A1]·xk−[tA1·K·(I−B1·R−1·tB1·K)−1·(D1·uak+B1·R−1·tB1·k)−(I−tA1)·k]=0 (1095)
Equation (1095) being true ∀xk, the system (1096) described in the Annex is therefore obtained.
Using the following lemma: (A−BCD)−1=A−1+A−1B·(C−1−DA−1B)−1DA−1 on the first equation of the system (1096), said equation then becomes:
(tC·Q·C+K)−tA1·K·(I−B1·R−1·tB1·K)−1·A1=0 (1097)
And then:
tC·Q·C+K−tA1·K·A1−tA1·K·B1)(R−tB1·K·B1)−1·tB1·K·A1=0 (1098)
Expression (1098) being a discrete-time Ricatti equation.
The second equation of the system (1096) becomes the system (1099):
Expression (1099) can then be expressed in the following form:
We therefore obtain the following relation:
with K satisfying:
tC·Q·C+K−tA1·K ·A1−tA1·K·B1(R−tB1·K·B1)−1·tB1·K·A1=0
k=ND·uak
ND=I−tA1−tA1·K·(I−B1·R−1·tB1·K)−1·B1·R−1·tB1)−1·(tA1·K·(I−B1·R−1·tB1·K)−1·D1 (1103)
The system is then solved by substitution and the following form for the optimal control is obtained:
xk+1=[A1+B1·(I−R−1·tB1·K·B1)−1·R−1·tB1·K·A1]·xk+[B1·(I−R−1·tB1·K·B1)−1)·(R−1·tB1·(K·D1+N))+D1]·uak (1104)
The filter to be applied to the input acceleration can therefore have for example the following form:
[B1·(I−R−1·tB1·K·B1)−1·(R−1·tB1·(K·D1+N))+D1] (1105)
a represents several possible steps 51, 52, 53 for the direct kinematics calculation 23 represented in
A first step of the direct kinematics calculation 23 is a calculation of the length of the actuators 51 after application of the optimal control calculated in the course of the second step 22 of the control generating method according to the invention. To calculate the actuator extension length required for the application of the optimal control, it is firstly necessary to calculate the coordinates of the various points of attachment of the actuators of the mobile platform. Among the actuator attachment points, first attachment points are situated on a mobile part of the platform.
The platform considered is for example a Stewart platform. The calculations described subsequently are adapted for the example to the case of a Stewart platform.
A mobile part or mobile deck 54 of the Stewart platform can be represented, as in
We put:
Then
and
A fixed part or fixed deck 56 of the Stewart platform can be represented, as in
We put:
Then
and
Expressing the vectors
recalling that:
li representing the extension length of each actuator.
A second step of the direct kinematics calculation 23 is a calculation of the velocity of the actuators 52, calculated as a function of the actuator lengths obtained in the course of the first step 51 of the direct kinematics calculation 23.
We have:
li2=
by differentiation we obtain:
and
A third step of the direct kinematics calculation 23 is a calculation of the acceleration of the actuators 53, calculated as a function of the velocity of the actuators obtained in the course of the second step 52 of the direct kinematics calculation 23.
We have:
by differentiation we obtain:
with γ3 defined in Annex 1 by expression (1125′)
The acceleration {umlaut over (l)}i can then be put into the following form:
a and 6b represent functions for scaling the actuator elongations calculated as a function of the actuator length required in order to apply the optimal control.
We seek a function of the following form:
To this end, we firstly define an elongation of the actuators E such that:
with:
The system (1000) then becomes:
To retrieve the function scaling(l) from the function scaling(E), it is necessary to add a difference corresponding to the mid-stroke length of the actuators.
The sought-after function scaling(E) corresponds for example to a first sought-after function 60, represented in
For example the following function can be used:
We then verify that the proposed function fulfills the constraints imposed by the geometry of the mobile platform. To this end, we consider an interval
From this we deduce:
The function scaling(E) defined by relation (1132) therefore does indeed comply with the imposed constraints described by relation (1131).
The function scaling(E) also makes it possible to bound the velocity by changing the parameters:
The lengths can be bounded by adding a difference corresponding to a mid-stroke length of the actuators, to change the lengths into elongations:
A first step 71 of the inverse kinematics calculation 25 is a step of calculating the coordinates of the attachment points of the platform in a reference frame relative to the ground. The coordinates of the points of attachment of the mobile platform in the ground reference frame have, for example, the subscript “ms”. The coordinates of the points of attachment of the base of the platform in the ground reference frame have, for example, the subscript “bs”. Let us take three points of attachment on the ground to make a base of the platform. For example, it is possible to choose a first point O1, a second point O3 and a third point O5 with the first point O1 as origin point. Coordinates xms
The system (1137) is satisfied by all the points of the platform whatever the reference frame in which the coordinates (xms
The systems (1138) are linear systems of two equations in two unknowns. By using Cramer's procedure to solve the systems (1138) we then obtain the values of (λ2i μ2i)∀i∈□1;3□.
A second step 72 of the inverse kinematics calculation 25 is the application of Newton's algorithm in an iterative manner so as to calculate the coordinates of all the points of attachment of the actuators on the mobile platform in the reference frame tied to the ground.
Initially, an expression such as described below can express the fact that the distances D1, D2, D3 between the points of the mobile platform B1, B3, B5:
The coordinates in the mobile reference frame, such as are defined in (1107), can be used to calculate D1,D2,D3.
Moreover:
∀i∈[1;6]:li2=(xmsi−xmbi)2+(ymsi−ymbi)2+(zmsi−zmbi)2 (1140)
with representing the lengths of actuators of the current iteration.
By combining relations (1139) and (1140), the following system is obtained:
Next, using relations (1138), the following relation is obtained:
F=F(X) (1142)
with
X=(xms
Next, based on the following relation:
with F′(X)=jacobien(F)
From relation (1143), we deduce the following relation:
Δx=F′−1(X)·(F(X+Δx)−F(X)) (1144)
We seek Δx/F(X+Δx)=0, relation (1144) then becomes:
Δx=F′−1(X)·(−F(X)) (1145)
Using relation (1138), F′(X) can be expressed in the manner defined by expression (1146) described in Annex 2.
The variable X can be initialized with values arising from the previous iteration. For example, tools for the automated solution of equation systems can be used to solve the previous system and obtain a value of Δx. The iterations performed by applying Newton's algorithm can be stopped when we have max (|Δx|)≦10−7, otherwise, we can put X=X+Δx and restart a new iteration of Newton's algorithm. A maximum number of iterations can be fixed.
Once this step has been performed, by using relations (1138), we obtain the coordinates of all the points of attachment of the actuators on the mobile platform in the reference frame tied to the ground.
A third step 73 of the inverse kinematics calculation 25 is a step of calculating the coordinates of the centroid of the mobile platform as well as the angles of displacement of the mobile platform.
Initially, the coordinates of the center of gravity of the platform are calculated:
It is possible to calculate the coordinates of the vectors
It is then possible to create the following basis:
The basis (1148) corresponds, at an instant l=0, to the canonical basis of the reference frame tied to the ground. Using the following relation, which links the fixed reference frame and the mobile reference frame:
with:
and Tmob-fix defined by expression (1007), from this we deduce:
We have indeed therefore retrieved the coordinates as well as the angles (φ θ ψ x y z) associated with the centroid of the mobile platform.
By twice differentiating the coordinates (φ θ ψ x y z) we obtain the acceleration control to be applied by the mobile platform.
The acceleration control calculation method according to the invention advantageously makes it possible to realistically reproduce accelerations felt by the pilot or the driver of a vehicle in a simulator. It also makes it possible to utilize to the maximum the entirety of the dynamic resources of the motion system while avoiding reaching actuator end-of-stroke bumpers. This advantageously makes it possible to increase the lifetime of the actuators and more generally of the mobile simulation o platforms. Advantageously, the method according to the invention makes it possible to realistically reproduce extreme situations in which the actuators of the platform have an asymmetric configuration, for example in the case of missed takeoffs or following hard braking.
The direct 23 and inverse 25 kinematics calculations depend is solely on the geometry of the simulation platform used. These calculations can therefore advantageously be adapted to any simulator with motion without changing the functional architecture 30, 31 for calculating the acceleration control. Moreover, the calculations performed by the method according to the invention are exact calculations, that is to say not requiring any approximation. This advantageously makes it possible not to introduce edge effects which could impede the stability of the results produced by the method according to the invention.
The method according to the invention therefore advantageously makes it possible to improve the training of vehicle pilots by confronting them with extreme situations in a realistic manner. The vehicle pilots thus trained are therefore more able to react correctly when faced with dangerous situations, thus improving their safety and avoiding damage to the vehicles.
The method for calculating the optimal control according to the invention furthermore allows a simple calculation of the accelerations, platform related constraints being taken into account after the calculation of the optimal control generated by the vehicle's motion simulator.
Number | Date | Country | Kind |
---|---|---|---|
08 05020 | Sep 2008 | FR | national |
Number | Name | Date | Kind |
---|---|---|---|
6027342 | Brown | Feb 2000 | A |
20020055086 | Hodgetts et al. | May 2002 | A1 |
20040230394 | Saari et al. | Nov 2004 | A1 |
20070233280 | Bacon et al. | Oct 2007 | A1 |
20080124683 | Medford | May 2008 | A1 |
20100145511 | Popa et al. | Jun 2010 | A1 |
20100273132 | Dutt et al. | Oct 2010 | A1 |
Entry |
---|
Wang, et al., 2004. “Predictive washout filter design for vr-based motion simulator.” 2004 IEEE International Conference on Systems, Man and Cybernetics 7: 6291-6295. |
Schwarz, C., W., 2007. “Two Mitigation Strategies for Motion System Limits in Driving and Flight Simulators.” IEEE Transactions on Systems, Man, and Cybernetics. Part A: Systems and Humans 37(4): 562-568. |
Number | Date | Country | |
---|---|---|---|
20100070248 A1 | Mar 2010 | US |