Note: Descriptions are shown in the official language in which they were submitted.
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505
-1-
LEARNING PROGRAMMABLE LIMIT SWITCH AND
METHOD PROVIDING REAL-TIME PASSIVE FEEDBACK
Backclround of the Invention
1. Field of the Invention
5 This invention relates to a learning programmable
limit switch and, more particu:Larly, a motion system
which utilizes a learning programmable limit switch to
provide real-time passive feedback for a controller to
control the operation of a drive system in accordance
with a user-programmed motion profile.
2. Brief Description of the Related Art
In the field of motion control systems, pressure
transducers can be applied to control the ON/OFF state of
external circuits. Such a system monitors position and
15 sets or resets one or more outputs at predefined
positions or "setpoints." The mechanisms controlled by
this system usually have a constant delay from actuation
to the desired mechanical reaci:ion. An offset can be
added to the transducer position in order to activate the
20 output circuit before its actual setpoint has been
reached to compensate for this mechanical delay. As the
velocity of the mechanical sysi~em increases, the time
added by such a positional offset decreases. Therefore,
a larger proportional offset is needed to offset for the
25 same mechanical delay at higher speeds. In many
mechanical systems the delay for mechanism activation is
different from the delay for the deactivation of the
mechanism. This requires two different positional
offsets for delay compensation. When the circuit is OFF
30 an ON offset is used, arid when the circuit is ON an OFF
offset if needed.
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505
-2-
Usually such a system is implemented in software
by a microcontroller. The microcontroller reads the
transducers at fixed time intervals and calculates
velocity. The microcontroller computes the offsets based
on the calculated velocity and adds these offsets to the
position. The microcontroller compares this offset
position to a table of ON/OFF positions. The table entry
specifies the desired output state. The microcontroller
can control many circuits from one position reading.
This position typically corresponded only to a stop
position. Typically, the microcontrollers could not
operate at high speeds o~ with many simultaneous
controlled circuits.
Motion control system of the past oftentimes had
difficulty handling environmental changes. For example,
in a pallet shuttle system which shuttles a pallet
between a first station and a second station, the shuttle
system drives the pallet, for example, from a first
station at a high speed until it reaches the second
station, whereupon the pallet system slows to a slower
speed until finally it is brought to a complete stop at
the second station.
During a manufacturing process, it is desirable
to minimize the overall cycle time it takes to shuttle
the pallet between theses stations. When the motion
system was "cold", the time associated with the
transition between the high to low speeds and the low
speed to stop was very short. However, as the motion
system warmed up, the duration. of this time period would
tend to increase, thereby causing the pallet to
"overshoot" the desired stopping point and/or point at
which the slow speed was suppo~ee to occur. Consequently,
it was required to make manual adjustments to the system
so that the pallet would be shuttled as desired.
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505
-3-
Similarly, as the system cooled down, the time
required to transition between speeds was less which
would result in the pallet "undershooting" the points
corresponding to when the user desired the pallet to
5 begin to be driven at the slow speed or hit the stop
position.
U.S. Patent 5,227,965 issued to Klaes et al. and
assigned to Magnetek Controls of Clawson, Michigan
illustrates the use of a programmable limit switch which
10 employs high speed special purpose hardware and a general
purpose microcontroller to achieve high speed limit
switch operation. A state sequencer controls the high
speed special purpose hardware in a fixed sequence. The
states sequencer latches posit3_on data, and recalls
15 position offsets from a memory,. A hardware digital adder
sums the position and offset with this summed offset
position used as an address in output tables for
selecting an output status word. The microcontroller
operates asynchronously with respect to the state
20 sequencer. The microcontroller initializes and updates
the memories. The microcontroller calculates the
velocity from repetitive position signals and writes the
corresponding window offsets to memory. A selection
circuit picks out the status bit of the particular output
25 circuit. The outputs are shifted together and latched to
the output drivers.
Unfortunately, this system and other motion
systems of the past could only accommodate for a stop
position. They did not automatically adjust during real
30 time operation of the motion control system utilizing
sensed feedback corresponding to the motion of, for
example, an output shaft of the drive system to learn and
adjust to provide real time passive feedback to the
controller based upon position information.
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505
-4 -
. Another problem with systems of the past is that
they were utilized to detect velocity only and typically
provide a velocity offset so that only a stop position
would be properly achieved.
Summary of the Invention
It is, therefore, an object of the invention to
provide a real-time, learning programmable limit switch
for providing passive feedback for accurately controlling
movement in accordance with an user-programmed motion
profile .
Another object of the :invention is to provide a
passive feedback system which will accurately monitor,
control and "learn" not only a stop position, but
transition positions between, for example, a first speed
or velocity and a second speed or velocity.
Still another object o:E the invention is to
provide a learning programmable limit switch which
accounts for more than a single speed or position
application which only accommodates for a stop position
20 and which "learns" the offsets for transition points
associated with transitions between speeds, as well as
any. desired stop positions.
In one aspect, this invention comprises a method
of providing passive feedback :Eor controlling a drive
25 system comprising the steps of providing a programmable
switch for facilitating controlling the operation of the
drive system, programming the programmable switch with a
first programmed setpoint corresponding to a first
position of the drive system, a second programmed
30 setpoint corresponding to a second position of the drive
system, a first initial trigger point corresponding to
when the drive system performs a first change from a
first speed to a second speed, and a second initial
trigger point corresponding to when the drive system
CA 02336008 2000-12-22
WO 99!67691 PCTlUS99/13505
_S_
performs a second change from the second speed to a third
speed, energizing the drive system, using said first and
second initial trigger points to effect the first and
second changes, respectively, determining a first actual
5 setpoint corresponding to a first actual position and a
second actual setpoint corresponding to a second actual
position, comparing the first :programmed setpoint to the
first actual setpoint and the second programmed setpoint
to the second actual setpoint and adjusting at least one
10 of the first initial trigger point or the second initial
trigger point to provide an adjusted first trigger point
or an adjusted second trigger point, respectively, in
response to the comparison, and repeating the energizing,
triggering, determining and comparing steps and if the
15 first and second actual setpoints are not within a
predetermined tolerance range of the first and second
programmed setpoints, respectively, then repeating the
adjusting step.
In another aspect, this invention comprises a
20 process for providing passive feedback to facilitate
maintaining a cycle time in a motion control system
comprising the steps of providing a programmable switch
capable of receiving a motion profile associated with a
driver, determining an actual motion profile associated
25 with the driver, comparing the actual motion profile to
the motion profile, and adjusting outputs of the
programmable switch in response to the comparing step
such that the cycle time is achieved and maintained.
In still another aspect, this invention
30 comprises, a programmable limit switch for providing
passive feedback for use in a drive system comprising a
driver under the control of a controller having a
position indicated device associated therewith for
providing a first position count and a second position
35 count, the switch comprising programming means for
CA 02336008 2000-12-22
WO 99l6769I PCT/US99lI3505
-6-
receiving a first programmed setpoint corresponding to a
first position of the drive system, a second programmed
setpoint corresponding to a second position of the drive
system, a first initial trigger. point corresponding to a
5 first position at which the drive system performs a first
change from a first speed to a second speed, and a second
initial trigger point corresponding to a secand position
at which the drive system perfarms a second change from
the second speed to a third speed, determining means for
10 determining a first actual setpoint corresponding to the
first position count generated by the position indicating
device and a second actual setpoint corresponding to the
second position count generated by the position
indicating device, and learning means for comparing the
15 first programmed setpoint to the first actual setpoint
and the second programmed setpaint to the second actual
setpoint, for adjusting at least one of the first initial
trigger point or the second iniaial trigger point to
provide an adjusted first trigger point or an adjusted
20 second trigger point, respectively, in response to the
comparison so that the first arid second actual setpoin.ts
are within a predetermined tolerance range of the first
and second programmed setpoints, respectively.
In yet another aspect, this invention comprises a
25 drive system capable of mainta9.ning a cycle time
comprising a motion control system comprising a position
indicated device associated with a driven driver, the
position indicating device being capable of generating a
plurality of detected position counts, a programmalale
30 controller capable of receiving a desired motion profile
for the driven driver and for determining an actual
motion profile using the plurality of detected position
counts, and a processor for comparing the actual motion
profile to the motion profile and also for adjusting
35 outputs of the programmable controller in response to the
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/I3505
_7_
comparison such that the cycle time is maintained at a
desired level.
Other objects and advantages of the invention
will be apparent from the following description, the
5 accompanying drawings, and the appended claims.
Brief Description of Accompanyinct Drawings
Fig. 1 is a schematic diagram of a motion system
comprising a learning programmable limit switch in
accordance with one embodiment of the invention;
10 Fig. 2 is an illustration of another embodiment
showing the use of the learning programmable limit switch
in a typical motion control environment;
Fig: 3 is a schematic .illustration of the
learning programmable limit switch in accordance with one
15 embodiment of the invention;
Fig. 4 illustrates a plurality of illustrative
timing diagrams for various components of the system
shown in Fig. 3;
Fig. 5 is a waveform of a user-programmed motion
20 profile which is used for illustration;
Fig. 6 i:s a schematic illustration of a learning
procedure and method in accordance with one embodiment of
the invention;
Figs. 7A-7C, taken together, provide a schematic
25 illustration of the method and procedure for achieving.
the learning function in accordance with one embodiment
of the invention;
Figs. 8A-8D provide a plurality of waveforms and
outputs of a controller, learning programmable limit
30 switch.and actual motion achieved by the system and
method of the present invention, providing an
illustration of an "overshoot" and subsequent learning
adjustment in accordance with one embodiment of the
invention; and
CA 02336008 2000-12-22
WO 99/67b91 PCT/US99/13585
_ g ._
Figs. 9A-9C provide another waveform illustration
of the procedure and method of learning similar to Figs.
8A-8D, illustrating the procedure and routine for
providing learning adjustment.
Detailed Description of Preferred Embodiments
Referring now to Fig. 1, a drive system 10
comprising a processor or controller 12 which controls
the operation of a drive mechanism, drive means or driver
14 which, in turn, drives a driven mechanism l6, such as
a transfer drive (not shown), a lift table (not shown),
an indexing mechanism (not shown) or an indexing table
(not shown).
The drive system 10 further comprises a learning
programmable limit switch 18 which is coupled to drive
mechanism 14 and which provides passive feedback to
controller 12 in the manner described below.
Fig. 2 illustrates one embodiment of the
invention shown in Fig. 1. In this embodiment, like
parts are identified with the same part numbers, except
that the parts in Fig. 2 have a prime number (""') added
thereto. In the embodiment being illustrated in Fig. 2,
the learning programmable limit switch 18' is coupled to
an output shaft 20' of drive mechanism 14'. By way of
illustration, the shaft 20' is drivingly conventionally
coupled to driver mechanism 16' to move in the direction
of double arrow A in Fig. 2.
In general, the output signals 18a and 18c (Fig.
4) generated by the programmable limit switch 18' are
enabled (i.e., turned on or off) based upon the detected
angular position of the output s~.aft 20'. These outputs
are received by controller 12' which energizes the drive
mechanism 14' in response thereto. The programmable
limit switch 18' is user-programmed to receive a desired
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505
-9-
user motion profile 40 (Fig. 5). The method and routine
executed by the programmable limit switch l8' for
generating the outputs is described later herein.
Fig. 3 shows details of the programmable limit
5 switch 18'. Notice that the programmable limit switch
18' comprises an encoder housing 22' (Fig. 3) for housing
a portion of the output shaft ;20' and an encoder 24'
which generates a timing signal 24a (Fig. 4) based upon
the detected angular position of the output shaft 20' in
10 a manner conventional3y known. In the embodiment being.
described, the encoder 24' may be an absolute optical
encoder, such as Model No. 25H1V-lOCB-ELS-5V-HI-D2-B1-TX-
B-F-51441 available from Sequential Electronic System of
Elmsfield, New York, but it should be understood that
15 other types of position detecting sensors may be used.
The programmable limit switch 18 (Fig. 3) further
comprises a processor module 26, such as Model No. 368-1-
1884 from Cycledynamics, Inc. of Fairfield, Ohio which is
coupled and responsive to encoder 24 and which is coupled
20 to a power supply 28 fox providing power to the processor
module 26. In the embodiment being described, the power
supply 28 may be Model No. ST25A5C55 available from
Convertors Concepts, Inc of Pardeeville, Wisconsin.
The processor module 26 is also coupled town
25 input/output module 30, such a;s Model No. 368-1-1876
available from Cycledynamics of Fairfield, Ohio. The
power supply 28 is coupled to a female connector 36, such
as a Brad Harrison Model No. 43007 available from Daniel
Woadhead Company of Northbrook, Ill. The input/output
30 module 30 is coupled to a male connector 38, such as a
Brad Harrison Model No. 42605 which is also available
from Daniel Woodhead Company o:E Northbrook, I11.
A serial communications link 32 couples the
processor module 26 to a IBM compatible personal computer
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505
-lo-
34 so that the system may be easily programmed, monitored
and controlled.
Fig. 4 shows various timing diagrams which
illustrate the various correlation among the outputs of
5 encoder 24, programmable limit switch 18 and controller
12, as well as the resultant motion of the driven
mechanism 16, such as the transfer driver 16' in the
illustration shown in Fig. 2. For ease of illustration,
each encoder count occurs at approximately every degree.
10 Initially, controller :12 energizes drive system
14 using signals 12a and 12c. This causes drive
mechanism 14 to drive the driven mechanism 16 at a first
or high speed, V1. In the embodiment being illustrated,
the programmable limit switch monitors the output of
15 encoder 24 and generates an output signal 18a which
comprises a high to low disenable step-or trigger at
point 18b which, in turn, causes the controller 12 to
disenable the high speed signal ~12a at point 12b as
shown.
20 The corresponding actual motion profile of the
motion of the driven mechanism 16 is illustrated by the
waveform 16a. Notice that at point 16b the driven
mechanism 16 is accelerated until it achieves the first
or high speed, V1 at point 16c which continues for a
25 first period of time T1. Notice that at point 18b, the
switch 18 generates a disenable signal in response to the
encoder count achieving 175 degrees which is received by
controller 12 which generates .a disenable in response
thereto at point 12b which causes the controller 12 to
30 disenable the high speed signal at point 12b. Thus, at
point 16d and after the controller 12 generates the
disenable at point 12b, the drive mechanism 14 causes the
driven mechanism 16 to begin decelerating. Notice that
the output 18c from switch 18 remains enabled which
35 causes controller l2 to generate and output a low speed
CA 02336008 2000-12-22
WO 99/6'7691 PCT/US99/13505
-11--
signal 12c at point 12d which energizes drive mechanism
14 to drive the driven mechanism 16 at a second ar slower
speed V2 at point 16e.
The second speed or slower speed or velocity V2
which begins at point 16e in the motion profile l6a and
continues for a period T2 until programmable limit switch
18 disenables the low speed forward signal 18c at point
18d. In response to this dise:nable, controller
disenables its output 12c at point 12e as shown.
10 Notice in the motion profile 16a that between
points 16d and 16e the drive mechanism 14 is causing the
driven mechanism 16 to change from the first or high
speed ar velocity V1 to the second speed or velocity VZ
which begins at point 16e in Fig. 4. Time T3 shows the
15 corresponding period of time that it takes to cause the
drive mechanism 14 to slow the driven mechanism 16 from
the first speed or velocity V1 to the second speed or
velocity V2. Likewise, the time period T4 corresponds to
the period of time in which it takes the drive mechanism
20 14 to slow the driven mechanists 16 from the second speed
or velocity VZ to the third speed or velocity V3 which
begins at point 16g in Fig. 4.
In the illustration being described, the first
velocity or speed V1 is on the order of about 100 RPM,
25 the second speed or velocity V., is on the order of about
RPM and the third velocity 'iT3 is zero. However, the
programmable limit switch 18 may be used in any number of
speed applications such as a single speed, slow speed
start, as well as a multi-speed environment of the type
30 illustrated herein. It should be appreciated, that the
motion profile 16a of the driven mechanism 16 is merely
one example of a profile with which the programmable
limit switch 18 may be programmed.
It should be further appreciated from the
35 diagrams illustrated in Fig. 4 that after the controller
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505 ~
-12-
12 initiates energization of the drive mechanism 14 to
energize the driven mechanism :L6, the programmable limit
switch 18 tracks the angular motion, via the output of
encoder 24 which tracks the motion of the output shaft 20
5 (Fig. 2). The programmable limit switch 18 cycles its
outputs in the form of signals 18a and 18c based on the
motion profile 16a which correlates directly to the
movement of the driven mechanism 16. Thus, it should be
appreciated that when motion of output shaft 20' and,
10 therefore, driven mechanism 16 begins, encoder 24
generates the position count 24a corresponding to the
angular movement of the output shaft 20. The
programmable limit switch 18 u:~es the position count, as
well as the timing between position counts, to track the
15 motion profile 16a against a user-programmed motion
profile, such as the user-programmed profile 40
illustrated in Fig. 5.
As mentioned previously and in the manner
described later herein, the programmable limit switch 18
20 will provide a learned passive feedback in that if the
programmable limit switch 18 determines that the output
shaft 20 and, therefore, the driven mechanism 16 did in
fact properly follow the user-programmed motion profile
40 (Fig. 5), then it will continue generating the outputs
25 18a and 18c in their respective positions.
If, however, the programmable limit switch 18
determines that the motion profile of mechanism 16 did
not follow the user-programmed motion profile 40, then
programmable limit switch 18 wall adjust the turn off or
30 trigger positions of the enabling outputs 18b and 18d
(Fig. 4) until the operational characteristics of drive
system 10 and the proper positions at which the change
from V3 to VZ (point 16d) and Vz to V1 (point 16f ) are
"learned". This facilitates ensuring that the actual
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505 -
_13_.
motion profile 16a of mechanism 16 corresponds to the
user-programmed profile 40.
It has been found empirically that the actual
profile 16a may change due to various environmental
5 concerns, such as the temperature of drive mechanism 14.
A significant feature of the process and method of the
present invention is to maintain time period T2 at a
relatively consistent desired time, so that it does not
either shorten or lengthen the overall cycle time TS in a
10 manner which causes the driven mechanism 16 to
"undershoot" or "overshoot" its desired positions at
points 40a and 40b (Fig. 5). Thus, it should be
appreciated that the programmable switch 18 generates
outputs 18a and 18c which effect controller 12 outputs
15 12a and 12c, respectively. Then outputs, in turn, impact
the duration of the time periods Tl and T2 in a manner
which will cause the actual mol~ion profile 16 to achieve
the desired motion profile 40 (Fig. 5). Stated another
way, the programmable limit switch 18 will generate
20 outputs to account for undesired variations in the slope
of the lines between points l6d and 16e and points 16f
and 16g of the method motion profile 12 such that the
velocities at points 16e and 16g are the same as the
velocities programmed by the user at points 40b and 40a,
25 respectively.
The method and process of maintaining the cycle
time and providing the learned passive feedback for
controlling drive system 10 wi:l1 now be described
relative to Fig. 6 where encoder 24 generates the encoded
30 count or signal 24a (Fig. 4) in response to the rotation
of output shaft 20 (Figs. 2 and 3). Programmable limit
switch 18 will proceed to a profile detection routine at
block 46 (Fig. 6). If the encoder count signal 24a does
not change states, then a no-motion timeout will be
35 generated by processor 26. The no-motion timeout will
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13545
-14-
cause processor module 26 or switch I8 to proceed to a
correction flow routine (block 50) if, at decision block
48, it is determined that motion has been occurring. If
it has not, then the switch 18 continues in the main
5 processing loop 44. The main processing loop simply
spins in a tight loop in a manner conventionally known
waiting for serial data from the communication port or is
interrupted by an encoder status change or no motion
timeout.
10 For purposes of illustrating the profile
detection and correction flow routines, the setpoints
indicated by points 40b and 40a correspond to the points
at which output shaft 20 first begins the second speed or
velocity VZ and the third speed. or velocity V3. In the
15 illustration being described, the first and second
setpoints 40b and 40a are set ar programmed by the user
to be at 178 degrees and 180 degrees, respectively, as
shown in Fig. 5.
Before addressing the aforementioned routines, a
20 brief description of the data structure or array utilized
will now be discussed. In general, the routines utilize
two main data structures or arrays which are organized as
shown below. The first data structure is identified as
the action data structure. This action data structure
2S will be used in a circular array which contains data
organized as follows:
Action Data Structure: Used in a circular array
(hereinafter "action array") containing all of the
actions generated to control the motion of driver
30 mechanism 16 driven in accordance with the user-
programmed motion profiles) astpointa.
Averaged is the encoder count at which some action
~~Pasition Countlshould occur (i.e., outputs turn on or off)
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505
_15_.
Action Type Type of action (i.e., forward start, forward
single trigger, multi-trigger and the like
Outputs Value Which outputs should change for the averaged
position count
Next Action Pointer to the next action when cycling
Pointer forward through this array
5 Previous Pointer to the previous action when cycling
Action Pointer reverse through this array
The second data structure or array is identified
as the setpoint data structure or array. The setpoint
data structure will be used also in a circular array
10 containing data organized as follows:
Setpoints Data Structure: Used in a circular
array (hereinafter "setpointsarray") containing all of
the user-programmed motion profiles) setpoints.
Setpoint Position is the encoder count of a pre-programmed
15 Count user setpoint
Previous Averaged Queue containing a history of previous.
Position Count triggers for that setpoint. These
Queue entries are then used to generate an
average trigger that will be inserted
into an action entry within the action
array
Setpoint Entry Type of setpoint (e. g., forward setpoint
(correctable), forward_pls (non-
correctable) and the like)
20 Pointer to Action Pointer that points to the action within
Entry into Action the action array that corresponds to
Array that setpoint: Allows quick access to
action when a trigger correction is
required.
Next Setpoint Pointer to the next action when cycling
Pointer forward through this array
25 Previous Setpoint Pointer to the previous action when
Pointer cycling reverse through this array
CA 02336008 2000-12-22
WO 99/67691 PCTIUS99/13505
-16-
It should be noted that these two arrays are
cross-linked together by pointers to allow quick access
from the setpoint within the setpoints array to its'
corresponding action, or trigger, within the action
5 array. Although not shown, it should be appreciated that
data and arrays may be organized in other manners as
desired.
The profile detection :routine (block 46) will now
be described relative to Fig. '7A wherein encoder 24
10 generates the encoder signal, ;such as signal 24a in Fig.
4, at block 52. The routine continues to block 54 where
at least one encoder state change or interrupt is
generated and received by processor module 26. At block
56, the routine continues where processor module 26
15 responds to the state change or interrupt and reads a new
position count corresponding to the position of output
shaft 20 into a temporary memory location (not shown).
Processor module 26 proceeds to calculate (block
58) a velocity of output shaft using the time between the
20 new position count and a previous position count using
the following formula:
V = D ;
T
where V is an angular ~Jelocity of output shaft 20
25 at the new position count;
D is the angular distance in degrees traveled by
output shaft 20 between the new position count and the
previous position count; and
T is the time between the new position count and
30 previous position count.
At decision block 60, it is determined whether
the new position count is equal to the averaged position
count stored in the currently selected action array entry
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505
in memory (not shown). If it is equal, then the state of
the output signals 18a and 18c (illustrated in Fig. 4)
are changed based upon the outputs value stored in the
action array. Now move to the next action array entry in
5 the action array using the next or previous action
pointer based on the currently detected direction of
movement.
The routine proceeds to block 64 where processor
module 26 sets a plurality of flags if the calculated
10 velocity V is within the limits of the user-programmed
motion profile 40 (Fig. 5).
If the decision at decision block 60 is negative,
then the routine proceeds to block 66 where the new
position. count is stored as the current position count.
15 At decision block 68, processor module 26
determines if the second speed or velocity V2 is expected
to start occurring. If it is not, then the routine
proceeds to block 66 as shown. If it is, then processor
module 26 determines at decision block 70 whether the
20 second speed or velocity Vz is occurring at the new
position count by calculating and using an average of
velocities of a predetermined number of past velocities
within a velocity queue (not shown). If it is, then
processor module 26 sets flags (not shown) to confirm
25 that the user-programmed motion profile 40 (Fig. 5) was
detected properly and completely (block 72). This
procedure is done as a means to verify that the drive
system 10 has moved in accordance with the user-
programmed motion profile 40 (Fig. 5) and that the
30 correction algorithm then may be applied to this index.
The routine then proceeds to block 74 where
processor module 26 stores the new position count where
low speed was determined to occur into a "found low speed
position count" variable in memory (not shown).
35 Thereafter, the routine proceeds. to block 66 as shown.
CA 02336008 2000-12-22
WO 99/67691 PCT/US991I3505
-18-
If the decision at decision block 70 is negative,
then the velocity determined air the new position count is
saved into the velocity queue (not shown). Thereafter,
the routine proceeds to block 66 as shown. After the
velocity and the new position count are evaluated, the
new position count is stored ai: block 66 as the current
position count, the routine returns to the main loop
(Fig. 6).
As mentioned previously herein relative to Fig.
6, if no motion is detected at decision block 48, then
the processor module 26 performs a correction routine
(block 50 in Fig. 6) which begins at decision block 78
(Fig. 7B) where processor module 26 determines whether
the user-programmed profile 40, as represented by the
data in the setpoints array, was detected properly. If
it was, then the routine proceeds to block 80 where
processor module 26 locates user-programmed setpoints,
such as setpoints 40b and 40a in Fig. 5, within the
setpoints array. If the decision at decision block 78
was negative, then the motion profile was not detected
properly and the routine proceeds to decision block 82
which will be described later Inerein.
After block 80, processor module 26 uses the
current encoder count of encoder signal 24a as the actual
point 16g (Fig. 4) at which the drive mechanism 16
achieves the third speed or ve:Locity V3. If this
position equals the user-programmed setpoint 40a (Fig.
5), then the routine proceeds to decision block 86 as
shown. If, however; the decision at decision block 84 is
negative, then processor module 26 calculates a
difference between the actual position l6g (Fig. 4) and
the user-programmed position which corresponds to
setpoint 40a (Fig. 5) at block 88. The routine proceeds
to block 90 where processor module 26 applies the
calculated difference to the averaged position count or
CA 02336008 2000-12-22
WO 99/6769I PCT/US99/13505
-19-
trigger within the action array in order to generate a
new txigger count or position.
At block 92, the processor module 26 stores the
corrected or learned trigger for that motion index in a
5 previous averaged position count queue in the setpoints
array and proceeds to block 94. At block 94, processor
module 26 calculates a new average using a predetermined
number of triggers stored within the averaged position
count queue within the setpoints array and writes the
20 averaged trigger into the averaged position count within
the action array.
Thereafter, or if the decision at block 84 is
yes, then the routine proceeds to decision block~86 where
it is determined if the position at point 16e (Fig. 4) is
15 equal to the user-programmed position 40b (Fig. 5). If
it is, then the routine proceeds to block 87 (Fig. 7C)
where processor module 26 re-sorts the entire action
array based upon the averaged position count entry.
If the decision at decision block 86 is negative,
20 then processor module 26 calculates a difference between
the actual position 16e (Fig. 4) and the user-programmed
position which corresponds to setpoint 40b (Fig. 5) at
block 89. The routine proceeds to block 91 where
processor module 26 applies the calculated difference to
25 the averaged position count within the action array in
order to generate a new trigger count.
At block 96, the processor module 26 stores the
corrected or learned trigger for that motion index in a
previous averaged position count queue in the setpoints
30 array and proceeds to block 98. At block 98, processor
module 26 calculates a new average using a predetermined
number of triggers stored within the averaged position
count queue within the setpoints array and writes the
averaged trigger into the averaged position count within
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505 ~
-20-
the action array. Thereafter, the routine proceeds to
block 87 (Fig. 7C).
As mentioned previously herein, if the decision
at decision block 78 (Fig. 7B) is negative, .hen the
5 routine proceeds to decision block 82 (Fig. 7C) where
processor module 26 determines if part of the actual
motion profile 15a (Fig. 4) was detected properly. If it
was, then it is determined at decision block 100 (Fig.
7C) whether the second speed o:r velocity VZ has been
l0 learned. If part of this motion profile was not
detected, then processor modulE~ 26 clears all flags
(block 102) and the routine then returns to the main
program of Fig. 6.
If the decision at decision block 100 is
15 negative, then the routine proceeds to decision block 104
where processor module 26 determines if the stored low
speed velocities within the velocity queue are stable.
If the answer is yes, then the routine proceeds to block
106 where processor module 26 stores the average of low
20 speed velocity queue into a suitable buffer (not shown).
At block 108, the processor module 26 sets a learned low
speed velocity flag. Thereafter, or if the decision at
decision block 104 is negative, the routine returns to
the main loop in Fig. 6.
25 If the decision at decision block 100 is
affirmative, then processor module 26 proceeds to locate
the actual setpoint 40b corresponding to the point 16e
within the setpoints array at :block 110. It should be
understood that if the processor module 26 did not detect
30 the second velocity VZ, yet has learned the second
velocity VZ, it is presumed that driven mechanism 16
(Fig: 1) must have overshot the desired setpoint 40b
which prevented the second velocity VZ from occurring
(Fig. 5). Consequently, processor 26 will adjust the
35 trigger point or output 18b generated by switch 18 in
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505
-21-
order to back off the trigger so that the transition
between velocities Vl to VZ will occur sooner so that the
second velocity VZ may occur properly. This procedure is
further illustrated relative to Figs. 8A-8E and 9A-9C.
5 At block 116, processor module 26 calculates a
reduced position count using the averaged position count
in the action array as pointed to by the setpoint entry
in the setpoint array. The processor module 26 alsa
subtracts a fixed or predetermined number of encoder
counts, which generally correspond to the encoder's
resolution, to generate a new trigger position. Thus,
processor module 26 calculates (block 116 in Fig. 7C) a
reduced position count by decrementing the averaged
position count by the predetermined number of encoder
3.5 counts .
The routine proceeds to block 118 where the
processor module 26 stores the corrected or learned
trigger in the previous averaged position count queue in
the setpoints array and proceeds to block 120. At block
20 120, processor module 26 calcu:Lates a new average using a
predetermined number of triggers stored within the
previous averaged position count queue within the
setpoints array and writes the averaged trigger into the
averaged position count within the action array. The new
25 trigger provides a "corrected" trigger that will
facilitate causing controller l2 to energize drive
mechanism 14 to drive driven mechanism L6 in accordance
with the user-programmed profile. Thereafter, the
routine proceeds to block 87 as shown.
i,
CA 02336008 2000-12-22
WO 99167691 PCT/US99/13505
-22-
An illustration of the method of the invention
will now be described relative to Figs. BA-8D and 9A-9C.
In the first illustration shown in Figs. SA-8D, the
programmable limit switch 18 learns the appropriate
5 output 18b or trigger which will locate the transition
from the first speed or velocity Vl to the second speed
or velocity V2: In response to the triggers and motion
of output shaft 20, processor module 26 detects an actual
second speed or velocity v2 at 179 degrees. Processor
10 module 26 then adjusts the trigger or output point 18b
leftward, as shown in Fig. 8B, so that the trigger occurs
earlier at 173 degrees as shown. This adjustment of the
trigger, in turn, causes the~d;rive mechanism 14 to begin
driving the driven mechanism at the second speed or
15 velocity VZ at 178 degrees as shown.
Notice also in Fig. 8A that processing module 26
detects the transition between the second speed or
velocity V2 to the third speed or velocity V3 to stop at
point 16g or 180 degrees. Because this is consistent
20 with the user-programmed transition at point 4Oa in Fig.
5, the switch 3.8 makes no adjustment to the output or
trigger signal 18c at point 18d.
Notice in Figs. 8C and BD that, as the drive
system 10 warms up it takes longer for the system ZO to
25 transition from the first speed or velocity V1 to the
second speed or velocity VZ, the time period T3 (Fig. 4)
increases. This results in an "overshoot" of the
beginning of the second speed or velocity V2, as
illustrated in Fig. 8C.
30 This cycle and process are repeated and processor
module 26 again adjusts the output or trigger point 18b
of signal 18a of switch 18 in the manner described herein
so that it occurs at 172 degrees (Fig. 8D), rather than
173 degrees (Fig. 8C). The adjusted output trigger~l8b,
CA 02336008 2000-12-22
WO 99167691 PCT/US99/13505
-23-
in turn, causes drive mechanism 14 to drive the driven
mechanism 16 such that the transition to the second speed
or velocity VZ occurs earlier. Notice that the actual
motion profile (Fig. 8D) now corresponds to the user-
s programmed profile 40 (Fig. 5) and, consequently,
processor modu1e~26 performs no further adjustment.
A second illustration is provided in Figs. 9A-9C
which shows the methodology of the present invention as
applied to the drive system 10 which is operating in a
10 dynamic environment which is in, for example, a cold
machine condition. Notice in Fig. 9A, the programmable
limit switch 18 first learns the position of the driven
mechanism 1& resulting from energizing the drive
mechanism 14 using the outputs or triggers 18b and 18d.
15 In this illustration, switch 18 learns that for triggers
18b and 18d, the transitions between velocities V1 and V2
and between V2 and V3 occur at 174 degrees and 179
degrees, respectively. Processor module 18 utilizes the
routines of Figs. 7A-7C to determine that these
20 transitions do not correspond to the user-programmed
motion profile 40 (Fig. 5) which, in the illustration
being described, established the desired transitions to
begin occurring at 178 degrees (for transition V1 to V2)
and 180 degrees (for transition V2 to V3). Accordingly,
25 processor module 18 adjusts the outputs or triggers 18b
and l8d to occur later at 172 degrees and 179 degrees,
respectively, as illustrated in Fig. 9B.
The adjustments to outputs or triggers 18b and
18d cause drive mechanism 14 to energize driven mechanism
30 16 such that the driven mechanism 16 transitions VI-V2
and V2-V3 occur at 176 degrees and 179.5 degrees,
respectively. These positions are detected by the switch
18 in the manner described earlier herein using encoder
24.
CA 02336008 2000-12-22
WO 99167691 PCT/US99/13505
--24-
Processor module 26 dei~ermines that these
detected positions, namely 179.5 degrees and 176 degrees,
do not correspond to the user-programmed motion profile
40 (Fig. 5) which, as mentioned earlier, mandates that
5 the transition points 16e and 16g occur at 178 degrees
and 180 degrees, respectively. Consequently, the
processor module 26 again adjusts the outputs or triggers
18b and 18d to occur at 174 de~~rees and 179.5 degrees,
respectively, as shown in Fig. 9C. As illustrated in
10 Fig. 9C, this adjustment results in the transitions at
points 16e and 16g to occur at 178 degrees and 180
degrees, respectively. Processor module 26 detects these
positions in the manner descrilbed earlier and determines
that they are consistent with 'the programmed transitions
15 (points 40b and 40a in Fig, 5). Consequently, no further
adjustment to the outputs or triggers 18b and 18d are
made.
It should be appreciated that the processor
module 26 performs the routines illustrated in Figs.6 and
20 7A-7C with every 360 degree rotation of output shaft 20.
It could, however, perform the detection, learning and
adjustments either more or less frequently as required.
As illustrated in Figs. 8A-8D and 9A-9C, the
process is iterative and programmable limit switch 18
25 continues until the outputs or triggers 18b and 18d occur
such that the corresponding transitions 16e and 16g
ultimately occur at the user-programmed setpoin.ts 40b and
40a (Fig. 5), respectively.
Advantageously, this system and method provide a
30 learning programmable limit srnritch 18 which generaires
controlled outputs responsive to the detected angular
position of the output shaft 20. The outputs are fed
back to the PLC or prime controller 12 (Fig. 1) to
provide a passive feedback for the controller to control
35 the drive system such that it transitions between speeds
CA 02336008 2000-12-22
WO 99/67691 PCT/US99/13505
_25_
or to a stop point at the desired positions based on the
user-programmed motion profile 40 (Fig. 5).
While the method herein described, and the forms
of apparatus for carrying these methods into effect,
5 constitute preferred embodiments of this invention, it is
to be understood that the invention is not limited to
these precise methods and forms of apparatus, and that
changes may be made in either without departing from the-
scope of the invention, which is defined in the appended
10 claims.
What is claimed is:
