Applicant claims priority under 35 U.S.C. § 119 of European Application No. 22180890.0 filed Jun. 24, 2022, the disclosure of which is incorporated by reference.
Human-machine interfaces in vehicles, machines and robotic devices allow an operator to control the position of a remote element like a wheel or tool by applying an input force via an input device and to receive a feedback of the position and torque of the controlled element. However, this often requires a complicated mechanical linkage between the input device and the controlled element, as the connected components are most often not placed in a straight line enabling a connection between them by a simple shaft. Furthermore, such a mechanical connection is prone to wear and requires expensive bearings.
Therefore, electro-mechanical control systems are widely used to overcome these problems.
In printers, several gears and belts ensure that a number of rollers are driven by a single motor as if all the rollers where mounted on a common virtual shaft, ensuring the rollers at one end does not pull the paper faster than the preceding roller delivers the paper, whereby the paper could be torn apart. Or the paper could be folded and jammed if a roller that picks up the paper rotates slower than the preceding roller that delivers the paper. To reduce costs and allow different speeds of the paper in different stages of the paper handling, printers are equipped with multiple motors to drive the roller shafts in different areas of the printer. Document CN106208865B “Load observer-based virtual line shaft control method for multiple permanent magnet synchronous motors” discloses a method of improving the synchronisation of a number of slave motors with a master motor by means of a load observer and forward feeding of the observed load to the current loop of the slave motors. This allows the slave motors to respond quicker to starts, stops and variations in load and maintain better synchronization with the master motor based on position and speed control.
However, this document does not disclose a solution to the problem how to forward an external input provided by an operator to a controlled element and to receive a feedback from the controlled element with regard to the change of its position and torque.
CN106208865B only describes how a slave end of a shaft can be synchronized in position and torque with the position of the master end of the shaft and which torque has to be applied to obtain the desired position of the slave end. Furthermore, this known method relies on calculation of loads based on angle, speed and current dynamic models and is only applicable if electric AC motors are used.
In mechanical control systems in which an operator provides input and receives feedback from the controlled element by a mechanical connection, the small elastic deformations of the components may be considered during the design of the components to ensure the deformations will be negligible during normal operation and will not affect the system's performance.
In electronic control systems, in which a mechanical connection between an input device and a controlled element is replaced by an electronic control system that forwards input control commands to an actuator changing the position of the controlled element, it is considered advantageous that such deformations are not present as the mechanical component is replaced by an electro-mechanical system simulating the behaviour of an ideal mechanical component having infinite rigidity.
However, control systems operating with measuring the position of a user input device and using this input for determining a target position of the controlled device or element, are faced with the issue of a time delay between applying an input to the input device, forwarding a corresponding target position and achieving the desired target position of the controlled element. This leads to an offset between the position in which the controlled element should be at a given time, corresponding to the position of the input device at that same given time, and the position the controlled element is actually in at that given time, while moving towards the position it should preferably already be in. This is a well-known control problem and a number of solutions have been proposed to reduce the delay and thus the offset.
However, the elimination of any offset between an input device and the position of a controlled element does not represent an actual physical connection between the input device and the controlled element, as all solid materials have an elasticity module and consequently work like a spring, although often with a very high spring constant leaving the effects of the elasticity to be negligible and barely measurable. Hence, a physical load-transmitting component will always introduce a small offset between where the load is applied and where the load is transmitted to. Although the offset is not caused by a time delay, but by elastic deformations of the component caused by the load being transmitted.
The object of the present invention is to provide an electro-mechanical system to control and/or to synchronize a remote element by an input device or vice versa that is a true representation of a purely mechanical control system and that allows a feedback from the controlled element to the input device.
This object is achieved according to the invention by a system and method to control an element mounted on a remote shaft by an input device mounted on an input shaft and delivering a feedback force from the controlled element to the input device wherein the remote shaft and the input shaft are spatially separated and each shaft is rotatably mounted in a respective frame member against a spring force. Each shaft is provided with an angle sensor measuring the rotational position of the shaft with respect to its frame member. Output signals of the angle sensors are transmitted to an electronic control unit that controls a first torque actuator mounted on the input shaft and a second torque actuator mounted on the remote shaft in such a manner that the torques exerted to the input shaft and to remote shaft are both functions of the difference of the angular positions (θ1, θ2) of the input shaft and of the remote shaft as measured by the angle sensors. The angular positions (θ1, θ2) are weighted by a virtual spring constant (k) that emulates a mechanical connection between the input shaft and the remote shaft.
The electronic control unit synchronizes the torque and angles between the input shaft and the remote shaft in a manner that imitates a direct mechanical connection between the input device and the controlled element. A physical shaft for transmission of torque is comparable to a torsion spring with a spring constant k, which is determined by material, shape and dimensions of the shaft. If an external force is applied to one end of the shaft, initially an angular offset between the two ends of the shaft will be caused. This behaviour of a virtual shaft directly connecting the input device and the controlled element is emulated by the electronic control unit. The torque actuators on both shafts are activated in such a way that the angular positions of the input shaft and the remote shaft follow each other with a certain offset that is time dependent. Also, the inertia of the shafts and/or the controlled element can be taken into consideration. Further, it is possible to emulate a gearbox and/or a power steering arranged between the input device and the controlled element by introducing corresponding factors by which the angular difference between the two shafts is multiplied.
If the system is completely symmetrical, the functions of the input shaft and the remote shaft can also be interchanged. The remote shaft can control the movement of a device connected to the input shaft.
The invention has various applications like the replacement of a steering column in a vehicle and providing a steer-by-wire system with force feedback, the remote control of machinery with force feedback and the remote control of robots. The system can also be used to replace hydraulic systems or to provide a feedback to an operator in hydraulic systems.
The system can also be used to transmit linear motion when the rotary motion of the remote shaft is converted into linear motion. Also, the input shaft can be operated by a linear input device by converting the linear movement of the input device into rotational movement of the input shaft.
Other objects and features of the invention will become apparent from the following detailed description considered in connection with the accompanying drawings. It is to be understood, however, that the drawings are designed as an illustration only and not as a definition of the limits of the invention.
In the drawings,
To fully understand the principles and ideas on which the invention is based, the behaviour of a physical shaft for transmitting a torque between two elements is explained with reference to
The physical shaft 10 for transmission of torque is comparable to a torsion spring having a spring constant k, that is determined by material, shape and dimensions of the shaft 10. Thus, if a torque is applied to the shaft 10 it will twist the shaft 10 slightly causing one end of the shaft 10 to be rotationally offset by an angle of Δθ relative to the opposite end of the shaft 10, whereby the size of the angle Δθ is determined by the applied torque and the spring constant.
In a static scenario with no torque being transmitted between the flanges 11, 12 as shown in
Assuming that the larger flange 12 is connected to a component that requires a torque Tf to overcome friction, a torque T1a<Tf applied to the smaller flange 11 will cause an elastic deformation (torsion) in the shaft 10. The smaller flange 11 rotates to the position θ1a (
Then the torque applied to the smaller flange 11 is increased to T1b being infinitely close to, but below Tf and the smaller flange moves to a position θ1b as shown in
As the torque applied on the smaller flange 11 exceeds TF, the friction of the component is overcome and the second flange 12 starts to move. In
If a constant torque of Tf continues to be applied to flange 11, the component attached to flange 12 will rotate at a constant speed. When the larger flange 12 has reached a position θ2-d, the smaller flange 11 will have reached a position of θ1d, and the angular offset will remain Δθ=θ1d−θ2d=θ1b (
If the torque applied on the smaller flange 11 is increased, the angular offset will increase and the rotation speed of the shaft 10 and the component attached to flange 12 will increase.
In
Further, both shafts 110, 120 are provided with angle sensors 113, 123 and with a torque actuator 114, 124. The angle sensors 113, 123 provide their output signals 115, 125 to an electronic control unit 130 that calculates control signals 116, 126 for the torque actuators 114, 124 to obtain the desired emulation of a mechanic connection between the input device and the controlled element. The position sensors 113 and 123 measure the relative angles of the shafts 110 and 120 with respect to the frames 111 and 121.
The ECU 130 processes the angle data 115, 125 from both shafts 110, 120 and commands the torque actuators 114 and 124 to synchronize torque and angles between shafts 110 and 120 such that the shafts 110, 120 behave like one continuous shaft connecting the two flanges 112, 122.
The control function in the ECU 130 calculates the required torque to be provided by the torque actuators 114 and 124 based on the input from the position sensors 113 and 123, according to the following basic relations:
T
114
=k(θ123−θ113) and T124=k(θ113−θ123), and thus T114=−T124
When no external torque is applied to either shaft 110 or 120 the ECU 130 will command torque actuators 114, 124 to provide torques of equal size but opposite directions until θ113=θ123.
If an external torque is applied on one shaft, in this example the input shaft 110, shaft 110 will change its angular position and the output signal 115 of position sensor 113 will be different from the output signal 125 position sensor 123. This will cause the ECU 130 to command torque actuator 114 to apply a torque T114 on shaft 110 in the opposite direction of the applied torque. At the same time, the ECU 130 will command the torque actuator 124 to apply a torque T124 on shaft 120, being equal to the torque applied on shaft 110 by the actuator 114, but of opposite direction and thus in the same direction as the external torque being applied to shaft 110. As the torques are calculated from the spring constant (that remains a fixed constant) and the angular difference, the torques will increase as the angular difference increases.
If the resisting torque T114 exceeds the torque applied to shaft 110, the shaft 110 will start to turn back. Thereby the difference between position measurements from position sensors 113 and 123 will be reduced and the ECU 130 will command both torque actuators 114 and 124 to reduce the torques provided, until the torque applied by torque actuator 114 to shaft 110 equals the external torque being exerted on shaft 110.
If the torque T124 applied to shaft 120 by torque actuator 124 exceeds the torque that is required to initiate a motion of the component attached to flange 122, shaft 120 will start to rotate and its angular position θ123 will start to change accordingly and the position reading θ123 from position sensor 123 changes. This means that the torque applied to shaft 110 by torque actuator 114 will not be increased further when the torques applied by the torque actuators 114 and 124 exceeds the resistance of shaft 120. The applied external torque will then be allowed to move shaft 110 and maintain the angular offset Δθ=θ113−θ123 between the two shafts 110 and 120.
The model of the virtual shaft can be further refined in case of dynamic motion, wherein the inertia of the shafts 110, 120 and of the actuators 114, 124 needs to be considered. A physical shaft could be modelled as a system of two masses, each with inertia J/2, coupled by a spring with constant k.
The virtual shaft system might have a different inertia J′/2 at each end. To compensate for the change in inertia, an additional term is introduced into the control equation:
Furthermore, a motion filter can be applied to remove unwanted frequencies, e.g.
T
1(s)=H(s)k(θ2−gθ1)
When a human operator is operating machinery or controlling the steering wheel of a vehicle through a shaft, it is usually necessary to install a gearbox to reduce the required torque to a comfortable level. When introducing a gear ratio to reduce torque on one side of the gearbox, it is followed by an increase of motion, as the work input equals the work output of an (ideal) gearbox.
Using a control system according to the invention allows to integrate a virtual gearbox as well. A simulation of a gearbox with ratio g may be obtained simply by multiplying one of the angular positions with the gear ratio as shown below:
T
1
=k(θ2−gθ1)
T
2
=k(gθ1−θ2)
However, it may not always be desirable to use a gear ratio to reduce the required torque input from a human operator. In steering gear systems for cars, servo-assisted steering has been added in most vehicles instead of increasing the gear ratio, which would reduce the torque needed from the driver but increase the number of revolutions of the steering wheel necessary for parking manoeuvres. A virtual servo-assisted steering may also be included into the control system according to the invention. The torque of one of the shafts can be multiplied by an assistance factor as shown below:
T
1
=k(θ2−θ1)
T
2
=ak(θ1−θ2)
As the virtual gearbox and virtual servo-assisted steering are virtual and not actual physical structures, both the virtual gearbox and virtual servo-assisted steering can be made variable, depending on different input parameters. If the system is a steer-by-wire system replacing the steering column of a car, this could be used to introduce speed-depending servo-assisted steering and a speed depending steering gear ratio, by making the above described factors variables depending of the vehicles speed, such that:
g=g(v)
a=a(v)
These factors could also be chosen according to preferences of a driver or dependent on mode settings of the vehicle, such as Sport, Comfort or other selectable characteristics. These factors can also be combined with adjustable damper settings and other variables.
Therefore, the most comprehensive equations to calculate the time and speed dependent torques T1, T2 are the following:
T
1(t)=F1{a1·k·(g2θ2(t)+s2{dot over (θ)}2(t)−g1θ1(t)−s1{dot over (θ)}1(t))}
T
2(t)=F2{a2·k·(g1θ1(t)+s1{dot over (θ)}1(t)-g2θ2(t)−s2{dot over (θ)}2(t))},
If the system is a steer-by-wire-system for a vehicle the factors a1, a2, g1, g2, s1, s2 and k can be dependent on the speed v of the vehicle.
As a torque-control of both hydraulic motors and electrical DC motors is often difficult and involves complicated motor controllers and control algorithms, a second embodiment of the invention is depicted in
Thus, in the second embodiment of the system 200 according to
The second embodiment of a complete system 200 consisting of an input shaft 210 and a remote shaft 220 that are connected to a common ECU 230 containing means of data processing to provide position command signals 216, 226 to the two torque actuators 214, 224, based on position measurement inputs 225a-225b from the four position sensors 213a, 223a, 213b, 223b.
The position sensors 213a and 223a measure the relative angles of the shafts 212 and 222 with respect to the frames 211 and 221 and the position sensors 213b and 223b measures the relative angles of the torque actuators 214 and 224 with respect to the frames 211 and 221.
The ECU 230 processes the angle data from all four position sensors 213a, 223a, 213b and 223b and commands the torque actuators 214 and 224.
The control function in the ECU 230 synchronizes torque and angles between shafts 212 and 222; such that the behaviour mimics a rotational shaft, connecting shafts 212 and 222. It should be understood that this virtual shaft is not a physical component.
Where the ECU 130 in the first embodiment shown in
The control function in the ECU 230 calculates the required torque to be provided by the flexible elements 217 and 227 by the input from the position sensors 213a and 223a, based on the following basic relations:
T
217
=k(θ223a−θ213a) and T227=k(θ213a−θ223a), and thus T217=−T227
If flexible element 217 has the spring constant k217 and the flexible element 227 has the spring constant k227, the torques are also given as:
T
217
=k
217(θ213b−θ213a) and T227=k227(θ223b−θ223a)
Thus, the target positions θ213b and θ223b to which torque actuators 214 and 224 are to be driven, is given by:
When no external torque is applied to either shaft 212, 222, the ECU 230 will command torque actuators 214, 224 to drive towards each other, until θ213a=θ213b=θ223a=θ223b.
If an external torque is applied on one shaft, in this example on the input shaft 212, shaft 212 will change its angular position and the measurement from position sensor 213a will be different from the reading from position sensors 223a and 213b. This will cause the ECU 230 to command torque actuator 224 to drive towards a target position of θ213a=θ223a. Any resistance on shaft 222 will result in deformation of flexible element 227, causing sensor output 225b from position sensor 223b to deviate from sensor output 225a from sensor 223a. The ECU 230 will then command the torque actuator 224 to drive to the element 621 to the target position θ223b, measured by position sensor 223b, and the torque actuator 214 to drive the element a casing 218 of the flexible element 217 to a target position of θ213b, measured by the position sensor 213b. This will introduce a deformation of the flexible element 217 and introduce a resisting torque on shaft 212 opposing the applied external torque applied on shaft 212. The torque actuator 224 being driven to a position of θ223b will introduce a torque on shaft 222 through the flexible element 227.
If external torque applied on shaft 212 is increased, the flexible element 217 is further deformed and the control input 215a from sensor 213a changes. This will change target positions 8213b and 6223b and the resisting torque on shaft 212 is increased, as well as the torque applied through flexible element 227 is increased. If the resisting torque on shaft 212 exceeds the external torque applied on shaft 212, shaft 212 will start turning back and the target positions 8213b and 6223b will change and the applied torque on shafts 222 and the resisting torque on shaft 212 will be reduced, until the torque applied by torque actuator 214 on shaft 212 through the flexible element 217 equals the external torque being applied on shaft 212.
If the torque applied on shaft 222 by the flexible element 227 when torque actuator 224 is driven to the target position θ223b exceeds what is required to initiate motion of the component to which shaft 220 is attached to, shaft 220 will start to move and the position θ223a starts changing accordingly.
When shaft 220 starts to rotate as the torque applied by torque actuator 224 through flexible element 227 exceeds what is required to overcome the resistance from the component attached to shaft 220, the position reading {dot over (θ)}223a from position sensor 223a changes. This means that the position θ223a of shaft 212 must also change and as the difference between θ223a and θ223b starts to decrease, so will the ECU 230 command torque actuator 214 to drive to a new target position θ213b, decreasing the deformation of flexible element 217. Thereby, the resisting torque on shaft 210 is reduced and the external torque will then be allowed to move shaft 210 and maintain the angular offset Δθ=θ213a−θ223a between the two shafts 210 and 220.
The flexible element 227 is fitted between two casing elements 228a, 228b, such that one end of the flexible element 227 is rotationally fixed to one housing element 228a and the opposing end of the flexible element 227 is rotationally fixed to the other housing element 228b. The housing elements 228a and 228b are locked to each other in axial direction but able to rotate relative to each other. One of the housing elements 228b is rotationally fixed to the rotor of torque actuator 224. The other casing element 228a is rotationally fixed to shaft 220.
An angle sensor 223b, 229b measures the position of the rotor of the torque actuator 224. In this embodiment the angle sensor consists of a position sensor 229b measuring the position of a coded disc 223b being an integrated part of the casing element 228b.
A second angle sensor 223a, 229a measures the position of the shaft 220. In this embodiment the angle sensor consists of a position sensor 229a measuring the position of a coded disc 223a being a part of the casing element 228a.
The components of the shaft end unit are fitted in a framing member 221 which may be an assembly consisting multiple elements, likely including bearings for the rotating parts.
The torque actuator 224 may be an electric or a hydraulic motor or actuator. In this embodiment, the position of the rotor must be controllable by command inputs from controller 230 (
The embodiments described in
The invention may also be used for implementation of a remote angle-to-speed control, in which the user controls the torque applied on a torque actuator operating on a rotating component (e.g. a drill) and receives a feedback of the obtained speed of the rotating component in form of the angle/position of the user input device.
Although only a few embodiments of the present invention have been shown and described, it is to be understood that many changes and modifications may be made thereunto without departing from the spirit and scope of the invention.
Number | Date | Country | Kind |
---|---|---|---|
22180890.0 | Jun 2022 | EP | regional |