The present invention relates in general to aircraft control devices. More particularly, it relates to control devices comprising a stick with an effort feedback or a force feedback that makes it possible to restore or simulate an artificial effort which is felt by the user via the stick on which he acts.
An aircraft control device generally comprises a control stick rotatably mounted along an axis called roll axis and an axis called pitch axis, these two axes being orthogonal to each other. Devices of the “joystick” type are most often encountered.
Depending on the position of the stick along the two axes, the aircraft control device transmits movement commands to members for piloting the aircraft.
An effort feedback control device or an effort feedback haptic device is a device that comprises an element used for the control. This element is activated by the user. This effort feedback control device is configured to generate an artificial effort felt by the user, which opposes the motion applied by the user's hand.
In the field of aeronautics, control devices for an aircraft are known which allow an effort feedback to the user. These devices generally take the form of a stick, referred to as active stick.
These control devices make it possible, for example, to control an airplane or a helicopter, more particularly they make it possible to control control surfaces or one or several motors of the aircraft. This control is done by the action of a movement of the stick, generally a rotation, about an axis fixed on a support. This action is performed by the user or the pilot.
The effort feedback via the stick is generally achieved by a motor connected to the stick, to apply an artificial effort. This artificial effort is obtained by a torque generated by the motor on the stick. This artificial effort makes it possible to restore a stiffness and/or a damping. The intensity of the artificial effort to be applied is determined according to an angular position of the stick or of the motor used to control the stick, measured by a position sensor.
For a stiffness-type effort, the intensity depends of the deviation between the angular position of the stick and a reference angular position. For an effort of the damping type, the amplitude depends of a speed of rotation of the stick (obtained by derivation of the angular position).
The control devices of the state of the art restoring a stiffness and a damping have some limitations:
Control devices which use an effort sensor are also known. Based on the information provided by this effort sensor, these control devices will restore an effort feedback by an effort servo-control on the stick. These devices have the disadvantage of requiring an effort sensor in addition to the position sensor, which complicates the control device, increases the risk of failure and makes the control device more expensive.
The present invention thus relates to an aircraft control device which does not have these different limitations.
To this end, a method for controlling a motor of an aircraft control device is provided according to the invention. The device includes an aircraft control stick. The stick is connected by a mechanical connection to a shaft of the motor. The method comprises a step of determining a first intensity Kp representing a stiffness depending of a physical stiffness Kss of said mechanical connection and of a stiffness setpoint Kpspec to be restored on the stick, a second intensity Kv representing a damping depending of a physical damping fss between the stick and the motor and of a damping setpoint Kvspec to be restored on the stick, and a third intensity Ka representing an inertia depending of a physical inertia Jss of the stick and of an inertia setpoint Kaspec to be restored on the stick. The method also comprises a step of calculating a torque to be controlled on the shaft of the motor by linear combination of an angular position of the shaft relative to a stator of the motor, of a speed of rotation of the shaft relative to the stator and of an acceleration of the shaft relative to the stator with respectively said first, second and third intensities Kp, Kv and Ka.
Thus, this control device allows the user to feel an inertia type effort in addition to a stiffness type effort and to a damping type effort, based on information derived from the angular position provided by a simple position sensor.
In one embodiment, the determination step uses the formula:
where:
R is a mechanical connection reduction ratio,
Kss is the physical stiffness Kss of the mechanical connection,
rp is a radius of the stick, and
Kpspec is the stiffness setpoint to be restored on the stick.
In one embodiment, the determination step uses the formula:
where:
R is a mechanical connection reduction ratio,
rp is a radius of the stick,
fss represents the physical damping between the stick and the motor, and
Kvspec is the damping setpoint to be restored on the neck.
In one embodiment, the determination step uses the formula:
where:
R is a mechanical connection reduction ratio,
rp is a radius of the stick,
Jss represents the physical inertia of the stick,
Jmot represents the physical inertia of the shaft of the motor, and
Kaspec is the inertia setpoint to be restored on the stick.
In one embodiment, the method comprises a step of receiving the angular position of the motor shaft, the angular position being provided by a position sensor, the speed being obtained by derivation of the angular position and the acceleration being obtained by second derivation of the angular position.
In one embodiment, the method comprises a step of receiving the angular position of the shaft of the motor, the angular position being received from a position sensor (CPO). The speed is determined by derivation of the angular position and the acceleration is determined by second derivation of the angular position.
In one embodiment, the stiffness setpoint, the damping setpoint and the inertia setpoint are determined from respectively the angular position, the speed and the acceleration.
In one embodiment, the method further comprises a step of controlling the motor, the control step comprising a determination of an electric current setpoint from the torque, and a servo-control of this current setpoint using a current corrector and a measurement of an electric current at the terminals of the motor.
An aircraft control device is also provided according to the invention, the device comprising a stick, a motor comprising a shaft and a stator, the shaft being rotatably mounted in the stator, and a processing unit. The shaft is connected to the stick by a mechanical connection, the stick is configured to control the aircraft, the processing unit is configured for the implementation of the control method.
In one embodiment, the control device further comprises a sensor configured to determine an angular position of the shaft relative to the stator.
An aircraft comprising the control device is also provided according to the invention.
Other characteristics, aims and advantages of the invention will emerge from the following description, which is purely illustrative and not limiting and which must be read in relation to the appended drawings in which:
The stick MA is rotatably mounted along an axis called roll axis and an axis called pitch axis, these two axes being orthogonal to each other.
For simplification, only one of the axes is represented in
For each of the two axes, the control device DISPC comprises a motor MO, an angular position sensor CPO, a sensor CIC of an intensity of an electric current provided to the motor MO.
The motor MO, the angular position sensor CPO and the sensor CIC are similar for both axes. In the following, the operation of the control device DISPC along a single axis will be described. The operation on the other axis is identical.
The control device DISPC also comprises a processing unit UNIT.
This control device DISPC makes it possible to monitor the control surfaces of an aircraft or to monitor the motors(s) of the aircraft.
The motor MO comprises a shaft or rotor and a stator. The shaft and the stator are coaxial. The shaft and the stator have coils for one and permanent magnets for the other. The passage of an electric current in the coils causes a rotation of the shaft relative to the stator. For simplification, the expression “angular position of the motor MO” will be used to designate the angular position of the shaft relative to the stator.
The electric motor MO can be a single-phase motor (motor with limited displacement) or a permanent magnet synchronous motor.
The angular position sensor CPO is configured to determine an angular position of the motor, it is advantageously coupled directly on the motor shaft.
The stick MA and the motor MO are interconnected by a mechanical connection LI. More specifically, the shaft of the motor MO is connected to the mechanical connection LI which is connected to the stick MA.
The mechanical connection LI has a reduction ratio R. By reduction ratio R, it is meant that, when the electric motor MO and more particularly its shaft rotates by an angle Θ, then the stick rotates by an angle R*Θ.
The reduction ratio R can vary as a function of the angular position of the motor MO in a non-linear manner. In this case, R represents its linearized value around a given angle Θ.
The processing unit UNIT is configured to receive from the position sensor CPO the angular position of the motor MO. The processing unit is configured to receive from the sensor CIC the intensity of the electric current measured on electric terminals of the motor MO. The processing unit UNIT is configured to pilot the motor in current from the setpoints of a current which depends on the effort to be applied.
The processing unit UNIT also comprises a current corrector (not represented in
The processing unit UNIT is configured for the implementation of a control method represented in
This method comprises:
The angular position of the shaft of the motor MO relative to the stator of the motor MO is obtained from the angular position sensor CPO.
The first derivative of the angular position of the motor MO corresponds to a speed of rotation of the shaft of the motor MO relative to the stator of the motor MO.
The second derivative of the angular position of the motor MO corresponds to an acceleration of the rotation of the shaft of the motor MO relative to the stator of the motor MO.
The determination of the first derivative of the angular position and of the second derivative of the angular position can be made by algorithms in the state of the art well known to those skilled in the art and which consist in prforming a linear or non-linear derivation, to result in values of the speed of rotation of the motor MO and of the acceleration of the motor MO which are not noisy.
The second determination step 202 allows the determination of three efforts that the motor MO must apply on the stick MA, via the mechanical connection LI. Each of the three efforts constitutes an elementary component of an overall effort. The overall effort applied on the stick MA by the motor MO is therefore the sum of these three efforts. This global effort is felt by the user when he moves the stick MA.
The first of the three efforts is an effort restoring a stiffness of the stick MA. This first effort is generated by the motor MO. This first effort is proportional to an angular deviation between the angular position of the shaft of the motor MO relative to the stator of the motor MO and an angular position called anchor position. This anchor position is the position to which the stick MA returns when it is not subjected to an action from the user. The first intensity Kp is determined according to the stiffness setpoint Kpspec that the stick MA must restore. The stiffness to be restored is the stiffness that the user must feel when he uses the stick MA. This stiffness setpoint Kpspec can be a gain which presents the ratio between the generated effort and the angular deviation, this stiffness setpoint Kpspec can be variable according to the angular deviation, as illustrated in
In
The second of the three efforts is an effort restoring a damping of the stick MA. This second effort is generated by the motor MO. This second effort is proportional to the speed of rotation of the shaft of the motor MO relative to the stator of the motor MO. The second intensity Kv is determined according to the damping setpoint Kvspec that the stick MA must restore. The damping to be restored is the damping that the user must feel when using the stick MA. This damping setpoint Kvspec can be a gain or a function dependent on the speed of rotation of the motor MO, as illustrated in
In
The third of the three efforts is an effort restoring an inertia of the stick MA. This third effort is generated by the motor MO. This third effort is proportional to the acceleration of the rotation of the shaft of the motor MO relative to the stator of the motor MO. The third intensity K a is determined according to the inertia setpoint Kaspec that the stick MA must restore. The inertia to be restored is the inertia that the user must feel when using the stick MA. This inertia setpoint Kaspec can be a simple gain, or a non-linear law depending on the acceleration of the rotation of the motor MO. It can also be indexed by the speed of rotation of the motor MO or the angular position of the motor MO.
The intensities Kp, Ka and Kv are determined by using a transfer function HpSS(s) connecting the effort Fp(s) felt by the user on the stick MA and the angle Θmot(s) of the shaft of the motor MO relative to the stator of the motor MO.
This transfer function is modeled by the following function:
where:
Jmot is a predetermined parameter of the inertia of the shaft of the motor MO
Jss is a predetermined parameter of the inertia of the connection LI between the motor MO and the stick MA
fss is a predetermined parameter of the physical damping between the motor MO and the stick MA
Kss is a predetermined parameter of the stiffness of the connection LI connecting the motor MO and the stick MA
rp is the radius of the stick
fss is expressed in Newton*meter/radian/second (N*m/rad/s).
Kss is expressed in Newton*meter/radian (N*M/rad).
Jmot is expressed in meter*kilogram{circumflex over ( )}2 (m*kg2).
Jss is expressed in meter*kilogram{circumflex over ( )}2 (m*kg2).
By stick radius rp it is meant the distance between an axis of rotation of the stick MA and a point of application of the effort by the pilot on the stick MA.
Kpobt is an intensity of the stiffness obtained and felt by the user at the level of the stick MA. Kpobt is equal to the inverse of the static gain of the transfer function HpSS(s).
The previous formula shows that the stiffness felt by the user is the combination of two stiffnesses in series, namely the stiffness generated by the motor and the stiffness of the mechanical connection LI between the motor MO and the stick MA. Thus, to have a stiffness felt by the user at the level of the stick whose intensity is equal to Kpspec, it is necessary that the motor MO generates a first effort, of the stiffness type, whose intensity is equal to:
In the previous formula
Kvobt is an intensity of the damping obtained and felt by the user at the level of the stick MA. Kvobt is equal to the first-order static gain of the HpSS(s) function, which can be calculated from the following assumption valid at low frequency:
Or exactly:
By setting
we get:
By approaching s to 0, we get:
The intensity of the damping obtained and felt by the user at the level of the stick MA is therefore given by the equation:
The damping felt by the user is therefore the sum of the damping generated by the motor and of the damping of the physical connection LI between the stick MA and the motor MO. This sum is weighted by the stiffness of the physical connection LI and by the stiffness generated by the motor MO. Thus, to have a damping felt by the user at the level of the stick with the intensity Kvobt equal to Kvspec, it is necessary that the motor MO generates a second effort whose intensity Kv is equal to:
Kaobt is an intensity of the inertia obtained and felt by the user at the level of the stick MA. This intensity Kaobt is equal to the second-order static gain of the function HpSS(s). This static gain is calculated by taking the following assumption valid at low frequency:
The intensity Kaobt of the inertia obtained and felt by the user at the level of the stick MA is therefore:
We have:
After development, we find:
For reasons of physical feasibility, we know that:
And as the assumed input of the system is a force, the intensity Kaobt is expressed in m·Kg2 and is given by the following equation:
This equation clearly shows the impact of the restored stiffness, the restored damping and the restored inertia on the inertia restored at the level of the stick MA by the user. However, when the physical system is infinitely rigid, i.e, Kss→∞, the inertia felt by the user is only the sum of the inertia of the mechanical connection LI and of the inertia of the motor MO. Thus, the effect of the artificial stiffness on the global inertia is canceled.
Thus, to have an inertia felt by the user whose intensity Kaobt is equal to Kaspec, the intensity Ka of the inertia to be restored, that the motor MO must generate, must be equal to:
Thus the second determination step 202 makes it possible to determine the intensities (Kp, Kv and Ka) of three efforts that the motor MO must apply in order to actuate the stick MA in motion and so that the user feels, via the stick MA, three efforts restoring a stiffness of the stick MA, a damping of the stick MA and an inertia of the stick MA and of respective setpoints s Kpspec, Kvspec, and Kaspec.
Kp and Kpspec are expressed in Newton*meter/radian (N*m/rad).
Kv and Kvspec are expressed in Newton*meter/radian/second (N*m/rad/s).
Ka and Kaspec are expressed in meter*kilogram{circumflex over ( )}2 (m*kg{circumflex over ( )}2).
It can be noted that the transfer function connecting the effort of the user on the stick and the angle of the stick can be expressed at low frequency in the following form:
This low-frequency model can be represented by a second-order function of canonical form HTemplate of the following form:
where f is the cutoff frequency, ζ is a parameter of the desired damping and 1/K is a static gain. These elements can be expressed as a function of the stiffness setpoint Kpspec that the stick MA must restore, of the damping setpoint Kvspec that the stick MA must restore and of the inertia setpoint Kaspec that the stick MA must restore:
In one embodiment, the method comprises a step of determining the stiffness setpoint Kpspec that the stick MA must restore, the damping setpoint Kvspec that the stick MA must restore and the inertia setpoint Kaspec that the stick MA must restore, from the cutoff frequency f, from the desired damping parameter and from the static gain 1/K. This is achieved by successively using the following formulas:
ζ is expressed in Newton*meter/radian (N*m/rad).
f is expressed in hertz (Hz).
K is expressed in radian/Newton*meter (rad/N*m).
The step 203 of calculating the torque that the motor must generate from the three efforts is carried out by linear combination of the angular position, of the first derivative of the angular position and of the second derivative of the angular position with the intensities Ka, Kp and Kv associated with the three efforts that the motor MO must generate via its shaft.
In one embodiment, three torques are determined, the first as a function of the position, the second as a function of the speed and the third as a function of the acceleration, and these three torques are summed.
In the case where the setpoints are variable (non-linear artificial law), a lookup-table of the intensity of the efforts is used, which makes it possible to determine the intensities Kp, Kv and Ka according respectively to the angular position of the shaft, to the speed of rotation of the shaft and to the acceleration of the rotation of the shaft.
The step 204 of controlling the motor from the determined torque comprises a first step of determining a setpoint of an electric current making it possible to supply the electric motor MO so that it provides, on its shaft, the torque determined in the calculation step 203. This step also comprises the servo-control of this current setpoint using a current corrector and the measurement of the electric current at the terminals of the motor MO.
Thus, the sum of the three efforts constitutes the intensity of the torque that the motor MO must generate. More specifically, the value of the torque that the motor must generate depends on the intensities of the efforts (stiffness, damping and inertia) to be applied at the level of the stick. For example, if a pure stiffness is to be restored, the effort to be applied at the level of the stick MA is Ka*O. This torque intensity is transformed into a current setpoint by using either a linear relationship via the motor torque constant or a non-linear relationship between the torque and the current defined by the manufacturer according to the intrinsic characteristics of the motor MO. Then, this current setpoint is made available to the block 303 enabling the servo-control of the voltage of the electric current delivered at the terminals of the motor MO.
This determination of the intensity of the current is carried out based on the characteristics of the control device DISP and particularly of the electric motor MO. This determination of the intensity can be a linear law in the ideal case or a non-linear law taking into account the magnetic saturation, the temperature, etc.
Following the determination of the intensity of the electric current, a feedback loop allows a monitoring of the setpoint of the current intensity. This feedback loop uses the following elements:
Thus, the control method uses a model as represented in
Number | Date | Country | Kind |
---|---|---|---|
2012730 | Dec 2020 | FR | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/FR2021/052176 | 12/2/2021 | WO |