Method and apparatus for controllably driving the motion of one or more masses

Abstract: The present invention provides a stable, high performance system for driving one or more masses in precise incremental movements. More particularly, the present invention provides a method and system for deriving and implementing motion profiles that govern the movement of one or more masses, such as a printer drum as it is indexed along a rotational path by a stepper motor. A continuous driver input function is generated using a Kalman controllability matrix. This function is then approximated by a step motion profile.

Description: Field of the Invention This invention relates to methods and apparatus for controllably driving the motion of one or more masses, and relates in particular, but not exclusively, to methods for deriving and implementing motion profiles, e.g. , position and velocity profiles, approximately ideal motion profiles for one or more masses driven, for example, by a stepper motor. The methods and apparatus of the present invention are especially suitable for use in thermal phase change ink jet printers. Background of the Invention Drive means such as stepper motors are conventionally employed in equipment such as X-Y plotters, printing apparatus, and the like. Such apparatus require generally incremental displacements of one or more masses. The mass (or masses) being driven in such applications are accelerated from zero velocity to a selected velocity, and then decelerated to zero velocity to complete a cycle. The masses are typically required to complete such cycles of movement in rapid succession. Print substrates are supported by a substrate support during many types of printing operations. The substrate support may take the form of a generally planar or curved rigid surface, or a hollow, cylindrical print drum. The print substrate and a printing mechanism are typically moved relative to one another as printing material is applied to the print substrate. The print substrate may be indexed at predetermined intervals to expose different areas of the print substrate for printing. Imprecise indexing of the print substrate may result in overshoot, ringing and noise. Overshoot occurs when the print substrate and substrate support are moved beyond the desired final position and must then be returned to the desired final position. Vibrational ringing occurs when the substrate support does not stop positively. These problems are exacerbated by frictional forces, which cause the masses to stop in unpredictable locations. Overshoot and ringing generally result in diminished print quality, particularly in thermal phase change ink jet printers in which precise ink drop placement is critical. Throughput rates are also affected, because printing operations cannot commence until overshoot has been corrected and ringing has subsided. Additionally, imprecise indexing may result in serious acoustic noise which is objectionable from an operational standpoint. In printer applications, the desired substrate support ( e.g. , print drum) motion profile is normally conveyed directly to a stepper motor, and the stepper motor generates rotational output corresponding to the desired position profile. A print drum is typically driven by a cable and pulley system or a cogged timing belt which translates the rotational motor drive output to substrate support indexing. In general, acceleration/deceleration motion profiles may be either linear or nonlinear. An exemplary linear profile is illustrated in Fig. 1a. Linear velocity profiles are generally characterized by constant acceleration from zero or another predetermined velocity, followed by a zero acceleration constant velocity period, followed by constant deceleration to the initial velocity level. Linear profiles generally result in ringing at the inflection points of the motion profile, as shown. Nonlinear acceleration/deceleration profiles are illustrated in Figs. 1b and 1c. Nonlinear velocity profiles of the type shown in Fig. 1b are optimized for a maximum velocity, shown as V MAX . Velocity profiles for velocities (V) lower than the maximum are simply truncated versions of the maximum velocity profile. The truncated velocity profiles may produce ringing at inflection points, as shown. Alternatively, a plurality of nonlinear velocity profiles similar to the velocity profile for V MAX illustrated in Fig. 1b may be derived for several selected velocities and stored. This system requires substantial memory capability, however, and it may not be suitable for applications requiring a large number of programmed velocity profiles. U.S. Patent 4,648,026 teaches a microprocessor stepper motor drive which utilizes a single acceleration/deceleration motion profile regardless of the final velocity and/or position of the device being driven. The acceleration/ deceleration motion profile is stored in a storage device and added to the desired final velocity to produce smooth velocity profiles corresponding to selected desired velocities, as shown in Fig. 1c. Although the non-linear velocity profiles of the types shown in Fig. 1c are satisfactory for some systems, overshoot, ringing and acoustic noise remain problematic for high precision, rapidly cycling systems such as rotational indexing of a print drum and associated print substrate during operation of ink jet printers. Such applications require quiet, rapid and accurate movement to provide high quality printed products. The methods and apparatus of the present invention are thus directed to the derivation and implementation of motion profiles that provide quiet, rapid and precise rotational indexing of one or more masses driven, for example, by a stepper motor. It is known from US-A-4792737 to control the motion of an object in response to external motion commands by measuring the position of the object, estimating the velocity of the object by means of an estimating circuit, and feeding back the estimated velocity signal to the input of a power amplifier driving a motor to control the motion of the object. The estimating circuit embodies a Kalman filter using knowledge of the ratio of torque constant to the moment of inertia of the motor and load. It is known from US-A-4,764,871 to use an estimating circuit to derive a low distortion signal from the output of a rotational speed transducer, the estimating circuit comprises a Kalman filter in which a Kalman amplification factor embodies a state estimation model of the transducer. Summary of the Invention The present invention provides a method and system for deriving and implementing motion profiles that govern the movement of one or more masses, such as a printer drum as it is indexed along a rotational path by a stepper motor. A mathematical approach using Kalman controllability is used to generate a continuous desired motion profile for a particular set of system parameters over time. The Kalman controllability formulation provides an input function that can be implemented to provide the desired motion profiles. These desired motion profiles describe movement of an initially stationary system having one or more masses driven by a common drive to a new position, so that all of the masses arrive at the new location with zero velocity. Moreover, for drive systems including timing belts the final positions of the masses can be made consistent with the timing belt ratios, and no residual strain energy is stored in the belts after the desired movement stops. The input function provided by the Kalman controllability formulation is implemented by generating a step motion profile that approximates to the input function,this step motion profile being, preferably, a microstep motion profile generated, for example, by microstepping a stepper motor. Simulated and actual system performance of particular embodiments of the invention have demonstrated that a multiple mass system operated using motion profiles approximating the desired motion profiles moves quietly and stops accurately, even during rapid operation. Furthermore, implementation of the methods and apparatus of the present invention in certain stepper motor systems, has additionally improved the robustness of the stepper motor and reduced operational problems resulting from the motor stalling or losing steps. Consequently, printers that use stepper motors and employ a motion profile derived in accordance with the present invention can be designed to exhibit enhanced print quality and decreased print time, and, moreover, generate significantly less acoustic noise. Brief Description of the Drawings The invention will be best understood by reference to the following more detailed description of a non-limiting example, read in conjunction with the accompanying drawings, in which: Fig. 1(a) shows a graphical representation of a prior art linear acceleration/deceleration profile; Fig. 1(b) shows a graphical representation of prior art non-linear acceleration/deceleration profiles optimized for V MAX ; Fig. 1(c) shows a graphical representation of prior art acceleration/deceleration profiles having generally the same characteristics for two selected velocities; Fig. 2 shows a schematic representation of a drive system for rotationally indexing a mass such as a printer drum; Fig. 3(a) is a schematic diagram illustrating the technique of microstepping; Fig. 3(b) shows, schematically, the correspondence between microstep input pulses and motor drive microsteps; Fig. 4 illustrates a mathematical model of the drive system dynamics for a system with three masses as shown in Fig. 2; Fig. 5 shows an illustrative input function derived using the Kalman controllability formulation according to methods of the present invention; Fig. 6(a) shows an ideal motor position profile corresponding to the input function of Fig. 4; Fig. 6(b) shows an ideal motor velocity profile corresponding to the input function of Fig. 4; Fig. 7(a) shows an ideal print drum position profile corresponding to the input function of Fig. 4; Fig. 7(b) shows an ideal print drum velocity profile corresponding to the input function of Fig. 4; Fig. 8 illustrates a graphical representation of motor drive microsteps used in a numerical integration simulation of the motion of the three mass system shown in Figs. 2 and 4; Fig. 9(a) shows the numerical integration simulation for motor position corresponding to the ideal motor position profile of Fig. 6(a); Fig. 9(b) illustrates the numerical integration simulation for motor velocity corresponding to the ideal motor drive velocity profile shown in Fig. 6(b); Fig. 10(a) illustrates the numerical integration simulation for print drum position corresponding to the print drum position profile shown in Fig. 7(a); Fig. 10(b) shows the numerical integration simulation for print drum velocity corresponding to the print drum velocity profile shown in Fig. 7(b); Figs. 11(a) and 11(b) show oscilloscope photographs illustrating an actual print drum position profile and stepper motor current wave form over time, respectively, generated using a motor input approximating the ideal motion profile derived according to the present invention. Detailed Description of Preferred Embodiments The methods and systems of the present invention are described herein with reference to the rotational indexing of a print drum connected, by means of a timing belt and idler pulley, to a stepper motor. Although the methods of the present invention are well suited to this type of drive system, they are not limited to this application. Methods of the present invention may be utilized to generate and implement motion profiles for any system wherein one or more masses are driven by a common drive means. Figure 2 illustrates a conventional motor drive system to which the present invention may be applied, the illustrated drive system being for rotating a print drum during printing operations. Motor drive 10 is preferably a two phase stepper motor. A two phase stepper motor may be controllably rotated by applying a sequence of current magnitudes to each motor phase. A typical stepper motor generates about two hundred whole steps per revolution. Whole stepping is therefore a relatively crude method of driving a motor when precise motor movements are required. The technique known as microstepping facilitates more precise motor control by providing hundreds or thousands of positions per revolution. More specifically, input pulses are communicated to a microstep current driver which directs the advance of the phase currents of both phases of the motor by one microstep, as illustrated schematically in Fig. 3(a). For purposes of the present implementation of the invention, a microstep current driver generating eight hundred (800) microsteps per revolution was utilized. The phase current advance therefore resulted in one eight-hundredth of a revolution per input pulse. The timing of these input pulses determines the motion profiles of the system, as schematically illustrated in Fig. 3(b). Systems implementing the present invention preferably employ an open loop control system and do not require more complex, closed loop control features. Thus, motor 10 is preferably controlled in open loop manner by a microprocessor (not shown) that can be programmed to start and stop the motor, as well as to implement desired motion profiles. The microprocessor controls the precise timing between microstep pulses. More specifically, a position v. time history can be generated by summing the microstep pulses, as shown schematically in Fig. 3(b). The three individual masses in the system illustrated in Fig. 2 are connected by means of flexible members, such as timing belts. Motor rotor 12 is connected via timing belt 14 to idler pulley 16, and idler pulley 16 is connected, via timing belt 18, to drive pulley 20 rigidly mounted on print drum 22. The gear ratio of the timing belt drive is adjusted so that one whole step at the stepper motor rotor corresponds to one pixel at the drum surface. For the purposes of the present invention, the timing belts may be modelled as elastic springs arranged in parallel to damping elements, such as dashpots, as shown in Fig. 4. Use of such a model captures the elastic properties as well as the energy dissipation properties of the timing belt. The position of each of the masses after the entire zero velocity position to zero velocity position movement must be consistent with that of the other masses and with the gear ratio of the timing belts, so that no energy is stored in the belts as a result of rotational indexing. If this position/gear ratio consistency is lacking, the belt will be stretched and will store strain energy. Release of the stored strain energy will disrupt the final zero velocity condition of the three mass system. Fig. 4 illustrates a mathematical model of the drive system dynamics for an exemplary system in which three masses - the motor rotor, the idler pulley and the print drum - are moved from one position to another. T A is the torque applied to the first mass, the rotor, by the motor. The first mass has a mass moment of inertia J 1 and the rotary position of the rotor is represented by  1 in the time domain. The second mass, the idler pulley, has a mass moment of inertia J 2 , torque T 2 , and its rotary position is represented by  2 in the time domain. The third mass, the drum, has a mass moment of inertia J 3 , a frictional torque T F , and its rotary position is represented by  3 in the time domain. B 12 and B 23 represent internal damping in the flexible belts between the rotor and idler pulley and the idler pulley and print drum, respectively. B 1 , B 2 and B 3 represent viscous damping to ground of each mass, respectively. N 12 and N 23 represent frictionless gear ratios for each timing belt, and K 12 and K 23 represent the elastic coefficients for each timing belt. Equations of motion were written for each of the masses in the system based upon the following assumptions: (1) the system is frictionless, except for viscous damping represented by B 12 and B 23 , viscous damping represented by B 1 , B 2 and B 3 , and coulomb frictional torque T F ; (2) belts can be modelled by an elastic coefficient K and viscous damping parameter B combined with a frictionless gear ratio N; and (3) motor command angle  is changed instantaneously. The equations for rotary motion of the motor rotor, the idler pulley, and the print drum are as follows: where  represents position,  ˙ represents velocity; and represents acceleration, all in the time domain. The above equations can be rewritten to eliminate ' 1 and ' 2 (mass position adjusted for timer belt gear ratio) using the equalities ' 1 =  1 N 12 and ' 2 =  2 N 23 as follows: Viscous damping for the second mass, the idler pulley in the system illustrated in Fig. 2, was negligible and was therefore dropped from the system motion equations. In order to generate an optimum motion profile for a system of the type illustrated in Fig. 2, the following conditions are preferably satisfied by the three mass system: (1) All three masses must have zero velocity at the initial and final time points; (2) The motor motion profile (position v. time) is monotonic; (3) The final positions of the three masses are consistent with their gear ratios to prevent storage and release of strain energy. The second condition is not a prerequisite for all motion systems, but it may be critical for particular applications. Using the mathematics of state variable dynamics, a linear system of differential equations may be represented as a dynamic, linked system by a set of first order differential matrix equations. For the equations of motion of a multi-mass system, the dynamic equation is as follows: x (t)=A·x(t)+B·u(t) In this equation, x(t) is the generalized state vector for the system where suitable choices of states are the positions and velocities of each of the masses. Thus, the following six states are required to describe a system involving movement of three masses at any time: x 1 =  1 x 2 =  ˙ 1 x 3 =  2 x 4 =  ˙ 2 x 5 =  3 x 6 =  ˙ 3 Also, u(t) is the input to the system which corresponds to the input profile to the microstep driver. The derivative of the state at any given time, designated x ˙(t), is therefore a function of the system matrix A, the state vector x(t), an input matrix B and an input scalar u(t). Such a dynamic equation is useful if the system behaves linearly or may be approximated as such. The linearity restriction of the state variable approach also requires that T F at the drum be approximated by B 3 , a viscous damping coefficient. The following mathematical equation, based upon the Kalman controllability formulation, expresses the continuous input function u(t) required to transfer a system from an initial state x 0 = x(t 0 ) to a desired state x 1 = x(t 1 ) as follows: u (t) = -B t Φ t (t 1 -t) k -1 [Φ(t 1 -t 0 )x 0 -x 1 ] where k and is a matrix expressed as follows: and Φ (t)=e At is the matrix exponential of A. The variables in the above equation are as follows: x 0 = initial condition vector x 1 = final condition vector A = the system matrix, a 6 x 6 matrix in the exemplary, three mass embodiment B the input matrix t 0 = initial time point prior to transfer t 1 = final time point after transfer t = time q is a dummy variable representing time for integration purposes superscript t is the matrix transpose ( e.g. , B t ) superscript -1 indicates the inverse of a matrix ( e.g. , k -1 ) A, the system matrix, uses the motion equations of the three system masses and is derived and defined as follows: X 1 =  1 ; X 2 =  1 ; X 3 =  2 ; X 4 =  2 ; X 5  3 ; X 6 =  3 Therefore, X 1 = X 2 ; X 3 = X 4 ; X 5 = X 6 X 2 = -K 12 X 1 J 1 N 12 2 + K 12 X 3 J 1 N 12 - B 12 X 2 J 1 N 12 2 + B 12 X 4 J 1 N 12 + T A J 1 - B 1 X 2 J 1 X 4 = K 12 X 1 J 2 N 12 - K 12 X 3 J 2 + B 12 X 2 J 2 N 12 - B 12 X 4 J 2 - K 23 X 3 J 2 N 23 2 + K 23 X 5 J 2 N 23 - B 23 X 4 J 2 N 23 2 + B 23 X 6 J 2 N 23 X 6 = K 23 X 3 J 3 N 23 - K 23 X 5 J 3 + B 23 X 4 J 3 N 23 - B 23 X 6 J 3 - B 3 X 6 J 3 The A matrix can then be expressed as follows: The dynamic equation then becomes: B, the input matrix, is expressed above. The non-zero value in the B matrix indicates that the input acts on the motor mass of the three mass system. An expression was then developed for the applied torque, T A . In general, for a locked rotor of a stepper motor, T = T H sin50, where T H is the peak holding torque for the prevailing current in the motor, and  is the motor command angle. In the system illustrated in Fig. 4, both the command angle  and the rotor position  1 are variable. The applied torque, T A , is therefore expressed as follows: T A = T H sin50(- 1 ). As such, T A introduces non-linearity into the system. If the value of - 1 is small enough, however, sin50(- 1 ) is approximately equal to 50(- 1 ). For example, if - 1 is 0.003 radians, sin50(- 1 ) is 0.149, and 50(- 1 ) is 0.150. For small or negligible differences -, the system behaves in a manner approximating a linear system. The continuous input function, u(t), was determined for a system of the type shown in Fig. 3. Values for system constants were as follows: J 1 = 1.425 x 10 -4 lb-in-sec 2 ; J 2 = 1.441 x 10 -3 lb-in-sec 2 ; J 3 = 5.042 x 10 -2 lb-in-sec 2 ; N 12 = 5.333; N 23 = 5.626; K 12 = 2.676 x 10 4 lb-in rad ; K 23 = 2.676 x 10 4 lb-in rad ; B 12 = 1.469 lb-in-sec rad ; B 23 = 1.469 lb-in-sec rad T H = 3.397 lb-in; B 1 = 6.687 x 10 -3 lb-in-sec rad ; and B 3 = 1.0 lb-in-sec rad ; The total motion time interval was set at 0.35 sec. The A and B matrices were as set forth above. The beginning and end position points were defined as follows: x 0 = [1 0 0 0 0 0 0] x 1 = [0.503 0 0.0942 0 0.0168 0] The x 11 , x 13 , and x 15 values are consistent with the values for the frictionless gear ratios N 12 and N 23 , as required. These values are first used to derive the continuous input function u(t) capable of driving the system from x 0 to x 1 . The continuous input function derived using these values is shown in Fig. 5. The Kalman controllability formulation for a continuous input u(t) is then implemented using MATLAB software available from The Math Works Inc., 21 Elliot Street, South Natick, MA 01760. The analysis uses the equation: to determine the position and velocity profiles of the masses corresponding to the input function u(t). The ideal motor position and velocity profiles derived using this equation are shown in Figs. 6(a) and 6(b), respectively. The intermediate idler position and velocity profiles are substantially the same as those for motor position velocity, except that the values are reduced as a result of the gear reduction. The ideal print drum position and velocity profiles are shown in Figs. 7(a) and 7(b). These plots demonstrate that each mass would reach zero velocity at the end time point, .035 sec. Using the ideal position and velocity profiles generated as described above, the actual delay lengths of microstep input pulses were apportioned to match the ideal profiles. Curve fitting the ideal motor position and velocity profiles shown in Figs. 6(a) and 6(b) is therefore a major factor in the choice of microstep delay times to serve as input in a numerical integration simulation of three mass system motion. Additionally, the difference between the motor command angle  and motor position Θ is preferably monitored and maintained as small as possible, consistent with the ideal position and velocity profiles. Derivation of the actual microstep input pulse delay lengths by curve fitting, for example, may be accomplished in any convenient manner. A numerical integration simulation of the differential system motion equations was conducted using the Continuous System Modelling Program (CSMP), available from California Scientific Software. The system constants used in the numerical integration were as described above for ideal input and motion profile generation, with the addition of T S , the microstep timing constant having a value of 6.25 x 10 -5 seconds. Also, since numerical integration simulations are not limited to linear systems, physical constants were developed to describe the influence of coulomb friction on the three mass system and were incorporated in the simulation. The controlling parameter for the friction effects was the sign of the velocity of the mass upon which the frictional torque is acting, X 3 (t). The frictional force applied for positive velocities, shown for T F in Fig. 4, was valued at 2.4 lb-in. The frictional force for negative velocities was valued at -2.2 lb-in. The frictional force acting when the mass is at rest was valued at 2.4 lb-in. These four parameters were input into a function switch function of the CSMP system to generate a value for the frictional torque, T F . Fig. 8 shows the simulated motor input microsteps; Figs. 9(a) and 9(b) show the simulated motor position and velocity profiles especially; and Figs. 10(a) and 10(b) illustrates the simulated drum position and velocity profiles based upon the motor input illustrated in Fig. 8. The ideal motor position profile generated using the Kalman controllability formulation illustrated in Fig. 6(a) corresponds closely to the motor profile generated using the numerical integration simulation shown in Fig. 9(a) that is based upon the microstep delay times illustrated in Fig. 8. The microstep delay times approximating the ideal motor profile of Fig. 4a, x theoretical versus t, were implemented as microstep impulse inputs to a three mass system as illustrated in Fig. 2. Oscilloscope photographs of the drum position v. time performance and the current wave form in one motor phase are presented in Figs. 11(a) and 11(b). The actual drum position profiles shown in the oscilloscope photographs for a three mass system of the type illustrated in Fig. 2 corresponds closely to both the ideal and simulated profiles. The system implementation resulted in smooth drum motion without ringing or overshoot at the inflection points. Moreover, the system produced significantly reduced audible noise. Although methods and systems of implementing the present invention have been described with reference to a three mass system for driving a print drum, it will be obvious that the methods may be applied to generate motion profiles for a wide variety of systems requiring precise movement of system components from one state (position) to another.

