The present disclosure relates to the field of electric motor control and, more particularly, relates to a method and system for obtaining an initial mechanical angle of an electric motor.
An electric motor usually uses a linear Hall sensor to detect an electrical angle of a motor rotor and obtain a mechanical angle of the electric motor rotor from the electrical angle. For a multi-pole electric motor, a mechanical cycle corresponds to a plurality of electrical cycles. Correspondingly the mechanical angle of the electric motor rotor cannot be determined only from the electrical angle. In motor control of a gimbal, a mechanical limit structure of the gimbal is usually used to determine the mechanical angle cooperatively when the electric motor is powered on. Specifically, after the electric motor is powered on during start up, the gimbal usually rotates forward and backward to hit the limit structure, so as to determine the initial mechanical angle of the gimbal through the known position of the limit structure, and then enters attitude control. However, this method for determining the mechanical angle of the electric motor rotor by hitting the limit structure has the following problems:
1. The starting of the gimbal is slow and the user experience is poor;
2. It is easy to be blocked by obstructions during the process of hitting the limit structure, resulting in start-up failure, and hence the reliability is poor; and
3. The mechanical limit structure has a risk of fatigue damage, increasing the limit angle deviation.
In accordance with the disclosure, there is provided a method for obtaining an initial mechanical angle of an electric motor including determining a mechanical state of the electric motor, determining an initial electrical angle of the electric motor according to the mechanical state, and determining the initial mechanical angle of the electric motor according to the initial electrical angle.
Also in accordance with the disclosure, there is provided a gimbal including an electric motor, a sensor configured to determine a mechanical state of the electric motor, and a controller connected to the sensor and configured to determine an initial electrical angle of the electric motor according to the mechanical state and determine an initial mechanical angle of the electric motor according to the initial electrical angle.
The accompanying drawings are used to provide a further understanding of the present disclosure and constitute a part of the specification. Together with the following specific embodiments, they are used to explain the present disclosure, but do not constitute a limitation to the present disclosure.
Technical solutions of the present disclosure will be described with reference to the drawings. It will be appreciated that the described embodiments are exemplary but not to limit the scope of the present disclosure. Further, in the following description, descriptions of well-known structures and technologies are omitted to avoid unnecessarily obscuring the concept of the present disclosure.
The terms used here are only for describing specific embodiments, and are not intended to limit the present disclosure. The terms “including”,” “comprising”,” etc., used herein indicate the existence of the described features, steps, operations and/or components, but do not exclude the existence or addition of one or more other features, steps, operations or components.
All terms (including technical and scientific terms) used herein have the meanings commonly understood by those skilled in the art, unless otherwise defined. It should be noted that the terms used herein should be interpreted as having meanings consistent with the context of this specification, and should not be interpreted in an idealized or overly rigid manner.
In the case of using an expression similar to “at least one of A, B and C, etc.”,” generally speaking, it should be interpreted according to the meaning of the expression commonly understood by those skilled in the art (for example, “a system including at least one of A, B and C” shall include but is not limited to a system including A alone, a system including B alone, a system including C alone, a system including A and B, a system including A and C, a system including B and C, and/or a system including A, B, C, etc.). In the case of using an expression similar to “at least one of A, B or C”,” generally speaking, it should be interpreted according to the meaning of the expression commonly understood by those skilled in the art (for example, “a system including at least one of A, B and C” shall include but is not limited to a system including A alone, a system including B alone, a system including C alone, a system including A and B, a system including A and C, a system including B and C, and/or a system including A, B, C, etc.). Those skilled in the art should also understand that essentially any transitional conjunctions and/or phrases representing two or more optional items, whether in the specification, claims, or drawings, should be understood to include the possibility of one of the items, any one of the items, or two items. For example, the phrase “A or B” should be understood to include the possibilities of “A” or “B”,” or “A and B.”
The present disclosure provides a method for obtaining an initial mechanical angle of an electric motor. The method may include: determining a mechanical state of the electric motor; determining an initial electrical angle of the electric motor according to the mechanical state; and determining the initial mechanical angle of the electric motor according to the initial electrical angle.
At S101, the mechanical state of the electric motor is determined.
Two methods may be used to obtain the mechanical state of the electric motor: using a magnetic encoding device to determine a mechanical angle of the electric motor when the electric motor is powered on (also referred to as a “power-on mechanical angle”), or using a photoelectric code disc to determine a mechanical position range of the electric motor when the electric motor is powered on (also referred to as a “power-on mechanical position range”). That is, the mechanical state of the electric motor may include the mechanical angle or the mechanical position range when the electric motor is powered on. Two methods may be used to obtain the mechanical state of the electric motor. In one embodiment, the electric motor with the magnetic encoding device may be used to obtain the initial mechanical angle of the electric motor. In another embodiment, the electric motor with the photoelectric code disc may be used to obtain the initial mechanical angle of the electric motor.
It should be noted that in the embodiment of the electric motor with the magnetic encoding device, the mechanical angle obtained by the magnetic encoding device disposed at a side of a shaft of the electric motor may have poor linearity and low accuracy, and linearity calibration may be needed. Therefore, the mechanical angle obtained by the magnetic encoding device may be only used as a standard to determine the electrical cycle of the electric motor, to obtain the initial mechanical angle with high accuracy finally.
At S102, the initial electrical angle of the electric motor is determined according to the mechanical state.
Specifically, an electrical cycle of the electric motor (also referred to as a “current electrical cycle”) may be determined according to the mechanical state of the electric motor, that is, the mechanical angle or the mechanical position range. Then the electrical cycle may be combined with the electrical angle when the electric motor is powered on (also referred to as a “power-on electrical angle”) or the calibrated electrical angle when the electric motor is in the mechanical position range, to determine the initial electrical angle of the electric motor.
At S103, the initial mechanical angle of the electric motor is determined according to the initial electrical angle.
Assuming a number of pole pairs in the electric motor is N where N≥1, then the initial mechanical angle equals the initial electrical angle/N. Compared with the mechanical angle of the electric motor obtained by the magnetic encoding device when the electric motor is powered on, the initial mechanical angle may be more accurate. Further, in the above two embodiments, the electric motor may not need to rotate to hit limit structures. Rapid startup of the electric motor can be achieved and the loss of the electric motor can also be reduced.
It should be noted that in some embodiments, a potentiometer may be used to replace the magnetic encoder. That is, the mechanical angle when the electric motor is powered on may be measured by the voltage change of the potentiometer disposed on the electric motor, to determine the initial mechanical angle of the electric motor, which is not described in detail here.
An example method including using a magnetic encoding device to determine the mechanical angle consistent with the present disclosure is described below with reference to
At S101, the mechanical angle when the electric motor is powered on is determined by the magnetic encoder on the electric motor.
At S102, the initial electrical angle of the electric motor is determined according to the mechanical angle.
Specifically, as illustrated in
At S1021, an electrical angle when the electric motor is powered on is obtained by a Hall sensor on the electric motor.
At S1022, the initial electrical angle is determined according to the mechanical angle and the electrical angle.
In some embodiments, the number of pole pairs in the electric motor is N, and correspondingly a mechanical cycle of the electric motor may correspond to N electrical cycles. A current electrical cycle of the electric motor may need to be determined to determine the unique initial electrical angle of the electric motor.
More specifically, as illustrated in
At S10221, the current electrical cycle where the electric motor is located is determined according to the mechanical angle.
In general, the electric motor may have limit positions. A zeroth electrical angle EA0 when the electric motor is in an initial limit position may be obtained by the Hall sensor, and a zeroth mechanical angle MA0 may be obtained by the magnetic encoder. Consequently, an N-th electrical angle EAN when the electric motor is in a final limit position may be obtained by the Hall sensor, and an N-th mechanical angle MAN may be obtained by the magnetic encoder.
Further, the magnetic encoder may be used to obtain a first mechanical angle MA1, a second mechanical angle MA2, . . . , and an (N−1)-th mechanical angle MAN−1 corresponding to the zero degree electrical angle of the electric motor in each electrical cycle of the N electrical cycles, to obtain the zeroth mechanical angle to the N-th mechanical angle (MA0˜MAN).
Consequently, the electrical cycle of the electric motor may be determined according to a relationship between the mechanical angle MA when the electric motor is powered on and MA0˜MAN.
When the mechanical angle MA satisfies MAi≤MA≤MAi+1, the electric motor is determined to be in the electrical cycle i, where 0≤i≤N−1.
As illustrated in
when the mechanical angle is MA0<MA<MA1, the electric motor is in the electrical cycle 0;
when the mechanical angle is MA1<MA<MA2, the electric motor is in the electrical cycle 1;
when the mechanical angle is MA2<MA<MA3, the electric motor is in the electrical cycle 2; and
when the mechanical angle is MA3<MA<MA4, the electric motor is in the electrical cycle 3.
In some embodiments of the present disclosure, because of deviation between real-time data and recorded data in actual application, MA and the recorded MAi, MA2, and MA3 may not be strictly aligned. Judgment may be made at boundary points of the recorded data, as illustrated in
Correspondingly, to obtain the initial mechanical angle more accurately, following judgment steps may be included to correct the electrical cycles.
Whether the angle difference between the mechanical angle and any one of MA0˜MAN is in a preset threshold range may be determined.
When the angle difference between the mechanical angle and any one of MA0˜MAN is in the preset threshold range, if the electrical angle is close to 0°, the electric motor may be determined to be in the electrical cycle i+1, and if the electrical angle close to 360°, the electric motor may be determined to be in the electrical cycle i.
In general, the preset threshold range may be 180°, or any suitable angle, and the value may be adjusted according to the actual needs of the users.
For example, the mechanical angle may meet MA1<MA<MA2, and the electric motor may be determined to be in the electrical cycle 1 according to the mapping relationship between the electrical angle and the mechanical angle. To make the initial mechanical angle more accurate, after correction in the judgment steps, the electrical angle is determined to be close to 0°, and then the electric motor may be determined to be actually in the electrical cycle 2.
At S10222, the initial electrical angle is determined according to the electrical cycle and the electrical angle.
Correspondingly, the corrected initial electrical angle=the electrical angle when the electric motor is powered on+360°×the corrected electrical cycle.
In the previous example, the initial electrical angle before correction=the electrical angle when the electric motor is powered on+360°×1, while the corrected initial electrical angle=the electrical angle when the electric motor is powered on+360°×2.
At S103, the initial mechanical angle of the electric motor is determined according to the corrected initial electrical angle.
Correspondingly, the corrected initial mechanical angle=the initial electrical angle/N.
The second embodiment of the present disclosure is used to illustrate the second method in the present disclosure, and will be described below with reference to
As illustrated in
In some other embodiments, the photoelectric code disc may also include a high reflectivity area and a low reflectivity area, and the transmission and receiving modules or photosensitive elements of photoelectric sensors may be provided at the same side of the photoelectric code disc. When the photoelectric code disc is working, the light incident on the high reflectivity area and the low reflectivity area may cause the photosensitive elements to output different analog voltage signals. The processing method is similar to the foregoing embodiments and will not be repeated here.
In some embodiments, the rotation range of the electric motor may be limited. For example, an external structure driven by the electric motor may have mechanical limits, which causes the electric motor to only rotate within a limited range instead of 360°. Within this rotation range, a boundary between the light and dark areas of the photoelectric code disc may be included correspondingly. In this way, it can be determined that there is only one edge signal output by the photoelectric code disc within the rotation range of the electric motor, such that the mechanical position of the electric motor when the edge signal appears is a unique position determined within the rotatable range.
Specifically, with reference to
Obtaining a maximum voltage Vmax and a minimum voltage Vmin in the analog voltage signals;
Determining hysteresis interval [Vmax−(Vmax−Vmin)/4, Vmin+(Vmax−Vmin)/4] according to Vmax and Vmin; and
Determining the voltage higher than the hysteresis interval (the voltage higher than Vmin+(Vmax−Vmin)/4) as a high voltage 1 and the voltage lower than the hysteresis interval (the voltage lower than Vmax−(Vmax−Vmin)/4) as a low voltage 0, to discretize the analog voltage signals to the digital voltage signals.
As illustrated in
Specifically, S101 may include S1011 and S1022.
At S1011, after the electric motor is powered on, the electric motor is controlled to rotate toward a direction. The direction may be clockwise or counterclockwise.
In some embodiments, when the signal edge of the digital voltage signal is a rising edge, if the digital voltage signal when the electric motor is powered on is 0, the electric motor may rotate clockwise, and if the digital voltage signal when the electric motor is powered on is 1, the electric motor may rotate counterclockwise. When the signal edge of the digital voltage signal is a falling edge, if the digital voltage signal when the electric motor is powered on is 0, the electric motor may rotate counterclockwise, if the digital voltage signal when the electric motor is powered on is 1, the electric motor may rotate clockwise. It is understandable that the rotation direction of the electric motor here is related to the black and white boundary of the photoelectric code disc and the rotation range of the electric motor. In other embodiments, the electric motor can rotate in the opposite direction to the previous embodiment under the same circumstances.
At S1012, when the occurrence of the signal edge is detected, it is determined that the electric motor is in the mechanical position range.
After the mechanical position range when the electric motor is powered on is determined, S102 is performed to determine the initial electrical range of the electric motor according to the mechanical position range.
As illustrated in
In some embodiments of the present disclosure, as shown in
In various embodiments, a may be 1800 or another suitable value, and can be adjusted according to actual needs.
According to the corrected electrical cycle and electrical angle EAi, a more accurate corrected initial electrical angle may be obtained, where the corrected initial electrical angle=electrical angle EAi calibrated by the mechanical position range+360°×corrected electrical cycle. For example, if the electrical angle EAi obtained by the Hall sensor and calibrated by the mechanical position range is 30°, the uncorrected initial electrical angle=EAi+360°×3=1110°. However, in fact, comparing EAi with the actual electrical angle EA=220°, it may be obtained that |EA−EAi|=190°>180°, therefore the electric motor should actually be in electrical cycle 2 and the initial electrical angle=EAi+360°×2=750°. It can be seen that if no correction is made, the error of the initial electrical angle is relatively large.
At S103, the initial mechanical angle of the electric motor may be determined according to the corrected initial electrical angle.
Similar to the first method, the initial mechanical angle=the corrected initial electrical angle/N.
According to the previous two embodiments, in the method for obtaining the initial mechanical angle in the present disclosure, the electrical cycle of the electric motor may be determined according to the mechanical state of the electric motor (that is, the mechanical angle when the electric motor is powered on or the mechanical position range when the electric motor is powered on). Correspondingly, the unique initial electrical angle of the electric motor may be obtained and the unique initial mechanical angle of the electric motor may be determined. Further, the electrical cycle may be corrected to obtain a more accurate initial mechanical angle.
The present disclosure also provides a system for obtaining an initial mechanical angle of an electric motor. The system may include: a first sensor configured to determine the mechanical state of the electric motor, and a controller connected to the first sensor and configured to obtain an initial electrical angle of the electric motor according to the mechanical state and determine the initial mechanical angle according to the initial electrical angle.
When a number of pole pairs in the electric motor is N, the initial mechanical angle=the initial electrical angle/N.
In general, the electrical angle when the electric motor is powered on may be obtained using a second sensor (such as a Hall sensor) connected to the controller.
According to different first sensors, the mechanical state may be the mechanical angle of the electric motor when it is powered on or the mechanical position range when the electric motor is powered on. Therefore, the specific implementation of the obtaining system can be divided into two solutions. The first sensor in the first solution can be a magnetic encoder or a potentiometer to determine the mechanical angle of the electric motor when it is powered on. In the second solution, the first sensor can be a photoelectric code disc to determine the mechanical position range when the electric motor is powered on.
The third embodiment of the present disclosure illustrates the first solution of the obtaining system, and will be described with reference to
In this embodiment, the controller may determine the initial mechanical angle of the electric motor according to the mechanical angle when the electric motor is powered on obtained by the first sensor and the initial electrical angle of the electric motor when the electric motor is powered on obtained by the second sensor. Among them, the first sensor may be a magnetic encoder or a potentiometer. The following will take a magnetic encoder as an example for description. For the specific implementation of the potentiometer, the change in the voltage of the potentiometer set on the electric motor may be measured to obtain the mechanical angle when the electric motor is powered on and determine the initial electrical angle of the electric motor. The specific implementations of these two are similar and will not be repeated here.
Further, the controller may determine the electrical cycle of the electric motor and then determine the initial electrical angle of the electric motor according to the electrical cycle and the electrical angle.
In a process for the controller to determine the electrical cycle, the magnetic encoder may be configured to obtain a zeroth mechanical angle MA0 when the electric motor is in an initial limit position and an N-th mechanical angle MAN when the electric motor is in a final limit position. The second sensor (such as a Hall sensor) may be configured to obtain a zeroth electrical angle EA0 when the electric motor is in an initial limit position and an N-th electrical angle EAN when the electric motor is in a final limit position. Further, the magnetic encoder may be used to obtain a first mechanical angle MAi, a second mechanical angle MA2, . . . , and an (N−1)-th mechanical angle MAN−1 corresponding to the electrical angle of the electric motor which is zero in each electrical cycle of the N electrical cycles, to obtain the zeroth mechanical angle to the N-th mechanical angle (MA0˜MAN).
Final, the controller may be configured to determine that the electric motor is in the electrical cycle i with 0≤i≤N−1.
As illustrated in
when the mechanical angle is MA0<MA<MA1, the electric motor is in the electrical cycle 0;
when the mechanical angle is MA1<MA<MA2, the electric motor is in the electrical cycle 1;
when the mechanical angle is MA2<MA<MA3, the electric motor is in the electrical cycle 2; and
when the mechanical angle is MA3<MA<MA4, the electric motor is in the electrical cycle 3.
In some embodiments of the present disclosure, because of deviation between real-time data and recorded data in actual application, MA and the recorded MAi, MA2, and MA3 may not be strictly aligned. Judgment may be made at boundary points of the recorded data, as illustrated in
Correspondingly, to obtain the initial mechanical angle more accurately, following judgment steps may be included to correct the electrical cycles.
Whether the angle difference between the mechanical angle and any one of MA0˜MAN is in a preset threshold range may be determined.
When the angle difference between the mechanical angle and any one of MA0˜MAN is in the preset threshold range, if the electrical angle is close to 0°, the electric motor may be determined to be in the electrical cycle i+1, and if the electrical angle is close to 360°, the electric motor may be determined to be in the electrical cycle i.
In general, the preset threshold range may be 180°, or any suitable angle, and the value may be adjusted according to the actual needs of the users.
For example, the mechanical angle may meet MA1<MA<MA2, and the electric motor may be determined to be in the electrical cycle 1 according to the mapping relationship between the electrical angle and the mechanical angle. To make the initial mechanical angle more accurate, after correction in the judgment steps, the electrical angle is determined to be close to 0°, and then the electric motor may be determined to be actually in the electrical cycle 2.
After the corrected electrical cycle is obtained, the initial electrical angle=the electrical angle when the electric motor is powered on+360°×the corrected electrical cycle.
In the previous example, the initial electrical angle before correction=the electrical angle when the electric motor is powered on+360°×1, while the corrected initial electrical angle the electrical angle when the electric motor is powered on+360°×2.
Correspondingly, the corrected initial mechanical angle=the initial electrical angle/N.
The fourth embodiment of the present disclosure is used to illustrate the second solution of the obtaining system in the present disclosure, and will be described below with reference to
In the present disclosure, the first sensor may be configured to output the analog voltage signals of the electric motor, and the controller may obtain the analog voltage signals from the first sensor, convert the analog voltage signals to the digital voltage signals, and determine the position range corresponding to the signal edge of the digital voltage signals as the mechanical position range.
As illustrated in
Therefore, the photoelectric code disc may output different analog voltage signals. The controller may sample the analog voltage signals and discretize the analog voltage signals to the digital voltage signals. Therefore, a signal edge (falling edge or rising edge) of a signal transition may be obtained. Further, a range of positions of the electric motor corresponding to the digital voltage signals output by the photoelectric code disc at two sides of the signal edge may be calibrated as the mechanical position range.
Specifically, with reference to
Obtaining a maximum voltage Vmax and a minimum voltage Vmin in the analog voltage signals;
Determining hysteresis interval [Vmax−(Vmax−Vmin)/4, Vmin+(Vmax−Vmin)/4] according to Vmax and Vmin; and
Determining the voltage higher than the hysteresis interval (the voltage higher than Vmin+(Vmax−Vmin)/4) as a high voltage 1 and the voltage lower than the hysteresis interval (the voltage lower than Vmax−(Vmax−Vmin)/4) as a low voltage 0, to discretize the analog voltage signals to the digital voltage signals.
After determining the mechanical position range, the controller may control the electric motor to rotate toward a direction, until the controller detects the occurrence of the signal edge and determines that the electric motor is in the mechanical position range. The direction may be clockwise or counterclockwise.
In some embodiments, when the signal edge of the digital voltage signal is a rising edge, if the digital voltage signal when the electric motor is powered on is 0, the electric motor may rotate clockwise, and if the digital voltage signal when the electric motor is powered on is 1, the electric motor may rotate counterclockwise. When the signal edge of the digital voltage signal is a falling edge, if the digital voltage signal when the electric motor is powered on is 0, the electric motor may rotate counterclockwise, if the digital voltage signal when the electric motor is powered on is 1, the electric motor may rotate clockwise. It is understandable that the rotation direction of the electric motor here is related to the black and white boundary of the photoelectric code disc and the rotation range of the electric motor. In other embodiments, the electric motor can rotate in the opposite direction to the previous embodiment under the same circumstances.
As illustrated in
In some embodiments of the present disclosure, as shown in
In various embodiments, a may be 180° or another suitable value, and can be adjusted according to actual needs.
According to the corrected electrical cycle and electrical angle EAi, a more accurate corrected initial electrical angle may be obtained, where the corrected initial electrical angle=electrical angle EAi calibrated by the mechanical position range+360°×corrected electrical cycle. For example, if the electrical angle EAi obtained by the Hall sensor and calibrated by the mechanical position range is 30°, the uncorrected initial electrical angle=EAi+360°×3=1110°. However, in fact, comparing EAi with the actual electrical angle EA=220°, it may be obtained that |EA−EAi|=190°>180°, therefore the electric motor should actually be in electrical cycle 2 and the initial electrical angle=EAi+360°×2=750°. It can be seen that if no correction is made, the error of the initial electrical angle is relatively large.
Correspondingly, the initial mechanical angle=the corrected initial electrical angle/N.
According to the previous two embodiments, in the present disclosure, the electrical cycle of the electric motor may be determined according to the mechanical state of the electric motor (that is, the mechanical angle when the electric motor is powered on or the mechanical position range when the electric motor is powered on). Correspondingly, the unique initial electrical angle of the electric motor may be obtained and the unique initial mechanical angle of the electric motor may be determined. Further, the electrical cycle may be corrected to obtain a more accurate initial mechanical angle.
The present disclosure also provides a gimbal. The gimbal may include an obtaining system for obtaining an initial mechanical angle of an electric motor provided by previous embodiments of the present disclosure. The system may include: a first sensor configured to determine the mechanical state of the electric motor, and a controller connected to the first sensor and configured to obtain an initial electrical angle of the electric motor according to the mechanical state and determine the initial mechanical angle according to the initial electrical angle.
In one embodiment, the gimbal may be a three-axis gimbal. In some other embodiments, the gimbal may be another type of gimbal, and the present disclosure has no limits on this. In one embodiment as illustrated in
Those skilled in the art can clearly understand that for the convenience and brevity of the description, description is made use the division of the above functional modules as an example. In practical applications, the above functions can be realized by different functional modules as needed, that is, the internal structure of the device is divided into different functional modules to complete all or part of the functions described above. For the specific working process of the device described above, reference can be made to the corresponding process in the foregoing method embodiments, which will not be repeated here.
Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present disclosure, not to limit them. Although the present disclosure has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that the technical solutions described in the foregoing embodiments can still be modified, or some or all of the technical features can be equivalently replaced. In the case of no conflict, the features in the embodiments of the present disclosure can be combined arbitrarily; and these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present disclosure.
This application is a continuation of International Application No. PCT/CN2018/094012, filed Jul. 2, 2018, the entire content of which is incorporated herein by reference.
Number | Date | Country | |
---|---|---|---|
Parent | PCT/CN2018/094012 | Jul 2018 | US |
Child | 17119283 | US |