Angular displacement sensing system and method using brushless DC motor commutation hall effect sensors
View Patent ↗A method and system for sensing angular displacement is provided. More specifically, the system includes a brushless DC motor, three Hall effect sensors, an angular displacement signal processor, and an output state observer. The Hall effect sensors provide three electrical angles of the motor rotor which are used in an angular displacement signal processor that is implemented in hardware and software. The angular displacement signal processor provides an improved resolution angular displacement output. Based on the angular displacement output from angular displacement signal processor and the motor control command signal from the motor drive, an output state observer is applied to generate a high resolution angular displacement signal.
1. A method for sensing angular displacement, wherein a brushless DC motor includes a rotor and a plurality of sensors are mounted in the brushless DC motor, the method comprising:
measuring a plurality of sensor signals indicative of the angular displacement of the rotor using the plurality of sensors;
calculating a direction signal using the plurality of sensor signals;
combining the plurality of sensor signals to produce a plurality of intermediate signals;
combining the plurality of intermediate signals with the direction signal to calculate a first angular displacement signal; and
calculating a second angular displacement signal by processing a motor control command signal and the first angular displacement signal.
2. A method for sensing angular displacement, wherein a brushless DC motor includes a rotor and a plurality of sensors are mounted in the brushless DC motor, the method comprising:
measuring a plurality of sensor signals indicative of the angular displacement of the rotor using the plurality of sensors;
combining the plurality of sensor signals using a plurality of encoder interface circuits to produce a plurality of intermediate signals; and
combining the plurality of intermediate signals using a mathematical operation to provide a first angular displacement signal.
3. The angular sensing system according to claim 2 , wherein the mathematical operation, is an averaging operation in accordance with the relationship
α
=
∑
i
=
1
z
θ
i
/
z
where α corresponds to the first angular displacement signal, θi corresponds to the plurality of intermediate signals calculated by the encoder interface circuits, and z corresponds to a number of signals contained in the plurality of intermediate signals.
4. The method for sensing angular displacement according to claim 2 , comprising calculating a second angular displacement signal by combining a motor control command signal and the fist angular displacement signal.
5. The method for sensing angular displacement according to claim 2 , wherein calculating a second angular displacement signal is in accordance with the relationship:
x
.
^
=
A
x
^
+
Bu
c
+
K
(
θ
disp
-
C
θ
obs
)
:
θ
obs
=
C
x
^
;
where θ disp is the first angular displacement signal; u c is the motor control signal; A, B, and C are constant matrices indicative of the controlled plant model between the motor control signal (u c ) and the first angular displacement signal (θ disp ); K is the observer gain which is determined by the output state observer design to minimize the error of (θ disp −Cθ obs ); θ obs is the second angular displacement signal; {circumflex over (x)} is a state to be observed; and is a derivative of state {circumflex over (x)}.
6. An angular displacement sensing system comprising:
a brushless DC motor having a rotor, the brushless DC motor being driven by a motor control command signal;
a plurality of sensors mounted in the brushless DC motor, wherein the plurality of sensors produce a plurality of sensor signals indicative of an angular position of the rotor;
a plurality of encoder interface circuits coupled to the plurality of sensors, the plurality of encoder interface circuits being adapt to generate a plurality of intermediate signals using the plurality of sensor signals; and
an integrated unit coupled to the plurality of encoder interface circuits, the integrated unit being adapted to receive the plurality of intermediate signals, the integrated unit being adapted to perform a mathematical operation on the plurality of intermediate signals to provide a first angular displacement signal.
7. The angular displacement sensing system according to claim 6 , wherein each of the encoder interface circuit of the plurality of encoder interface circuits receives two sensor signals of the plurality of sensor signals.
8. The angular displacement sensing system according to claim 6 , wherein the mathematical operation, is an averaging operation in accordance with the relationship
α
=
∑
i
=
1
z
θ
i
/
z
;
wherein α corresponds to the first angular displacement signal, θi corresponds to the plurality of intermediate signals generated by the plurality of encoder interface circuits, and z corresponds to a number of signals contained in the plurality of intermediate signals.
9. The angular displacement sensing system according to claim 6 , wherein the first angular displacement signal is processed with the motor control command signal to produce a second angular displacement signal.
10. The angular displacement sensing system according to claim 9 , wherein the first angular displacement signal is processed with the motor control command signal to generate the second angular displacement signal in accordance with the relationship:
x
.
^
=
A
x
^
+
Bu
c
+
K
(
θ
disp
-
C
θ
obs
)
:
θ
obs
=
C
x
^
;
where θ disp is the first angular displacement signal; u c is the motor control command signal; A, B, and C are constant matrices indicative of the controlled plant model between the motor control command signal (u c ) and the first angular displacement signal (θ disp ); K is the observer gain which is determined by the output state observer design to minimize the error of (θ disp −Cθ obs ) is the second angular displacement signal; {circumflex over (x)} is a state to be observed; and is a derivative of state {circumflex over (x)}.
11. The angular displacement sensing system according to claim 9 wherein the plurality of encoder interface circuits has three encoder interface circuits and the plurality of sensor signals has three sensor signals.
12. The angular displacement sensing system according to claim 11 , wherein the first sensor signal and the second sensor signal are connected to the first encoder interface circuit, the first sensor signal and the third sensor signal are connected to the second encoder interface circuit, and the second sensor signal and the third sensor signal are connected to the third encoder interface circuit.