This application claims the priority benefit of Taiwan application serial no. 110100082, filed on Jan. 4, 2021. The entirety of the above-mentioned patent application is hereby incorporated by reference herein and made a part of this specification.
The disclosure relates to a driving technology of a mobility assistance device, and particularly relates to a mobility assistance device and a driving method thereof.
As the world's population is aging, many elderly people want to be less dependent on their families and have the ability to walk on their own without other's assistance, the development of mobility assistance devices (or referred to as exoskeleton assistance devices/exoskeleton robots, etc.) with better cost-effective performance is in progress.
Mobility assistance devices (or referred to as exoskeleton assistance devices/exoskeleton robots) can be worn on the user's body, and operate through the assistance force provided by various motors in the mobility assistance devices, thereby increasing the athletic ability of the user's limbs (mainly lower limbs), for example, assisting the user in excising their leg muscles. However, the price of mobility assistance devices remains high. Therefore, in order to reduce the cost of the mobility assistance devices while still maintaining its proper functions, it is necessary to focus on the motor device, which is the most important part of the mobility assistance device, to consider how to save costs and maintain its functions.
Mobility assistance device and other devices equipped with a motor device have different requirements in terms of control for the motor device. For other devices with a motor device, such as a fan, the motor device is expected to constantly maintain a fixed speed so as to achieve the desired effect. However, due to factors such as walking motion and foot support, the motor device provided on a mobility assistance device constantly changes its speed. That is, the motor device will be constantly switched between low and medium speeds, and the adjustment of low and medium speeds is particularly important for the motor device. Moreover, if there is no proper design, and if the motor device is directly switched between low speed and medium speed, motor vibration will often occur, which will cause discomfort to users of the mobility assistance device.
The disclosure provides a mobility assistance device and a driving method thereof. By switching the angle velocity corresponding to the brushless DC (direct current) motor to use the corresponding algorithm, a more accurate rotor angle can be obtained to continuously drive the brushless DC motor, thereby saving the cost for constructing the mobility assistance device, reducing power consumption and improving reliability.
In an embodiment of the disclosure, a mobility assistance device includes at least one bracket and a driving device which drives the at least one bracket. The driving device includes a brushless direct current (DC) motor, a rotor angle sensor, and a sensing driver. The rotor angle sensor senses the angle of the brushless DC motor. The sensing driver is coupled to the rotor angle sensor. The sensing driver uses a corresponding algorithm to estimate a corresponding angle corresponding to an angle velocity switching of the brushless DC motor. The corresponding angle is used as an angle of the brushless DC motor. The sensing driver drives the brushless DC motor according to the corresponding angle, so that the brushless DC motor provides a supporting force to the at least one bracket.
An embodiment of the disclosure provides a driving method of a mobility assistance device. The mobility assistance device includes at least one bracket and a driving device for driving the at least one bracket. The driving device includes a brushless DC motor. The driving method includes the following steps: sensing the angle of the brushless DC motor to determine whether the angle velocity switching of the brushless DC motor occurs; and, corresponding to whether the angle velocity switching of the brushless DC motor occurs, using a corresponding algorithm to estimate a corresponding angle, wherein the corresponding angle is used as the angle of the brushless DC motor. The brushless DC motor is driven according to the corresponding angle, so that the brushless DC motor provides a supporting force to the at least one bracket.
In detail, the brackets of the mobility assistance device 100 include a first bracket 110 (e.g., a thigh bracket used for the user's thigh) and a second bracket 120 (e.g., a calf bracket used for the user's calf). Both the first bracket 110 and the second bracket 120 are coupled to the driving device 130. The sensing driver in the driving device 130 of this embodiment drives the brushless DC motor in the driving device 130 according to the sensed corresponding angle, so that the brushless DC motor in the driving device 130 provides a supporting force respectively to the first bracket 110 and the second bracket 120. The mobility assistance device 100 further includes a first side shield 112 (take the thigh side shield as an example), at least one first strap (such as the first straps 114 and 116) (take the thigh strap as an example), a second side shield 122 (take the calf side shield as an example) and at least one second strap (e.g., second straps 124 and 126) (take the calf strap as an example). The first side shield 112 is fixed to the first bracket 110. The first straps 114 and 116 are connected to the first bracket 110 or the first side shield 112. The first side shield 112 and the first straps 114 and 116 are configured to fix the mobility assistance device 100 on the thigh of the user, so as to facilitate driving the thigh of the user when the driving device 130 provides the supporting force to the first bracket 110.
The second side shield 122 is fixed on the second bracket 120. The second straps 124 and 126 are connected to the second bracket 120 or the first side shield 122. The second side shield 122 and the second straps 124 and 126 are configured to fix the mobility assistance device 100 to the user's calf, so as to facilitate driving the user's calf when the driving device 130 provides the supporting force to the second bracket 120.
When the user is wearing the mobility assistance device 100 and walking, the movement of the user's two legs will switch between standing and swinging.
However, the currently commonly adopted brushless motors will only maintain a fixed speed in the same direction after being driven, instead of adjusting the speed between different modes. Therefore, due to the different application levels of brushless DC motors, there will be substantive differences in the torque and speed detection technology of brushless DC motors.
The main structure of a brushless electric motor can be divided into a rotor and a stator. The rotor in this embodiment is realized as permanent magnets, and the stator in this embodiment is realized as coils. The brushless DC motor drives the rotor by changing the magnetic field on the stator, so that the motor rotates as a whole. The detection technology of the torque and speed of the brushless DC motor is mainly to detect the angle between the rotor and the stator for the reason that this angle will directly affect the torque and speed of the motor. If the angle between the rotor and the stator cannot be accurately detected or determined, the mobility assistance device 100 will make erroneous judgment when supplying power to the driving device 130 and provide a current that is slightly larger or smaller, and consequently the torque and speed of the driving device 130 will not achieve an expected level. As a result, the driving device 130 often encounters motor vibration, causes noise, and the energy conversion efficiency of the driving device 130 is low, and the user feels a strong sense of discomfort.
There are many types of methods for detecting the angle between the rotor and the stator of a brushless DC motor, such as algorithms used by a Hall sensor, a step encoder, and sensorless control, etc.
The torque, speed and output power of the brushless DC motor can be shown in
In the control technology of brushless DC motors, the magnetic field on the coil (that is, the “stator”) generates different torques due to the change in the position of the rotor.
This embodiment considers three control techniques for detecting the angle of the rotor 410 of a brushless DC motor, which are encoder control, Hall sensor control, and sensorless control respectively. The three types of control techniques are described briefly.
“Encoder control” is the best choice of control techniques where the encoder serves as the rotor angle sensor of the brushless DC motor in ideal conditions. However, the cost of the encoder is high, and when the encoder is designed in a brushless DC motor, there are problems such as a complicated mechanical structure.
“Hall sensor control” is to set up three Hall sensors on the brushless DC motor at intervals with 120 degrees to obtain the rotor position. The current rotor angle can be estimated by using the angle sensed by the Hall sensor at the previous sampling time plus the sampling time and the current angle velocity. Since each state of the Hall sensor represents an interval of 60 degrees, every time the state of the Hall sensor changes, it means that a 60-degree rotation has occurred. However, when the motor rotates at a high speed, the estimation error of the speed of the Hall sensor becomes larger.
The principle of “sensorless control” is that the rotor (permanent magnet) generates magnetic induction to the stator (coil winding) when the brushless DC motor rotates. Moreover, it can be learned from the Lenz's Law that when a conductor has magnetic induction, the conductor will generate a corresponding back electromotive force. Therefore, the input voltage and input current supplied to the brushless DC motor, as well as various parameters of the motor (such as the equivalent resistance, the equivalent inductance of the motor, etc.) can be adopted to deduce the angle information through the back electromotive force. In other words, the sensorless angle compensation algorithm can estimate the back electromotive force only when the parameters of the motor and the power supply to the motor (such as the voltage and current supplied to the motor) are determined. Although “sensorless control” has high rotor angle accuracy, the rotor angle can be estimated only when the motor has the back electromotive force. Therefore, when the motor is stationary, the rotor angle cannot be estimated.
Therefore, the embodiments of the disclosure can adopt the corresponding algorithm to estimate the angle of the brushless DC motor corresponding to the angle velocity switching in the speed change of the brushless DC motor, thereby using the estimated angles to drive the brushless DC motor. In detail, when the speed of the brushless DC motor is low, the Hall sensor angle compensation algorithm is adopted to calculate the angle of the brushless DC motor at this time point. When the brushless DC motor rotates at a specific speed, the angle of the brushless DC motor at this time point can be calculated through the sensorless control technology (that is, the sensorless angle compensation algorithm) and the back electromotive force of the brushless DC motor. By using this approach mixed and matched with the sensorless angle compensation algorithm (also known as sensorless control) and the Hall sensor angle compensation algorithm of the brushless DC motor, it is possible to obtain an accurate rotor angle in the motor, thereby accurately controlling the driving current supplied to the motor, reducing the vibration of motor and decreasing the discomfort caused to the user when using the mobility assistance device.
In this embodiment, it can be seen from
In addition, when the motor is activated to switch from a low speed to a high speed, because the rotor angle velocity is zero, there is no back electromotive force to generate voltage and current, it is impossible to perform operation with the sensorless algorithm. Therefore, the Hall sensor needs to be adopted and cooperate with the Hall algorithm to drive the motor and estimate the rotor angle.
In the embodiment, the “angle velocity switching of a brushless DC motor” refers to the switching of angle velocity of the brushless DC motor under two conditions. That is, one of the conditions mentioned above is that the brushless DC motor switches from a high speed/high angle velocity (also called the first speed range) to a low speed/low angle velocity (also called the second speed range). The other condition mentioned above is that the brushless DC motor switches from a low speed/low angle velocity (second speed range) to a high speed/high angle velocity (first speed range). The aforementioned “high speed/high angle velocity” (first speed range) and “low speed/low angle velocity” (second speed range) can be determined through the predetermined speed. The first speed range indicates the state where the angle of the brushless DC motor is larger than the predetermined speed when the rotor angle sensor (Hall sensor) detects the rotor angle of the brushless DC motor and generates the detection result. The second speed range indicates the state where the angle of the brushless DC motor is smaller than the predetermined speed when the rotor angle sensor (Hall sensor) detects the rotor angle of the brushless DC motor and generates the detection result.
However, whether the sensorless algorithm is operating normally cannot be determined accurately based on the speed of the motor alone. In order to avoid that the sensorless angle compensation algorithm might not operate normally, this embodiment also performs subtraction on the angle calculated through the sensorless angle compensation algorithm and the angle calculated through the Hall sensor angle compensation algorithm to obtain the angle error value of the two angles as the maximum error reference. Meanwhile, the predetermined sensitivity value is adopted to determine whether the error value of the two angles is significantly different from, for example, the predetermined sensitivity value. In that case, the algorithm needs to be adjusted to adopt the angle calculated through the Hall sensor angle compensation algorithm as the rotor angle. In other words, when the angle error value is smaller than or equal to the predetermined sensitivity value, it means that the two angle values calculated through the sensorless angle compensation algorithm and the Hall sensor angle compensation algorithm are similar. In this embodiment, the angle value calculated through the sensorless angle compensation algorithm is adopted as the rotor angle in the motor. Conversely, when the angle error value is larger than the predetermined sensitivity value, it means that the sensorless angle compensation algorithm may not work normally. Therefore, the angle value calculated through the Hall sensor angle compensation algorithm is adopted instead as the rotor angle in the motor.
On the other hand, when the motor is switched from a high speed to a low speed, the algorithm for estimating the rotor angle in the motor will be switched from the sensorless algorithm to the Hall algorithm. In this embodiment, an angle velocity (for example, 500 RPM serves as the reference for determining the speed) for switching is designed as a standard for the motor at low speed. Such design is made to prevent the motor from stopping unexpectedly due to external force or braking action when the embodiment performs the sensorless algorithm, and the unexpected stop of motor will cause the driver to act abnormally. In this embodiment, it is also simultaneously determined whether the Hall sensor and the corresponding Hall algorithm are operating normally to ensure the normal operation of the sensorless algorithm.
In step S820, the sensing driver uses the first angle compensation algorithm (that is, the Hall sensor angle compensation algorithm) to estimate the first angle. The first angle compensation algorithm (Hall sensor angle compensation algorithm) estimates the first angle mainly based on the detection result of the brushless DC motor 610. In step S830, the sensing driver 620 adopts the second angle compensation algorithm (that is, the sensorless angle compensation algorithm) to estimate the second angle. The second angle compensation algorithm (sensorless angle compensation algorithm) calculates the back electromotive force of the brushless DC motor 610 to estimate the second angle mainly based on the input current of the brushless DC motor 610 and multiple parameters of the brushless DC motor 610 (such as equivalent resistance, equivalent inductance, etc.). Steps S720 and S730 can be carried out simultaneously or in sequence.
In step S840, the sensing driver 620 decides to use the first angle or the second angle as the angle of the brushless DC motor 610. The sensing driver 620 in this embodiment mainly determines whether the current speed of the brushless DC motor 610 exceeds a predetermined speed (for example, 500 RPM), thereby determining whether to use the first angle or the second angle as the angle of the brushless DC motor 610. In addition, the sensing driver 620 in this embodiment can also calculate the current angle error between the first angle and the second angle, so as to determine whether the current angle error is greater than a predetermined sensitivity, and thereby deciding whether to use the first angle or the second angle as the angle in the brushless DC motor 620. In step S850, the sensing driver 620 determines the input current to be provided according to the angle in the brushless DC motor 610, so as to continue to drive the brushless DC motor 610. For example, the vector control algorithm of the motor can be adopted to convert the three-way current of the stator into the rotor coordinate vector; the current controller can be adopted to convert the input current and the control current into voltage commands; the voltage vector of the rotor can be converted to the three-way voltage of the stator. Moreover, the power stage circuit 630 can be adopted to set the switching state generated by the inverter algorithm.
If the determining result in step S910 is NO, then step S930 is performed, and the sensing driver 620 determines whether the current angle error between the first angle and the second angle is larger than the predetermined sensitivity, or whether the current speed of the brushless DC motor 610 does not exceed the predetermined speed (for example, 500 RPM). When one of the determining results in step S930 is YES (the current angle error between the first angle and the second angle is greater than the predetermined sensitivity, or the current speed of the brushless DC motor 610 does not exceed the predetermined speed), step S935 is performed to change the currently used angle compensation algorithm to the first angle compensation algorithm (Hall sensor angle compensation algorithm). When all the determining results in step S930 are NO (for example, the current angle error between the first angle and the second angle is smaller than the predetermined sensitivity and the current speed of the brushless DC motor 610 exceeds the predetermined speed), step S940 is performed, and no adjustment is made to the currently used angle compensation algorithm.
In step S940, the sensing driver 620 determines whether the current angle compensation algorithm is the first angle compensation algorithm (Hall sensor angle compensation algorithm). If the determining result in step S940 is YES, the sensing driver 620 adopts the first angle as the angle in the brushless DC motor 610. If the determining result in step S940 is NO, the sensing driver 620 adopts the second angle as the angle in the brushless DC motor 610. When step S950 or step S960 ends, return to step S910 to continue the process.
In summary, the mobility assistance device and the driving method thereof in the embodiments of the disclosure adopt a mixed use of the sensorless angle compensation algorithm (also known as sensorless control) and the Hall sensor angle compensation algorithm directed at the brushless DC motor. In other words, when the speed of the brushless DC motor is low, the Hall sensor angle compensation algorithm is adopted to calculate the angle of the brushless DC motor at this time point; when the brushless DC motor operates at a specific speed, the sensorless control technology (that is, the sensorless angle compensation algorithm) and the back electromotive force of the brushless DC motor are adopted to calculate the angle of the brushless DC motor at this time point. In addition, subtraction is performed on the angle calculated through the sensorless angle compensation algorithm and the angle calculated through the Hall sensor angle compensation algorithm to obtain the angle error value of the two angles. Furthermore, the predetermined sensitivity value is adopted to determine whether the error value of the two angles is significantly different from, for example, the predetermined sensitivity value, in which case the angle calculated through the Hall sensor angle compensation algorithm will be adopted instead. In this way, the brushless DC motor in the embodiment of the disclosure is not equipped with the most accurate (but also the most expensive) stepping encoder, but instead is equipped with a low-accuracy but relatively inexpensive Hall sensor. Moreover, when the speed of the motor is high, the calculation of the rotor angle is changed from the Hall sensor angle compensation algorithm to a more accurate sensorless angle compensation algorithm. As such, the construction cost for the mobility assistance device can be saved, power consumption can be reduced, and reliability can be improved. In addition, the embodiment of the disclosure can provide a driving circuit more accurately by accurately acquiring the rotor angle of the motor, thereby reducing the vibration of the motor and reducing the discomfort when using the mobility assistance device.
Number | Date | Country | Kind |
---|---|---|---|
110100082 | Jan 2021 | TW | national |
Number | Name | Date | Kind |
---|---|---|---|
9727076 | Smith | Aug 2017 | B2 |
10765537 | Smith | Sep 2020 | B2 |
11241801 | Smith | Feb 2022 | B2 |
11759944 | Smith | Sep 2023 | B2 |
20180193172 | Smith | Jul 2018 | A1 |
20200397600 | Smith et al. | Dec 2020 | A1 |
20200397601 | Smith et al. | Dec 2020 | A1 |
Number | Date | Country |
---|---|---|
107147343 | Sep 2017 | CN |
110757460 | Feb 2020 | CN |
2000188891 | Jul 2000 | JP |
2008301550 | Dec 2008 | JP |
2014087113 | May 2014 | JP |
2014087217 | May 2014 | JP |
2018153911 | Oct 2018 | JP |
I356578 | Jan 2012 | TW |
I687037 | Mar 2020 | TW |
2015093056 | Jun 2015 | WO |
WO-2015093056 | Jun 2015 | WO |
Entry |
---|
Bilal Akin et al., “Sensorless Field Oriented Control of 3-Phase Permanent Magnet Synchronous Motors” , Texas Instruments Incorporated, Jul. 2013, pp. 1-43. |
Puru Zhang et al., “A Controller of PMSM for Elctrical Bicycle with Hall Effect Sensors”, 2016 IEEE 11th Conference on Industrial Electronics and Applications, Jun. 2016, pp. 619-623. |
“Office Action of Taiwan Counterpart Application”, dated Sep. 6, 2021, p. 1-p. 12. |
“Office Action of China Counterpart Application”, dated Jun. 29, 2023, p. 1-p. 7. |
“Office Action of Japan Counterpart Application”, dated Oct. 4, 2022, p. 1-p. 3. |
Number | Date | Country | |
---|---|---|---|
20220216816 A1 | Jul 2022 | US |