Positional-based motion controller with a bias latch

• US 6,107,769 A
• Filed: 12/29/1998
• Issued: 08/22/2000
• Est. Priority Date: 12/29/1998
• Status: Expired due to Fees

• Current Assignee: Square D Company (Schneider Electric SE)
• Original Assignee: Schneider Automation Incorporated (Schneider Electric SE)
• Inventors: Pillsbury, Nathan H., Saylor, Michael J.
• Primary Examiner(s): IP, SHIK LUEN PAUL
• Application Number:
  US09/222,515
• Time in Patent Office: 602 Days
• Field of Search: 318/560-696, 369/30, 369/34, 369/32, 369/43, 187/292, 187/116, 187/316, 395/80-99, 83/53, 65/160
• US Class Current: 318/600
• CPC Class Codes: G05B 19/19 characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
• CPC Class Codes: G05B 19/414 Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller
• CPC Class Codes: G05B 2219/41255 Mode switch, select independent or dependent control of axis
• CPC Class Codes: G05B 2219/42126 Bumpless, smooth transfer between two control modes
• CPC Class Codes: G05B 2219/42186 Master slave, motion proportional to axis
• CPC Class Codes: G05B 2219/43174 Simulating cam motion mechanism
• CPC Class Codes: G05B 2219/50231 Synchronize engage, disengage groups of axis as function of position of simulate

Abstract

A motion controller and a method of controlling the motion of a plurality of axes which prevents a discontinuous position command being generated to a follower axis. A follower mode transfer function circuit or routine generates a position command in response to a master axis position. This function can be in the form of electronic gearing or camming. A bias latch is utilized to offset any change in position resulting from a change in mode, such as changing from electronic gearing to electronic camming, changing cam profiles or gearing ratios, or changing the master axis. The latch is summed with the transfer function position command and a standard move command profile generator position command to provide the follower axis position command. The latch is recalculated each time the follower mode is changed. A halt command can be used to selectively block or enable an independent move command signal, allowing the follower axis to remain in motion when the follower mode is turned off (not following the master axis), or allowing the follower mode to be turned on while the follower axis is in motion without a sudden change in position. Trigger calculation circuitry is used to precalculate timing for activating the follower mode when follower mode is changed from off to on while the follower axis is already in motion such that the axes are in phase after ramping time.

Claims

1. A motion controller which prevents a discontinuous position command to a follower axis when a follower mode is changed comprising:

a move profile generator which generates a move profile position value;

a transfer function position generator which generates a transfer function position value;

a latch which generates a bias position value; and

a summer which generates a follower axis position value in response to said move profile position value, said transfer function position value and said bias position value.

2. The controller of claim 1 wherein said follower axis position value controls the position of said follower axis.

3. The controller of claim 1 wherein said transfer function position generator generates said transfer function position value in response to a master axis position value.

4. The controller of claim 3 wherein said transfer function position value is a constant multiplier value times said master axis position value.

5. The controller of claim 4 wherein said bias position value changes in response to a change in said constant multiplier value.

6. The controller of claim 3 wherein said transfer function position generator includes a first transfer function lookup table which provides a first transfer function position value in response to a particular master axis position value.

7. The controller of claim 6 wherein said transfer function position generator includes a second transfer function lookup table which provides a second transfer function position value in response to said particular master axis position value.

8. The controller of claim 7 wherein said bias position value changes in response to a change from said first lookup table to said second lookup table.

9. The controller of claim 1 wherein said bias position value offsets a change in said transfer function position value resulting from a change in said follower mode.

10. The controller of claim 9 wherein said bias position value is calculated in response to said change in said follower mode.

11. A motion controller comprising:

circuitry for generating a first position value in response to a first axis position value;

circuitry for generating a second position value which offsets a change in said first position value due to a change in a mode of operation of said circuitry for generating a first position value; and

circuitry for generating a second axis position value in response to said first position value and said second position value.

12. The motion controller of claim 11 further comprising circuitry for generating a third position value wherein said circuitry for generating a second axis position value generates said second axis position value in response to said third position value in addition to said first position value and said second position value.

13. The motion controller of claim 12 wherein said first circuitry multiplies said first axis position value by a constant multiplier to generate said first position value.

14. The motion controller of claim 13 wherein said constant multiplier changes from a first value to a second value, and wherein said second position value changes in response to said change in said constant multiplier.

15. The motion controller of claim 12 wherein said circuitry for generating a first position value comprises a first lookup table for providing said first position value in response to said first axis position value.

16. The motion controller of claim 15 wherein said circuitry for generating a first position value comprises a second lookup table for providing said first position value in response to said first axis position value, and wherein said second position value changes in response to said circuitry for generating a first position value changing from utilizing said first lookup table to said second lookup table to provide said first position value.

17. A method of preventing a discontinuous position command to a follower axis when a follower mode is changed comprising the steps of:

generating a move profile position value;

providing a master axis position value;

generating a transfer function position value in response to said master axis position value;

generating a bias position value which offsets a change in said transfer function position value due to a change in said follower mode; and

generating a follower axis position value in response to said move profile position value, said transfer function position value, and said bias position value.

18. The method of claim 17 wherein said follower axis position value controls the position of a follower axis.

19. The method of claim 17 wherein said generating a transfer function position value step comprises providing a first constant multiplier and multiplying said master axis position value by said first constant multiplier.

20. The method of claim 19 wherein said generating a transfer function position value step comprises providing a second constant multiplier and subsequently changing multiplying said master axis position value by said first constant multiplier value to said second constant multiplier.

21. The method of claim 20 wherein said generating a bias position value step comprises changing said bias position value in response to said change from said first constant multiplier to said second constant multiplier.

22. The method of claim 17 wherein said generating a transfer function position value step comprises providing a first lookup table which generates said transfer function position value in response to said master axis position value.

23. The method of claim 21 wherein said generating a transfer function value step comprises providing a second lookup table which generates said transfer function position value in response to said master axis position value, and changing from utilizing said first lookup table to said second lookup table.

24. The method of claim 17 wherein said generating a bias position value step comprises changing said bias position value in response to said changing from utilizing said first lookup table to said second lookup table step.

25. The method of claim 17 wherein said generating a bias position value step comprises changing said bias position value in response to a change of said follower mode.

26. The method of claim 25 wherein said follower mode changes from electronic gearing to electronic camming.