ENCODERLESS MOTOR WITH IMPROVED QUANTIZATION AND METHODS OF USE AND CALIBRATION
20220224259 · 2022-07-14
Inventors
- Jeffrey Davis (Sunnyvale, CA, US)
- Rajesh Nerkar (Sunnyvale, CA, US)
- Richard J. Casler, Jr. (Sunnyvale, CA, US)
Cpc classification
G01D5/145
PHYSICS
International classification
Abstract
A DC electric motor having a stator mounted to a substrate, the stator having a coil assembly having a magnetic core, a rotor mounted to the stator with permanent magnets distributed radially about the rotor, the permanent magnets extending beyond the magnetic core, and sensors mounted to the substrate adjacent the permanent magnets. During operation of the motor passage of the permanent magnets over the sensors produces a substantially sinusoidal signal of varying voltage substantially without noise and/or saturation, allowing an angular position of the rotor to be determined from the sinusoidal signals by utilizing a transformation matrix or piece-wise algorithm applied in substantially linear portions of the sinusoidal signals without requiring use of additional hardware encoder or position sensors and without requiring noise-reduction or filtering of the signal.
Claims
1. An n-phase encoder for use in a mechatronic system, the encoder comprising: a movable element that applies a magnetic field with period, S, the period representing a total displacement; a stationary support with n magnetic field sensors mounted thereon and positioned on the stationary support so as to measure the magnetic field imparted by the movable element, wherein n is greater than 1; and a processor communicatively coupled to the n magnetic field sensors and configured to determine displacement of the movable element based on n signals from the n magnetic field sensors by processing the n signals utilizing a transformation matrix.
2. The encoder of claim 1, wherein the total displacement is 2π radians of a field angle ϕ.
3. The encoder of claim 2, wherein the processor is configured to process the n signals from the n sensors by: computing a sine and cosine of the field angle, ϕ, by pre-multiplying an n-by-1 vector by a 2-by-n mathematical transformation matrix, M; and computing the field angle, ϕ, as ϕ=tan−1(sin(ϕ),cos(ϕ)).
4. The encoder in claim 1, where S is a rotary displacement.
5. The encoder in claim 1, where S is a linear displacement.
6. The encoder in claim 3, wherein the mathematical transformation, M, is configured such that calculation of the field angle, ϕ, is independent of an amplitude and bias of the magnetic field sensors.
7. The encoder in claim 1, where the magnetic field sensors are uniformly distributed within the period, S.
8. The encoder claim 1, where the system is configured such that the applied magnetic field is represented by a sum of first and at least one of higher-order harmonics.
9. The encoder of claim 1, wherein the processor is configured to: store a runout represented by a spatially-varying signal representing a difference between a true field angle and a sensed field angle and utilizes the runout to compensate for the difference thereby removing any runout error.
10. The encoder in claim 1, where the encoder is utilized in a BLDC motor configured for operation of a mechatronic system within a diagnostic assay system.
11. The encoder in claim 10, wherein the mechatronic system of the diagnostic assay system comprises any of: a syringe, valve, cartridge loading or door mechanism.
12. A processing method comprising: providing an n phase encoder of a mechatronic system that includes a movable element that applies a magnetic field with period, S, the period representing a total displacement, and a stationary support with n magnetic field sensors mounted thereon and positioned on the stationary support so as to measure the magnetic field imparted by the movable element, wherein n is greater than 1; obtaining signals from the n magnetic field sensors corresponding to the measurements of the magnetic field imparted by the movable element; and processing n signals from the n magnetic field sensors by utilizing a transformation matrix to determine a displacement of the movable element.
13. The processing method of claim 12, wherein the total displacement is 2π radians of a field angle ϕ.
14. The processing method of claim 13, wherein processing the signals from the n sensors comprises: computing a sine and cosine of the field angle, ϕ, by pre-multiplying an n-by-1 vector by a 2-by-n mathematical transformation matrix, M; and computing the field angle, ϕ, as ϕ=tan−1(sin(ϕ),cos(ϕ)).
15. The processing method of claim 12, wherein the processing comprises normalizing an amplitude of at least one of the signals from the n magnetic field sensors to an arbitrary value.
16. The processing method of claim 15, wherein processing of the signals further comprises subtracting a signal bias of at least one of the signals from the n magnetic field sensors before a normalization operation.
17. The processing method of claim 16, wherein processing further comprises storing in memory or outputting to the mechatronic system, one or more signal bias coefficients
18. The processing method of claim 12, where S is a rotary displacement.
19. The processing method in claim 12, where S is a linear displacement.
20. The processing method in claim 12, wherein processing n signals comprises processing only a substantially linear portion(s) of the signals.
21. A calibration method for an n-phase encoder as in claim 1 in which the amplitude, bias and phase-shift of the signal of the n sensors is computed and stored in a memory of the encoder or the mechatronic system in which it is employed.
22. The calibration method of claim 21, wherein a transformation matrix, M(ϕ)), specific to the mechatronic system accounts for irregularities or otherwise actual phase-to-phase angle offsets.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0016]
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
[0027]
DETAILED DESCRIPTION OF THE INVENTION
[0028]
[0029] In one aspect, the BLDC motor includes a rotor, a stator, and multiple analog voltage sensors configured to produce a smoothly varying Hall-effect voltage without any need for filtering or noise reduction of the individual signals. In some embodiments, this feature is provided by use of permanent magnets within the rotor that extend a distance beyond the magnetic core of the stator. In some embodiments, the BLDC motor includes as many analog voltage sensors as phases of the motor, which are positioned such that the motor can be controlled based on the measured voltage patterns received from the sensors. In one aspect, the voltage signals from the sensors are processed utilizing a transformation matrix, thereby avoiding any inaccuracies that might otherwise arise from algorithms applied in a piecewise method. In some embodiments, this includes spacing the sensors radially uniformly about the stator such that the measured voltage waveforms are offset uniformly. For example, a three-phase BLDC can include three Hall-effect sensors spaced 40 degrees radially from each other, thereby allowing the system to control a position of the sensor within an increment of 40 degrees. The signals from the sensors can be used to determine the displacement of the motor with a high degree of accuracy. When utilized individually, although each signal is substantially free from noise and/or saturation, a velocity ripple or other motor harmonic arising from the piecewise method may adversely affect displacement determinations based on a single sensor signal. A velocity ripple describes cyclical variations or oscillations of rotational speed over time in comparison to the actual speed or displacement. Therefore, to overcome any adverse effects attributable to a velocity ripple on an individual signal, the control methods can obtain and process multiple signals from the distributed sensors to determine a given displacement of the motor. In some embodiments, a processor communicatively coupled to the motor is configured to obtain and process the signals from the multiple sensors by application of a mathematical transformation matrix (e.g. for three sensors a 2×3 transformation matrix) so as to determine the motor displacement with a high level of accuracy despite the presence of any velocity ripple affecting an individual signal.
[0030] As described herein, the sensor and processor configuration provides for highly accurate determination of motor displacement from multiple sensor signals that detect the magnetic field of the permanent magnets that also effect movement of the movable element (e.g. translator, rotor). Although this configuration is referred to herein as an “encoder”, this concept is distinguishable from conventional hardware encoders or additional position-based sensors that require additional encoder hardware on the motor (e.g. additional optical, electrical, or magnetic features on the shaft or rotor dedicated to encoding). Thus, the “encoder” described in further detail below is greatly simplified as compared to a conventional hardware encoder since it only requires sensing of existing magnets in the system. This provides for improved integration within the motor design and associated control unit as it does not require any additional encoder hardware or additional position-based detection components beyond the sensors noted below. It is further noted that the encoder described herein, allows for accurate determination from the sensor signals without filtering, noise filtering, or error correction of individual signals and without iteration or recursive solutions.
[0031] In one aspect, the encoder in accordance with the present invention is used to effect movement of a mechatronic sub-assembly. In a preferred embodiment, the encoder is utilized in a small-scale motor or mechatronic system within a diagnostic assay system, for example, a syringe, valve, cartridge loading or door mechanism, or other mechatronic sub-assembly. In the embodiments described below, the encoder is a multi-phase encoder corresponding to the number of phases of the motor that it encodes. Although a three-phase motor is described in the following examples, it is appreciated that the concepts described herein could be applied to any multi-phase motor configuration.
[0032] For a three-phase encoder, the system can include: a movable element (e.g. rotor, linear stage) that applies a magnetic field with period, S, the period representing a displacement of 2π radians of a field angle, ϕ; a stationary element with 3 magnetic field sensors (e.g. Hall-effect sensors) configured to measure the magnetic field imparted by permanent magnets of the movable element; and a processor (e.g. microprocessor, control unit) that is configured to obtain the signals from the three sensors and to process the signals from the three by: (a) computing the sine and cosine of the field angle, ϕ, by pre-multiplying the 3-by-1 vector by a 2-by-3 mathematical transformation matrix, M; and (b) computing the field angle ϕ, as ϕ=tan−1 (sin (ϕ), cos (ϕ)). The following equations can be used for implementation of this integrated sensor encoder approach for three sensors placed 2703 radians apart.
[0033] The matrix M in equation (8) can then be computed using the phase difference of 2π/3 radians between sensor signals.
In another aspect, the sensors can be calibrated for magnitude, offset and phase, by modifying equation (1). This phase calibration will compute a new M matrix in equation (8).
[0034] It is appreciated that the above is an example implementation of this approach applied to a three-phase encoder, as described herein, and that this same approach could be adjusted and utilized for encoding of any multi-phase system or motor or even a multi-speed motor.
[0035] In the foregoing specification, the invention is described with reference to specific embodiments thereof, but those skilled in the art will recognize that the invention is not limited thereto. As used throughout, the term “about” can refer to the ±10% of the recited value. Various features and aspects of the above-described invention can be used individually or jointly. It is appreciated that any of the aspects or features of the embodiments described herein could be modified, combined or incorporated into any of the embodiments described herein, as well as in various other types and configurations. Further, the invention can be utilized in any number of environments and applications beyond those described herein without departing from the broader spirit and scope of the specification. The specification and drawings are, accordingly, to be regarded as illustrative rather than restrictive.
[0036] In some embodiments, such as that shown in
[0037] It should be noted that the number of pole teeth and poles, and indeed the disclosure of an internal stator and an external rotor are exemplary, and not limiting in the invention, which is operable with motors of a variety of different designs.
[0038]
[0039] Three linear Hall-effect sensors 202a, 202b and 202c are illustrated in
[0040]
[0041]
[0042] As illustrated in this non-limiting exemplary prototype, each of Hall-effect sensors 202a, 202b and 202c is positioned beneath the distal edge of the rotor magnets, just toward the inside, radially, of the central track of the rotating magnets. Hall-effect sensor 202b is located to be forty degrees arc from Hall-effect sensor 202a along the rotating track of the magnets of the rotor. Similarly, Hall-effect sensor 202c is located a further forty degrees around the rotor track from Hall-effect sensor 202b.
[0043]
[0044] Referring back to
[0045] Advantageously, extending the rotor magnets below the distal extremity of the iron core avoids the corrupting effect of the switching fields from the coils of the stator on the signal from the Hall-effect sensors. The particular extension d1 will depend on several factors specific to the particular motor arrangement, and in some embodiments will be 1 mm or more (e.g. 2 mm, 3 mm, 4 mm, 5 mm, 6 mm, or greater), while in some other embodiments the extension will be less than 1 mm. In some embodiments, the distance is a function of the size of the permanent magnets and/or the strength of the magnetic field. In some embodiments of the exemplary prototype as detailed herein, 1 mm of extension is sufficient to produce a sinusoidal signal of varying voltage without noise or saturation. Placement of the Hall-effect sensors at a separation d2 to produce a Hall-effect voltage produces a smoothly variable voltage, devoid of noise. In some embodiments, the Hall-effect sensors produce a smoothly variable DC voltage in the range from about 2 volts to about 5 volts devoid of noise or saturation. The dimension d2 may vary depending on choice of sensor, design of a rotor, strength of permanent magnets in the rotor, and other factors that are well known to persons of skill in the art. A workable separation is readily discovered for any particular circumstance, to avoid saturation of the sensor and to produce a smoothly variable DC voltage substantially devoid of noise.
[0046]
[0047]
[0048]
[0049] In some embodiments, the approaches described herein provide for a high degree of accuracy and precision for mechanisms driven by motor 100. In the non-limiting example described above using an 11-bit ADC, the motor position can be controlled to 0.0005 degree mechanical. Coupled with gear reduction extremely fine control of translation and rotation of mechanisms can be attained. In some embodiments, motor 100 is coupled to a translation drive for a syringe-pump unit to take in and expel fluid in an analytical chemical processes.
[0050]
[0051]
[0052]
[0053] In some cases, the above algorithms may not be suited for operation on a simple microprocessor. In some embodiments, the algorithms utilize a look-up table combined with a Newton-Raphson or equivalent iterative numerical solution. This can be implemented as a simple subroutine call in a PSoC processor having a floating point implementation. An alternative approach of utilizing only substantially the linear portions of the sinusoidal signals, such as the centroid approach described in U.S. Pat. No. 10,348,225 entitled “Encoderless Motor with Improved Granularity and Methods of Use” issued Jul. 9, 2019, utilizes only involves multiplication and division such that it can be implemented in simpler microprocessors where more complex facilities are not possible.
[0054] As described above in the non-limiting exemplary embodiments, an ADC is used to produce the division of the straight portions of the phase-separated waveforms and motor 100, which can be driven by, for example, a DRV83 13 Texas Instruments motor driver circuit. It is understood that there are other arrangements of circuitry that might be used while still falling within the scope of this approach. In some embodiments the circuitry and coded instructions for sensing the Hall-effect sensors and providing motor encoding may be implemented in a programmable system on a chip (PSOC) on the PCB.
[0055]
[0056] It is appreciated that a variety of alterations can be made in the embodiments described herein without departing from the scope of the invention. For example, electric motors of different designs might be incorporated and controlled in alternative embodiments of the invention by placement of sensors to generate substantially sinusoidal phase-separated waveforms in a manner that the circuitry takes into account only the substantially straight portions of the resulting, intersecting curves, with additional resolution provided by dividing the straight portions into equal length segments, effectively dividing the voltage increments into equal known segments to be associated with fractions of rotor or stator rotation, depending on mechanical design of the motor.
[0057] Some non-limiting exemplary uses and applications for a DC electric motor according to the invention include the following:
[0058] Diagnostic applications: With increasing use of robotics for use in high-throughput processing of fluid samples and performing of diagnostic assays, high resolution control of mechanical mechanisms has become extremely useful. Particularly, as diagnostic devices have trended toward small-scale and microdevices, which are more efficient and require smaller sample sizes, control over small-scale movements is of particular interest.
[0059] Medical applications: With increasing use of robotics for remote surgery techniques, extremely well controlled movement of remotely controlled implements have become essential. For example, in ophthalmology or neurology procedures where manipulation of retinal cells or nerve endings require movements with microscopic resolution. In order to effect these movements, which are far finer than is possible with a human hand with eye coordination, computers are used to move actuators in concert with feedback from suitable sensors. A motor with high resolution positional encoding capabilities as disclosed herein can assist the computer, and therefore the surgeon, in performing these delicate procedures.
[0060] Semiconductor fabrication: Systems for fabrication of semiconductor devices rely on fine movement of the silicon wafer and manipulator arms. These movements are regulated by means of positional feedback. A motor with high resolution positional encoding capabilities as disclosed herein suitable in these applications.
[0061] Aerospace and satellite telemetry: High resolution angular position feedback can be used for precise targeting and for antenna positioning. In particular, satellite communication antenna dishes need to precisely track orbiting satellites. Satellite trajectory combined with precise angle feedback from a motor as described herein mounted to the antenna and power spectrum from the antenna can assist precise tracking. In addition, because the motor as described herein is small, inexpensive and robust, it is an ideal choice for use on satellites and in other extra-terrestrial applications that will be well known to persons of skill in the art.
[0062] Remote controlled vehicles: the small size and reduced cost of the motor disclosed herein makes it desirable for use in remote controlled vehicle applications, including drones. In particular the high resolution positional encoding features of the motor make it ideal for steering (directional control) and acceleration (power control) in both commercial and recreational uses of remote controlled vehicles. Additional uses will be apparent to persons of ordinary skill in the art.
[0063] Human Augmentation: The small size and reduced cost of the motor disclosed herein makes it desirable for use in prosthetic, orthotic or humanoid applications as these might be applied to augment or substitute for leg, arm or hand mechanics.
[0064] Further to the above, the skilled person will be aware that there are a variety of ways that circuitry may be arranged to provide granular control for a motor thusly equipped and sensed. The invention is limited only by the claims that follow.