Method for determining a movement limit
10139794 · 2018-11-27
Assignee
Inventors
Cpc classification
B25J9/1615
PERFORMING OPERATIONS; TRANSPORTING
B25J9/0009
PERFORMING OPERATIONS; TRANSPORTING
B25J9/1623
PERFORMING OPERATIONS; TRANSPORTING
International classification
B25J9/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
In a movement system, the movement limit is determined by having a degree of freedom of the movement system defined and the respective current movement system state being available. Subsequently, an articulation trajectory is determined for each upper articulation point of the movement system, on which articulation trajectory the articulation point can move along the degree of freedom. The movement limit is then derived by calculating the point of intersection of the actuator movement in an extreme deflection with its respective articulation trajectory.
Claims
1. A movement system for simulators configured for carrying out a method for determining a movement limit of the movement system, wherein the movement system comprises: a platform which can be moved in several degrees of freedom with respect to a fixed reference plane by actuators, wherein the actuators are arranged in an articulated fashion both in the fixed reference plane and on the movable platform and are designed to change length in order to move the movable platform, and microprocessor-controlled computing unit which receives information from the actuators and is configured for: a) defining a degree of freedom of the movement system for which the movement limit is to be determined, b) making available a current movement system state of the movement system with respect to a predefined coordinate system, c) calculating an articulation trajectory for each upper articulation point of the actuators at the movable platform along the fixed degree of freedom taking into account the current movement system state in the predefined coordinate system, d) calculating a maximum possible position of each upper articulation point on its calculated articulation trajectory in the direction of the defined degree of freedom as a function of an extreme deflection of the corresponding actuator of the respective upper articulation point, and e) calculating the movement limit of the movement system with respect to the defined degree of freedom as a function of the maximum possible positions of the upper articulation points on their articulation trajectories whereby the movement limit is calculated deterministically and in real time, in order to thereby configure real-time-capable controlled-loop control while taking into account the available movement limit within the movement system.
2. The movement system according to claim 1, wherein the degrees of freedom of the movement system are the translational or rotational degrees of freedom.
3. The movement system according to claim 1, wherein the current movement system state is detected by means of sensors and then made available.
4. The movement system according to claim 1, wherein the movement system state is the location and/or position of the platform with respect to the predefined coordinate system.
5. The movement system according to claim 1, wherein the movement system state is the location, position and/or deflection of the actuators with respect to the predefined coordinate system.
6. The movement system according to claim 1, wherein the maximum possible position of an upper articulation point on its calculated articulation trajectory is calculated in the direction of the defined degree of freedom in that a movement space of the respective actuator with respect to its extreme deflection in the case of a movement of the actuator about the lower articulation point in the fixed reference plane is calculated, and the point of intersection of the calculated articulation trajectory of the respective upper articulation point with the movement space of the actuator is calculated.
7. The movement system according to claim 1, wherein the movement limit is determined for a first defined degree of freedom of the movement system, wherein subsequently in each case the movement limit for a second defined degree of freedom is calculated for various assumed values of the first defined degree of freedom within the movement limit, in order to obtain the movement limit for a movement space which is defined by the first and second degrees of freedom.
8. The movement system according to claim 1, wherein the movement system is a Stewart-Gough platform.
9. The movement system of claim 8, wherein said Stewart-Gough platform has six actuators.
10. A non-transitory computer-readable medium containing computer instructions stored therein for causing the microprocessor controlled computing unit to perform steps a) through e) of claim 1.
11. Device for determining a movement limit of a movement system, the movement system having a platform which can be moved in several degrees of freedom with respect to a fixed reference plane by means of actuators, wherein the actuators are arranged in an articulated fashion both in the fixed reference plane and on the movable platform and are designed to change length in order to move the movable platform, the device configured for carrying out the method according to claim 1.
12. Method for actuating a movement system in order to simulate movements and/or accelerations, wherein the current movement system state of the movement system is detected by means of sensors, and control signals for actuating the actuators of the movement system in order to simulate a movement and/or an acceleration are generated, wherein the control signals are generated as a function of the current movement system state and a determined movement limit of the movement system, wherein the movement limit of the movement system is calculated in accordance with the method according to claim 1.
13. A non-transitory computer-readable medium containing computer instructions stored therein for causing the microprocessor controlled computing unit to perform the method according to claim 12.
14. Control device for actuating a movement system, which control device is configured for carrying out the method according to claim 12.
15. Simulator for simulating movements and/or accelerations with a movement system and a control device according to claim 14.
16. Method for determining a movement limit of a movement system with simulator for carrying out a method, wherein the movement system comprises: a platform which can be moved in several degrees of freedom with respect to a fixed reference plane by actuators, wherein the actuators are arranged in an articulated fashion both in the fixed reference plane and on the movable platform and are designed to change length in order to move the movable platform, and a microprocessor-controlled computing unit which receives information from the actuators, the method comprising: a) defining a degree of freedom of the movement system for which the movement limit is to be determined, b) making available a current movement system state of the movement system with respect to a predefined coordinate system, c) calculating an articulation trajectory for each upper articulation point of the actuators at the movable platform along the fixed degree of freedom taking into account the current movement system state in the predefined coordinate system, d) calculating a maximum possible position of each upper articulation point on its calculated articulation trajectory in the direction of the defined degree of freedom as a function of an extreme deflection of the corresponding actuator of the respective upper articulation point, e) calculating the movement limit of the movement system with respect to the defined degree of freedom as a function of the maximum possible positions of the upper articulation points on their articulation trajectories, whereby the movement limit is calculated deterministically and in real time, and f) configuring a real-time-capable controlled-loop control while taking into account the available movement limit within the movement system, and using the controlled-loop control for controlling the movement system.
Description
DESCRIPTION OF THE DRAWINGS
(1) The invention will be explained by way of example with reference to the appended figures, of which:
(2)
(3)
(4)
(5)
(6)
DETAILED DESCRIPTION
(7)
(8) The respective articulation points are denoted by a small r. The lower articulation points on the frame G have here the index u which defines the articulation point as a lower articulation point of the respective indexed actuator. The upper articulation points correspondingly have a small o, as a result of which the articulation point is denoted as an articulation point of the respective actuator provided on the platform P. The indices g and f define the respective coordinate system which, can, however, be respectively converted per se. The index g therefore means the positionally fixed coordinate system of the frame, while the index f denotes the vehicle-side coordinate system with respect to the movable platform P.
(9) Therefore, the articulation point r.sub.ug,1 denotes the lower articulation point of the actuator R.sub.1, while the articulation point r.sub.of,1 denotes the upper articulation point of the actuator R.sub.1 on the platform P. The other designations for the articulation points then are obtained correspondingly.
(10)
(11) Along the selected degree of freedom, a respective articulation trajectory t.sub.1 to t.sub.3 is then calculated for each upper articulation point r.sub.of,1 to r.sub.of,3, said articulation trajectory being obtained from the current state of the respective upper articulation point along the looked-for degree of freedom. In other words, the articulation trajectories t.sub.1 to t.sub.3 of the respective upper articulation points r.sub.of,1 to r.sub.of,3 are obtained from the looked-for degree of freedom in the Z direction, based on the current position of the upper articulation points with respect to the fixed coordinate system of the frame G.
(12) The articulation trajectories t.sub.1 to t.sub.3 denote here that distance along which the respective articulation points move if the platform P is moved in the looked-for degree of freedom in the Z direction. The upper articulation points can only assume positions here in the respective articulation trajectories t.sub.1 to t.sub.3 if the platform P is moved along the selected degree of freedom in the Z direction. Other positions outside the articulation trajectory are not possible in the equivalent model.
(13) In the next step, a movement space is calculated for each actuator with respect to an extreme deflection.
(14) Owing to the fact that the actuator R.sub.1 is arranged in an articulated fashion at the lower articulation point r.sub.ug,1, a total of two movement spaces in which the actuator R.sub.1 can lie in its respective maximum deflection are obtained for the two extreme deflections of the actuator R.sub.1. The movement space describes here a circular path in the 2-D equivalent model. Therefore, a circular movement space B.sub.max is defined for the extreme deflection, while in the case of a minimum deflection the movement space B.sub.min is defined. The circular movement space B.sub.max has here a radius r.sub.1,max, which corresponds to the maximum deflection of the actuator R.sub.1. The movement space B.sub.min has a radius r.sub.1,min which corresponds to the minimum length of the actuator.
(15) The point of intersection with the maximum movement space B.sub.max of the actuator R.sub.1 with the articulation trajectory t.sub.1 yields here the maximum position along the looked-for degree of freedom z which the actuator can move to on the articulation trajectory t.sub.1. In the downward direction there is no restriction owing to the lack of a point of intersection of the movement space B.sub.min with the trajectory t.sub.1 within the system limits. If the maximum deflection is looked for, the maximum position with respect to the articulation trajectory t.sub.1 is the point of intersection with B.sub.max, which is denoted as r.sub.of,1,max.
(16) The other actuators R.sub.2, R.sub.3 are set off against one another in a similar way, with the result that points of intersection with their respective movement spaces also are obtained here in relation to their respective articulation trajectories t.sub.2, t.sub.3. Both the actuator R.sub.2 and the actuator R.sub.3 have here points of intersection with their respective articulation trajectories which lie above the maximum possible position of the actuator R.sub.1. The system limit with respect to the looked-for degree of freedom is therefore set to that maximum position which constitutes the smallest common denominator with respect to the looked-for degree of freedom. In the case of the exemplary embodiment of
(17) The movement limit with respect to the looked-for degree of freedom is therefore the maximum position of the actuator R.sub.1, with the result that the platform P can at maximum be moved as far as the limit P.sub.limit,max. In a corresponding way, the movement limit P.sub.limit,min, at which the actuator R.sub.2 constitutes the limiting factor, is thus obtained for the minimum deflection.
(18) If a rotational degree of freedom, for example around the rotational angle theta, is looked for instead of a translational degree of freedom, no straight articulation trajectories are obtained but instead circular trajectories which are then set off according to the same principle as in
(19) If these relationships are described mathematically, a quadratic equation with a real, two-real or two conjugate-complex solutions are obtained for each actuator R.sub.1 to R.sub.3. In the first case, the actuator is already in an extreme location, and in the second case one of the positions cannot be arrived at by the actuator except in the case of damage, which can be ruled out during practical operation. In the third case, the movements of the actuator do not restrict the considered degree of freedom.
(20)
(21) The frame G is permanently connected to the origin of the geodetic coordination system. For the case of a rotationally symmetrical design which is presented below, these lie in the center point of a triangle formed from the center points of the distances between three lower articulation points which are arranged in pairs. All the articulation points therefore lie on a circle whose center point coincides with the origin of the geodetic coordinate system. These assumptions are made exclusively for better comprehension and can be omitted in the case of an asymmetrical arrangement without restricting the general validity of the following statements.
(22) Furthermore, the triangle is arranged in such a way that the tip points rearward with respect to direction of flight to be introduced later. The X axis of the geodetic coordinate system points in the direction of flight, the Y axis in the direction of flight viewed toward the right, and the Z axis according to the definition in the downward direction. The designation of the lower articulation points is made from the rear tip of the triangle in the counterclockwise direction. The lower articulation points are given the designation r and the indices u are a designation of the upper articulation points. The index g specifies that the articulation point is considered as described in the geodetic coordinate system.
(23) The designation of the articulation points which are connected to the platform P is made analogously with r supplemented with the indices o for the upper articulation points and f for the representation in the aircraft-fixed coordinate system. Of course, these coordinate systems can be correspondingly transformed.
(24) In the platform-fixed coordinate system, the X axis is in turn arranged in the directory of flight, the Y axis points in the direction of flight to the right and the Z axis points downward. The origin of the platform-fixed coordinate systems lies at the center point of the platform triangle P and is designated below as the motion reference (MRP).
(25) If the lower articulation points are now connected to the respective upper articulation points, the corresponding actuators R.sub.1 to R.sub.6 are obtained. Figure shows the corresponding nomenclature for this.
(26)
(27) The vectors of the actuators for a known location of the platform P are then obtained for the forward kinematics.
{right arrow over (r)}.sub.n=1 . . . 6={right arrow over (r)}.sub.g+{right arrow over (r)}.sub.ofg,n=1 . . . 6{right arrow over (r)}.sub.ug,n=1 . . . 6={right arrow over (r)}.sub.g+
(28) With the transformation matrix
(29)
so that the looked-for length of the actuators is
(30)
(31) The vector for the origin of the aircraft-fixed coordinate system to the lower articulation points is then analogously
{right arrow over (r)}.sub.uf,n=1 . . . 6=
{right arrow over (r)}.sub.ufg,n=1 . . . 6={right arrow over (r)}.sub.g{right arrow over (r)}.sub.ug,n=1 . . . 6={right arrow over (r)}.sub.g{right arrow over (r)}.sub.ug,n=1 . . . 61-4
(32) For the inverse kinematics, the equations (1-1) and (1-3) give rise to a non-homogeneous equation system with 24 equations and 24 unknowns, which equation system can have up to over 40 solutions. For this reason, the position of the platform for a given actuator length is possible only by means of iterative methods which have a non-deterministic running behavior. Owing to the high number of solutions, it is therefore not possible to determine the movement space analytically by inserting the extreme values for the actuator length.
(33) In the text which follows, it is then assumed that just one degree of freedom is always excited. In this context, the actuator which is considered is moved. It is assumed that all the other actuators can permit the movement in the degree of freedom considered. In this way, 24 extreme values are obtained for each of the six actuators. The actuator with the smallest extreme value in absolute terms then defines the limitation of the platform in this degree of freedom.
(34) A further assumption is the transformability of all the vectors into the considered coordinate system. This requires knowledge of the location of this coordinate system. The upper equations are resolved for this purpose:
(35)
(36) This will now be briefly outlined on the basis of a translational degree of freedom.
(37) In the text which follows, it will be assumed that the location in the three rotational degrees of freedom is known and constant. The transformation matrix from the physically secure coordinate system to the geodetic one and therefore the description of the platform articulation points in the geodetic coordinate system are thus easily possible. Furthermore, the location of the lower articulation points is also known.
(38) Generally, after conversion of all the vectors the desired coordinate system then is obtained from the equation (1-1)
{right arrow over (r)}.sub.A,n=1 . . . 6={right arrow over (r)}.sub.g,A+{right arrow over (r)}.sub.ofA,n=1 . . . 6{right arrow over (r)}.sub.ugA,n=1 . . . 6 {right arrow over (r)}.sub.A,n=1 . . . 6{right arrow over (r)}.sub.g,A={right arrow over (r)}.sub.ofA,n=1 . . . 6{right arrow over (r)}.sub.ugA,n=1 . . . 61-7
and is noted on a component basis
(39)
(40) This results in an equation system with three equations and six unknowns on the left-side. There is a fourth equation as a result of the relationship for the actuator length.
l.sub.n=1 . . . 6.sup.2=r.sub.n=1 . . . 6,A,x.sup.2+r.sub.n=1 . . . 6,A,y.sup.2+r.sub.n=1 . . . 6,A,z.sup.21-9
(41) A solution to this equation system is possible only with two further restrictions with respect to the variable which has been assumed to be unknown thereto. When a translation degree of freedom is considered, this leads, for example, to an equation system with four unknown equations.
(42) If, for example, the maximum possible travel in the X direction is looked for a random location and position of the platform in the geodetic coordinate system, the equation (1-1) yields
{right arrow over (r)}.sub.n=1 . . . 6{right arrow over (r)}.sub.g=
(43) For the known variables, the right-hand sides of the equations (1-8) are combined by means of
a.sub.n=1 . . . 6=cos .Math.cos .Math.r.sub.of,x,n=1 . . . 6+(sin .Math.sin .Math.cos cos .Math.sin ).Math.r.sub.of,y,n=1 . . . 6+(cos .Math.sin .Math.cos +sin .Math.sin ).Math.r.sub.of,z,n=1 . . . 6r.sub.ug,x,n=1 . . . 6
c.sub.n=1 . . . 6=cos .Math.sin .Math.r.sub.of,x,n=1 . . . 6+(sin .Math.sin .Math.sin +cos .Math.cos ).Math.r.sub.of,y,n=1 . . . 6+(cos .Math.sin .Math.sin +sin .Math.cos ).Math.r.sub.of,z,n=1 . . . 6r.sub.ug,y,n=1 . . . 6
e.sub.n=1 . . . 6=sin .Math.r.sub.of,x,n=1 . . . 6+(sin .Math.cos ).Math.r.sub.of,y,n=1 . . . 6+(cos .Math.cos ).Math.r.sub.of,z,n=1 . . . 6r.sub.ug,z,n=1 . . . 61-11.
(44) For the illustrative example, the movement space is to be determined in the X direction, with the result that the two other translational degrees of freedom are kept constant at the edge value. This results for the movement in the X direction in
(45)
(46) Therefore, there is obtained, using the relationship for the length of the actuator by means of
(47)
(48) Per actuator, two translational extreme positions are therefore obtained for each length which is used. If the maximum and the minimum actuator length is then used, 24 extreme values are obtained therefrom. The limit of the movement range which applies for the instantaneous location in examined coordinate direction are the points which are closest to the assumed position. The values for
r.sub.y,n=1 . . . 6=c+d.sub.x1-15
and
r.sub.z,n=1 . . . 6=e+f.sub.x1-16
can be determined directly. This is easily apparent because of the unchanged coordinates of the upper articulation points in the two degrees of freedom.
(49)
(50) Subsequently, the movement limit in the Y direction was calculated in each case for X for various X values within the calculated movement limit, with the result that in each case different Y values are obtained for various X values. As a result, in this context the limit of the movement space which the platform can move to is obtained for Z=0 and a current position at the coordinate origin.
(51) An advantage of this method is that this movement space can be calculated deterministically and analytically, with the result that this method is basically capable of real-time operation.