CONTROL BY MEANS OF A SET-POINT GENERATOR

Abstract: The invention relates to a device for displacing an object, which device includes a drive device for moving the object along an axis of motion, a control unit which is coupled to the drive device, a set-point generator which is coupled to the control unit and is arranged to determine from secondary conditions a jerk set profile and set points for a plurality of sampling periods for a trajectory to be traveled and to apply the set points to the control unit per sampling period. A problem solved by the invention consists in that secondary conditions such as, for example the maximum velocity or the desired final position, can be changed during a motion along a trajectory. To this end, during the displacement along the trajectory and in response to a change of the secondary conditions, a jerk set profile and associated set points are derived in the set-point generator from the secondary conditions for the sampling periods as from a sampling period succeeding the change. A jerk set profile is used which comprises two pulse pairs, each pulse pair comprising two pulses of the same amplitude and opposite sign. It is an advantage of the invention that the waiting time for the execution of changed instructions is reduced.

Description: Control by means of a set-point generator. The invention relates to a device for displacing an object, which device includes a drive device for moving the object along an axis of motion, a control unit which is coupled to the drive device, a set-point generator which is coupled to the control unit and is arranged to determine from secondary conditions a jerk set profile and set points for a plurality of sampling periods for a trajectory to be traveled and to apply the set points to the control unit per sampling period. The invention also relates to a method of displacing an object along a trajectory by means of a drive device, in which a jerk profile and set points are determined from secondary conditions for a plurality of sampling periods for the trajectory. A device of the kind set forth is known from US 5,331,264. In the context of the present Patent Application, secondary conditions are to be understood to mean initial values, final values and constraints, such as the maximum velocity, the maximum acceleration and the maximum jerk, being the derivative of the acceleration to time. Furthermore, a set profile is to be understood to mean a function of continuous time, representing the value of one of the motion variables at any sampling instant of the task to be performed. The set-point generator of the known device is arranged to determine, prior to the displacement along the indicated trajectory, the jerk set profile and the other set points for the other motion variables for a plurality of sampling periods for the displacement of the object along the indicated trajectory and to apply the set points to the control unit per sampling period, so that the drive mechanism can displace the object along the indicated trajectory. It is a drawback of the known device that during the displacement of the object along the trajectory there is a waiting period for changing secondary conditions influencing the motion of the object. This waiting period occurs, for example in the case of a correction of the desired final position or upon adjustment of a higher maximum velocity of the object. It is an object of the invention to provide a device in which said waiting time is reduced. To achieve this, the device according to the invention is characterized in that the set-point generator is arranged to derive, during a displacement along the trajectory and in response to a change of the secondary conditions, a jerk set profile and associated set points from the secondary conditions for the sampling periods as from a sampling period succeeding the change. As a result of this step, new set points can be derived, substantially without a waiting period, from new secondary conditions associated with a new task, so that the set points of the new task can be applied to the control unit, the old task then being terminated. An example of such a new task is a corrected final position for the object. A special embodiment of the device according to the invention is characterized in that the set-point generator is arranged to derive the jerk set profile which comprises two pulse pairs, each pulse pair comprising two pulses of the same amplitude and opposite sign. This step offers four different combinations for the different signs of the pulses and seven intervals which must be predetermined, so that use can be made of a mathematical model of seven equations with seven unknowns which can be solved within one or a few sampling periods. A further device according to the invention is characterized in that the set- point generator is arranged to generate pulses, subject to a constraint. This constraint implies, for example, that the maximum jerk equals zero, that the acceleration equals the maximum acceleration if the jerk equals zero, or that the velocity equals the maximum velocity if the jerk and the acceleration are both zero. As a result of this step, an optimum solution in respect of time is obtained, meaning that the final state is reached in the shortest possible time considering the given secondary conditions. A further device according to the invention is characterized in that the set- point generator is arranged to derive the sign of the pulses from a state of motion of the object. One effect of this step is that the signs determined are used to a make a choice between various options in the mathematical model in respect of determination of the values of intervals. A further device according to the invention is characterized in that the set- point generator is arranged to make the period of time between two successive pulses in the jerk set profile equal to zero in dependence on the state of motion of the object and an estimated final position of the object. The effect of this step consists in that the set of equations of the physical model for achieving a time-optimum solution remains solvable. A further device according to the invention is characterized in that the set- point generator is arranged to determine the set points from the resultant jerk set profile by the sampling of continuously integrated functions. The set points of the acceleration, the velocity and the position can thus be simply and quickly determined within one or a few sampling periods. A further device according to the invention is characterized in that the set- point generator is arranged to carry out error reduction during the derivation of the set points, which error reduction involves determination of a weighted mean of a value obtained by a forward calculation and a value obtained by a backward calculation of position as well as velocity and acceleration, a function of time being used as the weighting factor. This step enhances the accuracy of the calculations of the set-point generator in respect of calculations of integers having a finite word length or of calculations with operands having a different numerical representation. A further device according to the invention is characterized in that a position sensor is coupled to the set-point generator. Coupling the output of the position sensor to the set-point generator provides a further feedback of the desired final position and the actual final position of the object. A further device according to the invention is characterized in that the position sensor includes an electronic camera. It is thus achieved that a position of the object in space is determined in a coordinate system which is independent of the device. The invention also relates to a set-point generator for use in a device of the kind set forth. The invention furthermore relates to a method of displacing an object, which method is characterized in that, in response to a change of the secondary conditions during the displacement, a jerk set profile and associated set points are determined from the secondary conditions for the sampling periods as from a sampling period succeeding the change until the end of the trajectory. The above and other, more detailed aspects of the invention will be described in detail hereinafter, by way of example, with reference to the drawing. The drawing consists of the following Figures: Fig. 1 shows a device for controlling a motor by means of a set-point generator, Fig. 2 shows graphs of set profiles for a point-to-point motion, Fig. 3 shows an example of a corrected set profile. Fig. 1 shows an example involving a movable object 15 with a motor control in which the invention can be used. Fig. 1 shows a motor 1 with a servo amplifier 3 which is coupled to a tachometer 2. The tachometer is connected to a control unit 5. The control unit includes a first summing device 6, an input of which is connected to the tachometer whereas another input is connected to a set-point generator 7. The first summing device 6 determines the difference between a feedback signal 10 from the tachometer 2 and a reference signal 11 from the set-point generator 7. The set- point generator is connected to a second summing device 8, one input of which receives a desired position signal 13 and another input of which receives a position signal 12. The set-point generator generates a set point profile and derives the reference signal 11 therefrom. The values of the reference signal are applied to the control unit 5 per sampling period. The sampling frequency has a value in a range of between approximately 5 kHz and 50 kHz. The set- point generator 7 is controlled by a difference signal 14 between the desired position signal 13 and the position signal 12 from a position sensor 9. The position sensor 9 is used to determine the position of the object 15 independently of the drive. To this end, use can be made of, for example an electronic camera which generates the position signal 12. The set-point generator 7 also includes a processing unit (not shown) for executing calculations. An integrated digital signal processing unit of the type Texas Instruments TMS320C31 is an example of such a processing unit. The invention will be described on the basis of a set-point generator which is arranged for use in a device for performing a point-to-point motion. In the known method disclosed in the cited US 5,331 ,264, the jerk set profile is generated prior to the displacement along a trajectory, after which the set points are generated for all sampling periods for traveling the trajectory. During the traveling of the trajectory it is no longer possible to change secondary conditions having an effect on the motion of the object. In the set-point generator according to the invention, however, such a change of secondary conditions is possible during the traveling of the trajectory. To this end, the device according to the invention includes a set-point generator which, after the occurrence of a change of the secondary conditions, derives a new jerk set profile from the secondary conditions for the samples as from a sampling period subsequent to the change. Furthermore, the set-point generator preferably uses a set profile which comprises two pulse pairs, each pulse pair comprising two pulses which, except for the sign, have the same amplitude. One aspect of the invention concerns the determination of the duration and the switching instants of these pulses. The invention will be described further with reference to Fig. 2. From the top downwards Fig. 2 shows a position graph, a velocity graph, an acceleration graph and a jerk graph for a point-to-point motion. The dashed line represents a task which possibly has not yet been completed. When such a jerk set profile is assumed, for example the set points associated with such a profile can be determined within a sampling period of from 0.2 to 0.02 s. One aspect of the invention is the assumption that the point-to-point motion is considered to be a combination of two specific motions: a shock motion and a soft- stop motion. The shock motion is defined as a motion where the final state at an instant ι e is defined by the imposed final velocity v e and the final acceleration, and the final jerk has the value zero. A soft-stop motion is a special case of a shock motion where the final velocity is zero. The point-to-point motion can thus be subdivided into a maximum of 7 phases of motion: 1. changing of the acceleration to the maximum acceleration, 2. motion at the maximum acceleration, 3. changing of the acceleration to zero, 4. motion at maximum velocity, 5. changing of the acceleration to maximum deceleration, 6. motion at maximum deceleration, 7. changing of the acceleration to zero. The second, the fourth and the sixth phase of motion may be absent or have, for example a duration zero, because the maximum acceleration, the maximum velocity or the maximum deceleration, respectively, are not reached. Depending on the secondary conditions, the other phases of motion may also have a duration zero. The following conditions are also assumed: at the starting instant t 0 , the starting position is s,, the initial velocity is v, and the initial acceleration is a,. During the motion, three constraints must be imposed on the motion variables jerk, acceleration and velocity, i.e. the maximum velocity v mΛΪ , the maximum acceleration a max and the maximum jerk j max , the position, velocity and acceleration as a function of time being continuous and at an unknown instant t e in the final state there is standstill in an imposed position, the final velocity and the final acceleration then having the value 0. Furthermore, the instantaneous position s plp (t), the instantaneous velocity v pψ (t), the instantaneous acceleration a pφ (t) and the instantaneous jerk j plp (t) for the point-to-point motion must satisfy the following secondary conditions and constraints of the physical model: s ptp( l θ ~ s i s ptp^e> ~ s e Wo ) " v ( ! ) = ° a ptp<Jo) = a i Furthermore, if the initial acceleration exceeds the maximum acceleration in this model the maximum acceleration is made equal to the absolute value of the initial acceleration, the velocity set profile being adjusted so that the maximum velocity is maintained for an as long as possible period of time. Furthermore, in the set-point generator according to the invention one of the constrained variables, such as velocity, acceleration or jerk, is always made equal to the stated positive or negative maximum values during the generating of the set profile. An optimum solution in respect of time is thus obtained. The mathematical model for determining the set profiles of the jerk, acceleration, velocity or position utilizes generalized step functions so that successive integration of the set profile can be simply executed. For a generalized step function of the order n it holds that: ! n :t≥ t 0 Γ Λ ( '-Ό>- 0:t < t 0 n=0, l ,2,... (3) A pulse is described by two generalized zero-order step functions of opposite sign and different reference times. The two pairs of pulses of the jerk set profile for the point-to-point motion are described by the switching instants and (t 6 ,t 7 ) and an absolute value of the amplitude amounting to the maximum jerk, in which /,_ ] </, S { 1 , .. ,7} . The set profiles of the other motion variables are derived from the jerk set profile by means of successive integrations; e, and έ 2 indicate the sign of the first and the third jerk pulse. The sign of the second and the fourth pulse opposes that of the first and the third pulse, respectively. The set-point generator determines the switching instants of said seven phases of the jerk set profile by means of integration of the set profile and the system equations. The set profiles are described by the following functions: 2 JptpW'Jwax∑, r θ( r -4*-4>- *=1 r θ ( -'4*-3)- r θ('-W +r θ( -'4*-l)] 2 <WW ' maχ∑ t lFfi- k-*)- *=1 rι(ϊ-ϊ 4 jfc-3 ) -rι ( '- ϊ *-2 )+ rι ( '→4*-ι ) ] + Λ,- r 2 f - r 4*-2) +r 2( r - r 4t-l)] +α ( / - f θ)- i r 3 ('-'4Jt-2) +r 3('- ? 4it-i)] where «,,6 2 €{-l. + l} /,_,<<,• ιe{i,..,7} These functions and the inequality describe a third-order problem for three final conditions at t η for which the following secondary conditions are used: where either the first condition or the second condition holds. By substitution of the following is obtained by means of (4): where r, >0 ι € { 1....7} The above mathematical model does not offer an indication as regards the sign e, ,£ 2 of the pulses and how the selection of the alternatives in the equations (7.1), (7.3), (7 5) is performed. According to the invention, first the. sign of the pulses is determined and subsequently it is determined which of the alternatives in the equations (7. 1), (7.3), (7.5) must be selected. The determination of the sign of e, ,e 2 for the point-to-point motion utilizes the determination of e for the shock or soft-stop motion. During the shock motion an object experiences a maximum acceleration along the axis of motion, the sign of e being assumed to oppose that of the initial acceleration. The jerk set profile of the shock motion also comprises a pulse pair which comprises two pulses of the same amplitude and opposite sign. The determination of the sign of e and the values of τ { ,τ 2 τ 3 is given by By substitution of 'ι β 'i-l +τ ι τ,-≥0 (9) .€{1,2,3} there is obtained This system is solved for Tι,7 2 en τ 3 and it follows that a„ max τ 3 = - 'max τ 3 = 'max where T j ≥O /G {1,2,3} In that case, the acceleration is given by a(t)=a r sign(a i )j max (t-t Q ) (15) After a period of time Δf , a zero acceleration state is reached. The time interval is given by At=sign(a^^- =- - (16) ./max ./max The variation of the velocity during the period is called the characteristic velocity variation and is geometrically represented as the surface area below or above the acceleration graph. This characteristic velocity variation is dependent exclusively on the initial state of the object 2 along the axes of motion and the constraints and is further given by Av=sign(a i )— a r -i — (17) •/max A velocity difference smaller than the characteristic velocity variation means that an initial decrease has occurred in the acceleration, so a negative jerk, followed by an increase of the acceleration to zero, and hence a positive jerk. The sign of e is then determined by: e =sign(v e -v r Av) . (18) In order to determine the sign of e, ,e 2 for various physical situations in the point-to-point motion, a stop distance is determined for a given initial state of the object along the axis of motion, a soft-stop motion being assumed instead of the required point-to- point motion. The stop distance can in that case be determined by the formules () given above for the soft-stop motion. Furthermore, the associated sign of e of the jerk pulse pair can be determined in conformity with the above reasoning. Furthermore, the stop distance and the sign of the associated first jerk pulse e stop are characteristic quantities which are determined exclusively by the initial state of the object along the axis of motion and the secondary conditions. The stop distance and the sign e stop for the position-to-position motion for a number of combinations of the sign of e stop , the state of motion and the resultant estimated final positions and the desired final position are then determined in a manner which is analogous to the manner used to determine the soft-stop motion. The method of determining the sign of € j ,e 2 for the first and the third jerk pulse for these combinations can be summarized in the following algorithm: if ( e sto P = !) tnen if (s f >s stop ) then {e,=l;e 2 =-l;} else if (v det < -v maχ ) then {e 1 = l;e 2 = l;} else if (α,->0) then » f ( s f >s stopi) then { f ι =1 ; f 2 =1 ;} else {e,=-l;€ 2 =l;} else {e,=-l;e 2 = l;} else if (s f <s stop ) then {€,=-l;e 2 =l;} else if ( v det >v maχ) then ( € 1 = ~ ! = e 2= ~ ! * - > else if (fl;<0) then if (s f <s stop ) then {€,=-l;c 2 = -l;} else {e, = l;e 2 =-l} else { €l = -l; έ2 = -l;} where 2 v ^d A e„f (19) V max and s * represents the desired final position. The mathematical system (7) can be solved for the quantities e determined for the first and the third jerk pulse. In this respect it is assumed that the point- to-point motion can be considered to be a shock motion up to a final velocity equal to ~ 6 2 v m a x ' follo ed by a soft-stop motion, so that for the calculation of the intervals τ i' τ 2 , τ 3 °f tne initial states and 7 5 ,7 6 and τ 7 in the final states use can be made of the formules of the shock-motion and the soft-stop motion, respectively. 7 4 is subsequently determined from the equation 7.7 by utilizing the values found for τ 1 ,7 2 ,7 3 and r 3 ,τ 6 ,τ- j . The set of equations (7) can be solved if the value determined for τ 4 is not negative. If the value determined for 7 4 is negative, the assumption that the maximum velocity has been reached is false and in the equation (7.5) the alternative 7 4 =0 must be chosen. Subsequently, it is determined which alternatives must be selected in the equations (7.1) and (7.3). To this end, use is made of the state of motion of the object and the desired final state. Furthermore, the case 7 =0 and 6ι =e 2 and the case 7 4 =0 and 6 j ≠e 2 are distinguished. In the first case, applicable to 7 4 =0 and €ι =€ 2 , the time optimization problem is not suitably defined. In the second case an optimum solution in respect of time, however, is possible. For the first case it also holds that the initial velocity v. is so high that the new maximum velocity cannot be reached without exceeding the desired final position, the absolute value of the new maximum velocity being smaller than the initial velocity v- . In this case use is made a non-optimum soft-stop motion which is determined such that the desired final position is reached. Because in all calculations in the set-point generator according to the invention first the signs of €! ,£ 2 are determined, the intervals must be selected so that the desired result is obtained with the assumed signs of 6 1 ( e 2 . Two situations can thus occur: a standard soft-stop motion and a non-standard soft- stop motion. In the standard soft- stop motion the intervals 7, ,7 2 and τ 3 are determined and the other intervals are set to zero. In the non-standard soft-stop motion, occurring if the initial acceleration is higher than the absolute value of the maximum acceleration, only the intervals 7 3 ,7 6 and τ 7 are determined and the other intervals are also set to zero. Moreover, the acceleration is chosen so that the final position is reached exactly and the acceleration is less than the stated maximum acceleration. The intervals T j ,7 2 ,τ 3 can then be determined by means of the soft-stop model, utilizing a unidirectional pulse pair. In order to obtain a clear set of equations, the following new parameters are substituted in the soft-stop model: € ^ χ =i 2 II a i V: =V:+e ' ' 2 max // a ; =€ r ■ - 'max The set of equations describing a non-standard soft-stop model comprises three equations for the velocity, for the distance and for ensuring the presence of a constant acceleration interval, respectively: (24) // This system can be reduced to a single quadratic equation providing the solution. The solutions are then the sole solutions of real non-negative intervals for the given secondary and final conditions when the normal soft-stop motion is used in the case that and the non-standard soft-stop motion is used in the other cases. For the case 7 4 =0 en e, =e 2 . utilizing opposed pulse pairs without a constant velocity interval, an optimum solution in respect of time is possible, however. In that case it is determined whether 7 2 or τ 6 must be equal to 0. To this end, use is made of a method which includes forward reasoning and backward reasoning. According to the forward reasoning it is assumed that 7 2 =0, the maximum acceleration with the correct sign being reached at the instant r, =r 2 • Subsequently, it is attempted to falsify this assumption. To this end, the three intervals and the velocity at the instant t 3 =t 4 are expressed as / a i where /, =< • , -t x - — and 7 2 =0 . ./max Furthermore, it must be possible to execute a soft- stop motion as from the velocity v 3 and a zero acceleration with a stop - e equal to t 2 . This is possible only if the sign of v 3 opposes that of e 2 . If the latter is not the case, the original assumption is false and τ 2 must be unequal to 0, so € 2 v 3 > 0=»7 2 >0 . If the soft-stop motion is possible, the distance traveled (referred to as the forward distance) is determined by way of the sum of the shock distance and the stop distance: 3 s fwd = v i τ l +v 3 '3 + 5 + (25) .2 6/ max Comparison of the forward distance s^ and the desired distance St and the sign of έ, yields conclusions as regards the value of 7 2 ;if the difference between s * and S βvd has the sign of 6ι , a value of 7 2 which is not equal to zero is required; if the sign of the difference is not the same as that of e,, 7 2 must be set equal to 0, so r > 0=>T 2 >0 nf For the backward reasoning it is assumed that 6 =0, the maximum acceleration then being reached with the correct sign at the instant t 5 =t 6 . Subsequently, it is attempted to falsify this assumption. To this end, the three intervals and the velocity at the instant t 3 =t 4 are expressed as 5 =τ 7 =.^- and τ 6 =0 ./max 2 ,. v max y 3 - y ptpV3> 'max Furthermore, it must be possible to perform a shock motion as from the initial state until the velocity v 3 is reached with a shock e equal to } . This is possible only if the sign of V j -V j opposes that of e, . If the latter is not the case, the original assumption is false and τ 6 must be unequal to 0, so € 1 (v 3 -v- ) < 0=*7 6 > 0 . If the shock motion is possible, the distance traveled (referred to as the backward distance) is determined by way of the sum of the shock distance and the stop distance: t. . 7 2 a i =v / (τ ι + - ^) +v 3 (27) 2 3 2 6 max Comparison of the backward distance s bwd , the desired distance s* and the sign of 6 j offers conclusions in respect of the value of τ 6 The alternative to be chosen in the equations (7.1) and (7.3) follows from the equation (26) and the sign of e 2 3 , and from the equation (28) and the sign of £ι(v 3 -v ( ) , respectively. For all cases, except 7 4 =0,6ι =έ 2 , seven equations can then be selected from the set of equations (7), so that τ v .τ 1 are determined. The case τ 4 =0, l =€ 2 has been described separately. The value of the intervals τ, ..7 7 and the signs t λ ,t are subsequently substituted in the set profiles as defined in the mathematical model (4). Subsequently, the set- point generator calculates the set points for each sampling period by the sampling of continuously integrated functions. This offers the advantage that it can be performed more simply in comparison with a discrete numerical integration. Furthermore, the processing unit utilizes numbers with a floating decimal point notation with single precision or integers with a word length of, for example 32 bits. Inaccuracies may then occur, for example in the calculation of the distance in integers with a word length of 32 bits from velocities, accelerations, jerk and time represented as floating decimal point numbers with single precision. In order to enhance the accuracy of the calculations in the digital processing unit of the set-point generator, use is preferably made of error reduction. The error reduction utilizes the time variable in two ways. According to the first way the length of the interval in which the sampling commences is reduced by one sampling period after the calculation of each sample. The intervals having passed are set to zero. Thus, motions can be performed within a sampling period, the new set points also being obtained in relation to the set points of the previous sampling period. By reducing the interval it is assumed that the previously calculated set points serve as initial data for the calculation of the next sampling and the previous sampling instant serves as the initial sampling instant. According to the other method, the set position and possibly other set data are based on the theoretical break- point values for the points between the intervals. A breakpoint is to be understood to mean herein a discontinuity in the jerk. These breakpoints need not necessarily coincide with the sampling instants. The breakpoint values are related to the theoretical set data of these points. Furthermore, in calculations based on said intervals and reference points the error is substantially zero in the reference points and increases as the interval increases. Furthermore, the breakpoint values, notably those for the position, are not accurate. Thus, errors calculated exclusively by means of the initial conditions increase in the course of execution of the task to be performed, so that position errors increase in time and the final position does not correspond to the desired final position. In order to counteract said errors, in the set-point generator according to the invention the necessary breakpoints are determined on the basis of actual intervals in each sampling period. Thus, all breakpoints are determined in the actual position. Furthermore, a forward calculation and a backward calculation are used. During a forward calculation, the breakpoints refer to the initial conditions in the initial state and the set points refer to the breakpoints passed. In a backward calculation, in the final state set points refer to the final state and the set points refer to the breakpoints situated ahead in time. Said errors occur in the central zone during the execution of the task. In order to counteract said errors, a weighted mean of a value calculated according to the forward calculation and of a value calculated according to the backward calculation is used for position, velocity as well as acceleration, a function of time being the weighting factor. The weighted mean values for the motion variables are given by the formule: ot hot Thus, the set profile will be nearer to the forward set profile at the beginning and nearer to the backward set profile at the end, without a discontinuity occurring in the set profile. Fig. 3 shows an example of a weighted mean value of the position according to the forward and the backward calculation. The first curve 30 shows a position according to the forward calculation; the second curve 31 shows a position according to the backward calculation, and the third curve 32 shows the result of a weighted mean value according to the equations (31). Index of symbols a(t) acceleration as function of continuous time a, initial acceleration a™ maximum acceleration imposed by the user back indication for backward calculation Δs 0 ,,Δs 3 distance from the start to a breakpoint e number of the set {-1, 1} e,,€ 2 ditto, but for the point-to-point motion r n (t-t ) generalized step function of order n with increasing moment t o forw indication for forward calculation j(t) jerk, derivative of the acceleration according to time as a function of continuous time j, ^ maximum jerk imposed by the user JOG indication used for shock motion in generalized functions PTP indication for point-to-point motion s(t) absolute position as a function of continuous time s f total displacement in a point-to-point motion s, apparent displacement (PTP), corrected for an initial acceleration unequal to zero STP indication for soft-stop motion t continuous time, argument in set profiles to,,t, starting instant of a task t,,,t 7 breakpoint instants t c final instant of a task t_. ol total duration of a task τ,,,7 7 duration of time segments between jerk discontinuities T, first interval corrected for an initial acceleration unequal to zero. v(t) velocity as a function of continuous time v,,,v 7 velocity at a given breakpoint v e final velocity for a shock motion v, initial velocity for all motions v ^ maximum velocity imposed by the user for a point-to-point motion

