Direct velocity estimation for encoders using nonlinear period measurement

• US 6,704,683 B1
• Filed: 04/27/1999
• Issued: 03/09/2004
• Est. Priority Date: 04/28/1998
• Status: Active Grant

• Current Assignee: Immersion Corporation
• Original Assignee: Immersion Corporation
• Inventors: Hasser, Christopher J.
• Primary Examiner(s): Hoff, Marc S.
• Assistant Examiner(s): Charioui, Mohamed
• Application Number:
  US09/300,147
• Time in Patent Office: 1,778 Days
• Field of Search: 702/142, 702/94, 702/147, 702/145, 702/146, 702/150, 702/152, 702/158, 345/161, 345/157, 345/156, 324/165, 731/181
• US Class Current: 702/147
• CPC Class Codes: G01P 3/481 of pulse signals
• CPC Class Codes: G01P 3/486 delivered by photo-electric detectors
• CPC Class Codes: G01P 3/489 Digital circuits therefor

Abstract

A method and apparatus for providing a direct velocity of a moving object using nonlinear period measurement. A pulse signal from an encoder indicates the detection of a passage of a point on a moving sensor element, such as a mark on an encoder disk. A counter is then made to count down from a higher value to a lower value, where counts by the counter are made at a variable, nonlinear rate. The rate is faster when the count begins and gets slower as the count continues, reducing the possibility that the counter will overflow before the next encoder signal is received. The counter value is output and the counter is reset when another encoder signal is received, where the output value is directly related to the velocity of the object. In a different method and apparatus, first and second values, such as PWM or DAC commands, are provided to an actuator to output as forces. The values are differenced a rate of change of the force values is determined. A force is output according to the rate of change until another force value is received, allowing more stable and continuous force output.

Claims

1. A method, comprising:

receiving a signal from a sensor indicating displacement of a moving sensor element based on a movement of an object;

counting down from a first value to a lower value after the signal has been received, the counting being at a predetermined variable rate, the rate decreasing as the count continues; and

outputting a velocity value of said counter as a value related to a velocity of the object, the velocity value being a current value of the counter when a successive signal from the sensor is received.

2. The method of claim 1, wherein the counting rate is varied by providing one of a plurality of divisors to a frequency divider, the frequency divider controlling when the counter makes another count.

3. The method of claim 2, wherein the plurality of divisors are stored in a look up table.

4. The method of claim 3, wherein said plurality of divisors are determined from a 1/T² relationship, T being the time period between signals from the sensor.

5. The method of claim 3, wherein the plurality of divisors are determined by an iterative search of slopes to find the slope approximating a 1/T relationship.

6. The method of claim 2, wherein the frequency divider receives a high-frequency base clock signal and divides a frequency of the base clock signal by one of the plurality of divisors.

7. The method of claim 6, wherein a different divisor of the plurality of divisors is provided to the frequency divider based on a current value of the counter.

8. The method of claim 1, wherein the sensor is a digital encoder, and the moving sensor element includes at least one mark, said signal provided by said encoder being one of a rising edge signal and a falling edge signal, and passage of said at least one mark being detected by the encoder to detect movement of the object.

9. The method of claim 8, wherein the encoder includes a pattern having a plurality of the marks, which moves as the object moves.

10. The method of claim 8, wherein the signal from the encoder can be in one of two channels, each of the channels directing signals from an associated detector included in the encoder.

11. The method of claim 1, wherein the counter is reset when another signal from the encoder is received, such that the rate at which the counter is reset and the counting rate are proportional to the velocity of the object.

12. The method of claim 1, wherein the count of the counter bears a direct linear relationship to the velocity of the object, the velocity bearing an inverse relationship to a time period between the signals from said encoder.

13. The method of claim 1, wherein the moving object is a moving member of a linkage in a haptic feedback interface device.

14. The method of claim 1, wherein the output value of the counter is used by a non-microprocessor-based circuit to determine a damping force to be output to said object by at least one actuator.

15. The method of claim 1, wherein the output value of the counter is used by a microprocessor to determine a damping force to be output to the object by at least one actuator.

16. An apparatus, comprising:

a decoder state machine that receives a signal from an encoder, the signal having a pulse indicating movement of an element of the encoder, based on movement of an object; and

a nonlinear period counter coupled to said decoder state machine and configured to receive an indication of said pulse therefrom, said nonlinear period counter configured to count down from a first value to a lower value and configured to be reset to the first value when the indication of the pulse is received, a rate of said counter being predetermined, variable and decreasing as said counter counts down, thereby increasing the dynamic range of velocity estimation, said counter being configured to output the lower value based on a successive pulse being received by said decoder state machine, said lower value being related to said velocity of said object.

17. The apparatus of claim 16, wherein said nonlinear period counter includes:

a variable frequency divider, said frequency divider configured to send out a count signal at a variable rate; and

a velocity counter coupled to said variable frequency divider, said velocity counter configured to count from said first value to said lower value, after said count signal is received from said variable frequency divider.

18. The apparatus of claim 17, wherein said nonlinear period counter further includes a lookup table, said lookup table configured to provide different divisors to said variable frequency divider, said variable frequency divider configured to divide a base clock signal by said received divisors to change said rate of outputting said count signal.

19. The apparatus of claim 18, wherein said lookup table stores divisors that have been determined based on a 1/T² relationship, T being the time period between successive pulses.

20. The apparatus of claim 16, wherein said counting rate follows a 1/T relationship, T being a time period between said pulse and the successive pulse.

21. The apparatus of claim 16, further comprising a velocity register, said counter value being passed to said velocity register when the successive pulse is received.

22. The apparatus of claim 16, wherein said decoder state machine is a quadrature decoder state machine configured to receive two quadrature detector signals from said encoder.

23. The apparatus of claim 16, wherein said encoder is an optical encoder that senses motion of said object, a pattern of evenly-spaced marks being provided on an moving encoder element, the passage of one or more of said marks being detected as said object moves.

24. A method, comprising:

receiving a signal from a sensor indicating displacement of a moving sensor element based on movement of an object;

counting down from a first value to a lower value after the signal has been received, the counting being at a variable rate, the rate decreasing as the count continues, the counting rate being varied by providing one of different divisors to a frequency divider, the frequency divider controlling when the counter makes another count, the different divisors being stored in a look up table; and

outputting the value of the counter as a value directly related to a velocity of the object, the value being a current value of the counter when a successive signal from the sensor is received.

25. The method of claim 24, wherein the divisors are determined from a 1/T² relationship, T being the time period between signals from the sensor.

26. The method of claim 24, wherein the divisors are determined by an iterative search of slopes to find the slope approximating a 1/T relationship.

27. The method of claim 24, wherein the counting rate follows a 1/T relationship, T being a time period between said signal and a successive signal.

28. The method of claim 24, wherein the variable counting rate of the counter is predetermined.