Claims: A method of driving a system comprising at least one mass (12, 16, 22) in accurate incremental movements, an incremental movement being effected by driving the system between a first zero velocity location (x(t 0 )) and a second zero velocity location (x(t 1 )) utilising a single drive means (10), which method comprises:- (a) deriving a model of the system as first order differential equations of motion (x ˙ = A · x(t) + B · u(t)) describing the motion of the at least one mass; (b) calculating a continuous ideal input profile (u(t) = -B t Φ t (t 1 -t) k -1 [Φ(t 1 -t 0 )x 0 -x 1 ]) based on the Kalman controllability matrix derived from the equations of motion; (c) deriving a step motion profile (Fig 8) approximating to the ideal input profile; (d) driving the system by inputting to the drive means a pulsed drive signal to drive the system in a series of steps corresponding to the step motion profile to complete the incremental movement; and (e) repeatedly driving the system between successive zero velocity locations in accordance with the step motion profile to effect successive accurate incremental movements. A method as claimed in claim 1, wherein the step motion profile is a series of microsteps of equal magnitude constituting a microstep motion profile. A method as claimed in claim 2, wherein the drive signal is generated by choosing appropriate microstep delay times. A method as claimed in any preceding claim, wherein the system comprises a plurality of masses and wherein the ideal input profile is calculated such that each mass reaches its respective second zero velocity location at the same time. A method as claimed in claim 4 wherein the drive means is operatively connected to a single one of the masses. A method as claimed in any preceding claim wherein the system comprises three masses. A method as claimed in claim 6, wherein the three masses comprise a motor rotor of the drive means, an idler pulley, and a print drum of a printer, and wherein incremental movements incrementally advance a print substrate carried by the print drum. Apparatus for use in a method of any preceding claim and comprising said drive means (10) and a control means (fig. 3a) connected to said drive means wherein the control means is operable to output to said drive means the drive signal consisting of a series of pulses effecting stepped movement of the drive means corresponding to the step motion profile. Apparatus as claimed in claim 8 comprising a system of three masses interconnected by two flexible connecting means (14, 18), wherein the masses and connecting means are configured to prevent storage of residual energy in the connecting means. Apparatus as claimed in claim 9, wherein the three masses comprise a motor rotor (12) of the drive means, an idler pulley (16), and a print drum (22) of a printer. Apparatus as claimed in any of claims 8 to 10, wherein the drive means comprises a two-phase stepper motor (10) controlled by said control means for microstepping to produce said steps as microsteps.

Inventors: BURKE EDWARD F, BURKE, EDWARD F.
Applicants: TEKTRONIX INC, TEKTRONIX, INC.
Application year: 1992
Main classification: G05B19
IPC codes: G05B19, G05D3, G05B13