Claims: CLAIMS: 1. A device for displacing an object, which device includes a drive device for moving the object along an axis of motion, a control unit which is coupled to the drive device, a set-point generator which is coupled to the control unit and is arranged to determine from secondary conditions a jerk set profile and set points for a plurality of sampling periods for a trajectory to be traveled and to apply the set points to the control unit per sampling period, characterized in that the set-point generator is arranged to derive, during a displacement along the trajectory and in response to a change of the secondary conditions, a jerk set profile and associated set points from the secondary conditions for the sampling periods as from a sampling period succeeding the change. 2. A device as claimed in Claim 1 , characterized in that the set-point generator is arranged to derive the jerk set profile which comprises two pulse pairs, each pulse pair comprising two pulses of the same amplitude and opposite sign. 3. A device as claimed in Claim 2, characterized in that the set-point generator is arranged to generate pulses, subject to a constraint. 4. A device as claimed in Claim 3, characterized in that the set-point generator is arranged to derive the sign of the pulses from a state of motion of the object. 5. A device as claimed in Claim 1 , 2, 3 or 4, characterized in that the set- point generator is arranged to make the period of time between two successive pulses in the jerk set profile equal to zero in dependence on the state of motion of the object and an estimated final position of the object. 6. A device as claimed in Claim 1, 2, 3, 4 or 5, characterized in that the set- point generator is arranged to determine the set points from the resultant jerk set profile by the sampling of continuously integrated functions. 7. A device as claimed in Claim 1, 2, 3, 4, 5 or 6, characterized in that the set-point generator is arranged to carry out error reduction during the derivation of the set points, which error reduction involves determination of a weighted mean of a value obtained by a forward calculation and a value obtained by a backward calculation of position as well as velocity and acceleration, a function of time being used as the weighting factor. 8. A device as claimed in Claim 1 , 2, 3, 4, 5, 6 or 7, characterized in that a position sensor is coupled to the set-point generator. 9. A device as claimed in Claim 8, characterized in that the position sensor includes an electronic camera. 10. A set-point generator as claimed in Claim 1, 2, 3, 4, 5, 6 or 7. 11. A method of displacing an object along a trajectory by means of a drive device, in which method a jerk set profile and set points for a plurality of sampling periods for the trajectory are determined from secondary conditions, characterized in that, in response to a change of the secondary conditions during the displacement, a jerk set profile and associated set points are determined from the secondary conditions for the sampling periods as from a sampling period succeeding the change.

Inventors: DIRKX WALRICK ARNOLDUS ADRIANU, MEYER PIOTR JAN, DIRKX, WALRICK, ARNOLDUS, ADRIANUS, FRANCISCUS, MEYER, PIOTR, JAN
Applicants: PHILIPS ELECTRONICS NV, PHILIPS NORDEN AB, PHILIPS ELECTRONICS N.V.
Application year: 1997
Main classification: G05B21
IPC codes: G05B19, G05B21