ACCELERATION CONTROL METHOD FOR LOAD ON POWERED BACKPACK BASED ON DISTURBANCE OBSERVER

Abstract

The disclosure belongs to the technical field of powered drive devices, and discloses an acceleration control method for a load on a powered backpack based on a disturbance observer. The method includes: S1 setting the desired acceleration of the load on the powered backpack, presetting the initial motor drive current that regulates the movement of the load according to the desired acceleration, measuring the actual acceleration of the load; S2 establishing the disturbance observer for controlling acceleration the load on the powered backpack, using the disturbance observer to calculate the motor drive current that makes the actual acceleration of the load equal to the desired acceleration, so as to realize the acceleration control of the load on the powered backpack.

Claims

1. An acceleration control method for a load on a powered backpack based on a disturbance observer, comprising the following steps: S1 setting a desired acceleration of the load on the powered backpack, presetting an initial motor drive current according to the desired acceleration, and the load begins to move under driving of the initial motor drive current, and measuring the actual acceleration of the load; S2 establishing a disturbance observer for acceleration control of the load on the powered backpack, and utilizing the disturbance observer to calculate a motor drive current that makes an actual acceleration of the load to be equal to the desired acceleration, thereby achieving acceleration control of the load on the powered backpack, wherein the disturbance observer is operated according to the following calculation formula:
i.sub.o=i.sub.cmd−i.sub.D+i.sub.f wherein i.sub.o is the motor drive current, i.sub.cmd is a command drive current, that is, the sum of command currents generated by feedback control and feedforward control, i.sub.D is a corresponding drive current overcoming the disturbance, and i.sub.f is a friction compensation current, that is, a drive current required to eliminate the influence of a friction force.

2. The acceleration control method for the load on the powered backpack based on the disturbance observer according to claim 1, wherein in step S2, the disturbance observer calculates the corresponding drive current i.sub.D overcoming the disturbance for solution according to the following calculation formula:
i.sub.D=ĩ−i.sub.cmd wherein ĩ is a theoretical value of the command drive current required for the actual acceleration of the load.

3. The acceleration control method for the load on the powered backpack based on the disturbance observer according to claim 1, wherein in step S2, the ĩ obtains the solution according to the following calculation formula:
ĩ=.sup.−1[G.sup.−1(s)F(s)X.sub.sl(s)s.sup.2] wherein X.sub.sl(s)s.sup.2=[{umlaut over (x)}.sub.sl], {umlaut over (x)}.sub.sl is the actual acceleration of the measured load, is Laplace transform, .sup.−1 is inverse Laplace transform, s is a complex frequency, G.sup.−1(s) is an inverse of a second-order linear model of the powered backpack, and F(s) is a low-pass filter.

4. The acceleration control method for the load on the powered backpack based on the disturbance observer according to claim 1, wherein in step S2, the i.sub.cmd obtains solution according to the following calculation formula: $i_{cmd}=i_{\mathrm{ff}}+i_{\mathrm{PID}}$ $i_{\mathrm{ff}}=k_{\mathrm{ff}}{ℒ}^{-1}\left[G^{-1}\left(s\right)F\left(s\right)X_r\left(s\right)s^2\right]$ $i_{\mathrm{PID}}=k_{p}err+k_i\int \mathrm{err}\mathrm{dt}+k_d\frac{\mathrm{derr}}{dt}$ wherein i.sub.ff is a command current of a feedforward term, k.sub.ff is an adjustable feedforward coefficient, X.sub.r(s)s.sup.2=[{umlaut over (x)}.sub.r], the feedforward term is obtained from the calculation of the desired acceleration, i.sub.PID is a command current of a PID feedback term, and a load acceleration tracking deviation is err={umlaut over (x)}.sub.r−{umlaut over (x)}.sub.sl.

5. The acceleration control method for the load on the powered backpack based on the disturbance observer according to claim 1, wherein in step S2, a friction force model comprises viscous friction and Coulomb friction, and a friction compensation current i.sub.f is calculated according to the following formula: $i_f=\frac{k_v{\stackrel{.}{x}}_l+k_c\mathrm{sgn}\left({\stackrel{.}{x}}_l\right)}{k_{\mathrm{bs}}}$ wherein k.sub.v is a viscous friction coefficient, k.sub.c is a Coulomb friction coefficient, {dot over (x)}.sub.l is a first-order derivative of displacement of the load on the backpack, that is, speed, k.sub.bs is a coefficient between the motor drive current and a driving force.

6. The acceleration control method for the load on the powered backpack based on the disturbance observer according to claim 3, where in the G(s) obtains the solution according to the following: (1) establishing a second-order linear model of the powered backpack, an input of a second-order linear model is a command drive current in the motor drive current, and the second-order linear model output is an actual acceleration of the load on the powered backpack, in establishing the second-order linear model, the motor drive current comprises a command drive current and a friction compensation current, the second-order linear model is as follows: $G\left(s\right)=\frac{d}{a{s}^2+\mathrm{bs}+c}$ wherein s is a complex frequency; a, b, c and d are model parameters to be identified, (2) a sinusoidal current of different frequencies is adopted as a command drive current to operate together with the friction compensation current to drive the motor to generate a driving force, the amplitude and the phase of the sinusoidal current are obtained, the actual acceleration of the load under the sinusoidal current signal is measured and collected, so as to obtain an amplitude-frequency and phase-frequency relationship between the sinusoidal current and the actual acceleration of the load at different frequencies; (3) according to the amplitude-frequency and phase-frequency relationship obtained in step (2), fit the second-order linear model in step (1) to obtain the G(s).

7. The acceleration control method for the load on the powered backpack based on the disturbance observer according to claim 5, wherein the k.sub.bs, k.sub.v and k.sub.c are calculated and obtained in the following manner: (1) place the powered backpack horizontally, remove an elastic rope, and control the movement of the load at a constant speed by the motor, under the circumstances, the active force generated by the motor and a friction force have the following relationship when operating together:
k.sub.bsi−k.sub.v{dot over (x)}.sub.l−k.sub.c sgn({dot over (x)}.sub.l)=0 wherein {dot over (x)}.sub.l is a first-order derivative of displacement of the load on the backpack, that is, speed, k.sub.bs is a coefficient between the motor drive current and the driving force, k.sub.v is the viscous friction coefficient, k.sub.c is the Coulomb friction coefficient, t is the motor drive current; (2) fit k.sub.bs, k.sub.v and k.sub.c parameters through least squares method by collecting data i and {dot over (x)}.sub.l.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0030] FIG. 1 is a control block diagram of an acceleration control algorithm based on a disturbance observer constructed according to an embodiment of the disclosure.

[0031] FIG. 2 is a flow chart of the normal operation of the powered backpack constructed according to the embodiment of the disclosure.

[0032] FIG. 3 illustrates a powered backpack that assists the human to walk with loads and is constructed according to an embodiment of the disclosure.

[0033] In all drawings, the same reference numerals are used to denote the same elements or structures.

DESCRIPTION OF THE EMBODIMENTS

[0034] In order to make the purposes, technical solutions and advantages of the disclosure more comprehensible, the disclosure will be further described in detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the disclosure, and are not intended to limit the disclosure. In addition, the technical features involved in the various embodiments of the disclosure described below can be combined with each other as long as there is no conflict with each other.

[0035] As shown in FIG. 3, a powered backpack for assisting human to walk with load is illustrated. The system includes a base plate 7 and a load 9, a ball screw 13, an elastic rope 8, a data acquisition module, a motion control module, a power supply, a controller and a mode switching button provided on the base plate, wherein:

[0036] The ball screw 13 is provided in the center of the base plate 7, the load 9 is provided on the ball screw and moves up and down along the ball screw 13 under the driving of the motion control module. One end of the elastic rope 8 is fixed on the base plate, and the other end is connected to the load through the pulleys 10. Through the traction of the elastic rope on the load, it is possible to balance the gravity of the load in the vertical direction.

[0037] The power supply is connected to the data acquisition module and the motion control module, respectively supplying power to the data acquisition module and the motion control module. The data acquisition module and the motion control module are simultaneously connected to the controller. When the human starts walking with the powered backpack on the back, the mode switching button is used to control the powered backpack to enter an acceleration tracking control mode. In this mode, the data acquisition module collects the acceleration of human body in the vertical direction, and transmits the collected acceleration to the controller. The controller sets the desired acceleration of the load in the vertical direction according to the acceleration, and makes the motion control module to drive the load 9 to move at the desired acceleration on the ball screw 13. When the human stop walking, the mode switching button is used to control the powered backpack to enter the position control mode. In this mode, the data acquisition module collects the position of the load and transmits the position of the load to the controller. The controller makes the load to stay on the ball screw through the motion control module.

[0038] The motion control module includes a motor driver and a servo motor 42. The servo motor 42 is fixed on the support block 14 and connected to the coupler 11, and transmits the active force to the load 9 through the coupler 11, the ball screw 13, and the nut 12 in sequence, thereby adjusting the acceleration of the load to track the desired acceleration, thereby reducing the human metabolic energy consumption during load-carrying walking with the powered backpack. The motor driver works in the current mode, drives the servo motor 42 to generate a corresponding amount of torque according to the received motor drive current signal, and the driving force is transmitted to the load through the ball screw.

[0039] The controller is configured to read all sensor data, after calculation by the control algorithm, the motor drive current signal is transmitted to the motion control module, and the data is transmitted to the upper computer through the communication module. After the motion control module receives the motor drive current signal, the driving motor generates the corresponding amount of driving force, and then the movement of the load is controlled through the transmission mechanism such as ball screw.

[0040] As shown in FIG. 2, the process shown in FIG. 2 is adopted when the powered backpack is working normally. The steps are as follows:

[0041] (a) Initialize each module of the controller and assign initial values to the variables;

[0042] (b) The acceleration tracking control mode of the system is controlled by the mode switching button, the system includes two modes, which are position control mode and acceleration tracking control mode, respectively.

[0043] (c) In the position control mode, the PID control algorithm is adopted to control the load to return to the middle position of the ball screw, the position deviation between the actual position and the desired position is calculated, and the PID control algorithm is adopted to calculate the motor drive current so that the actual position of the load is close to the desired position.

[0044] (d) In the acceleration tracking control mode, the acceleration control method based on the disturbance observer provided in the disclosure is adopted to implement acceleration tracking control, specifically as follows:

[0045] S1 Establish the model of the powered backpack, including the friction model and the second-order linear model, and identify the friction model parameters and the second-order linear model parameters through the experimental method.

[0046] S2 Switch to acceleration tracking control mode through the mode switching button, the controller generates the desired acceleration, and measures the acceleration of the load as the feedback signal.

[0047] S3 As shown in FIG. 1, an acceleration control method based on a disturbance observer is constructed, the disturbance observer is adopted to calculate the drive current required to overcome the disturbance, that is, the disturbance term, a feedforward term is generated based on the desired acceleration, and a feedback term is generated based on the deviation of acceleration tracking. The friction compensation current is calculated according to the movement state of the load and the identified friction model parameters, that is, the friction compensation term, which compensates the friction force in the actual system, and the feedforward term, feedback term, friction compensation term, and disturbance term constitute the motor drive current signal. The corresponding amount of motor drive current generated by the motor driver is controlled by the PWM wave, that is, the magnitude of the torque generated by the motor is regulated, and the actual acceleration of the load is adjusted by the motor drive current so that the actual acceleration is equal to the desired acceleration as much as possible, thereby realizing acceleration tracking control of the load.

[0048] Furthermore, the friction model and the second-order linear model of the powered backpack in step S1 are specifically as follows:

[0049] Establish a friction model which consists of Coulomb friction and viscous friction:

f=k.sub.v{dot over (x)}.sub.l−k.sub.c sgn({dot over (x)}.sub.l)  (1)

[0050] Establish a second-order linear model. The friction force causes the nonlinearity of the system. The actual system containing the nonlinear part is represented by G′(s). After eliminating the influence of the friction force, the powered backpack can be approximated as a second-order linear system G(s). The second-order linear model may be expressed through transfer function:

[00004]$\begin{array}{cc}G\left(s\right)=\frac{d}{a{s}^2+\mathrm{bs}+c}& \left(2\right)\end{array}$

[0051] Specifically: f is the friction force, {dot over (x)}.sub.l represents the first-order derivative of the displacement of the load on the backpack, that is, the speed, k.sub.v represents the viscous friction coefficient, k.sub.c represents the Coulomb friction coefficient, G(s) represents the second-order linear model after eliminating the nonlinear effects caused by the friction force. The common machinery system can be regarded as a second-order system in a limited frequency band. The parameters, k.sub.v, k.sub.c, a, b, c and d are identified through experimental methods.

[0052] The identification method for the friction model is as follows:

[0053] When identifying the friction model by the experimental method, the powered backpack is placed horizontally, the elastic rope is removed, and the load is controlled by the motor to move at a constant speed. Under the circumstances, the active force generated by the motor and the friction force work together to move the load and the motor rotor at a constant speed, that is, the load acceleration is almost zero, {umlaut over (x)}.sub.l≈0, and has the following relationship:

k.sub.bsi−f=M.sub.eq{umlaut over (x)}.sub.l≈0

f=k.sub.v{dot over (x)}.sub.l+k.sub.c sgn({dot over (x)}.sub.l)

that is:

k.sub.bsi−k.sub.v{dot over (x)}.sub.l−k.sub.c sgn({dot over (x)}.sub.l)=M.sub.eq{umlaut over (x)}.sub.l≈0  (3)

[0054] Specifically: {umlaut over (x)}.sub.l represents the second-order derivative of the displacement of the load on the backpack. Under the circumstances, because the powered backpack is placed in a static state, the measured load acceleration {umlaut over (x)}.sub.sl is equal to {umlaut over (x)}.sub.l; k.sub.bs represents the coefficient between the motor drive current and the driving force, i represents the motor drive current, M.sub.eq is the theoretically calculated equivalent mass of the load and the motor rotor of at the load end. Through collection of data i and {dot over (x)}.sub.l, according to formula (3), the least squares method is used to fit the k.sub.bs, k.sub.v and k.sub.c parameters.

[0055] For the identification of the second-order linear model of the powered backpack, it is required to perform friction compensation first, that is, the friction force is eliminated by the driving force of the motor, and the non-linear actual system is transformed into a linear system that is easy to model, then the frequency scanning method is adopted to obtain a linear model of the system, that is, the transfer function. The specific method is: sinusoidal currents of different frequencies are adopted as the input signal of the system, and the sinusoidal currents work together with the friction compensation current to drive the motor to generate driving force, the acceleration signal of the load under this input signal is measured and collected. In this manner, the amplitude-frequency and phase-frequency relationship between sinusoidal current and load acceleration at different frequencies can be obtained. The Matlab system identification toolbox is adopted to fit these discrete amplitude-frequency and phase-frequency data into the transfer function, i.e., G(s).

[0056] Furthermore, in step S3, the specific steps are:

[0057] The load speed signal {dot over (x)}.sub.l can be obtained according to the differential position data obtained by the load drive motor encoder, and the generated friction compensation current is:

[00005]$\begin{array}{cc}{i}_f=\frac{k_v{\stackrel{.}{x}}_l+k_c\mathrm{sgn}\left({\stackrel{.}{x}}_l\right)}{k_{\mathrm{bs}}}& \left(4\right)\end{array}$

[0058] The control algorithm uses the feedforward term and the feedback term to generate the command drive current i.sub.cmd. The feedforward term is generated according to the desired acceleration, and the feedback term generated by the proportional-integral-derivative (PID) controller according to the deviation of the measured actual acceleration of the load and the desired acceleration.

i.sub.cmd=i.sub.ff+i.sub.PID  (5)

[0059] The feedforward term i.sub.ff is generated based on the desired acceleration signal {umlaut over (x)}.sub.r of the load.

i.sub.ff=k.sub.ff.sup.−1[G.sup.−1(s)F(s)X.sub.r(s)s.sup.2]  (6)

[0060] Specifically, is the Laplace transform, .sup.−1[ ] is the inverse Laplace transform, s is the complex frequency, X.sub.r(s)s.sup.2=[{umlaut over (x)}.sub.r], {umlaut over (x)}.sub.r is the desired acceleration, k.sub.ff is the adjustable feedforward coefficient, G.sup.−1(s) is the inverse of the second-order linear model of the powered backpack, and F(s) represents a low-pass filter. The non-causal system G.sup.−1(s) that is not physically achievable is converted into a causal system G.sup.1(s)F(s) that is physically achievable.

[0061] The feedback term i.sub.PID is obtained by the proportional-integral-derivative (PID) controller according to the deviation of the desired acceleration i.sub.r of the load and the measured actual acceleration {umlaut over (x)}.sub.sl.

[00006]$\begin{array}{cc}{i}_{\mathrm{PID}}=k_{p}err+k_i\int \mathrm{err}\mathrm{dt}+k_d\frac{\mathrm{derr}}{dt}& \left(7\right)\end{array}$

[0062] Specifically, K.sub.p, K.sub.i and K.sub.d respectively represent proportional, integral, and differential coefficients, and the load acceleration tracking deviation is expressed as err={umlaut over (x)}.sub.r−{umlaut over (x)}.sub.sl.

[0063] The steps of using the disturbance observer: the actual acceleration {umlaut over (x)}.sub.sl of the measured load, of which Laplace transform is X.sub.sl(s)s.sup.2, the theoretical value of the command drive current required for the actual acceleration of the load is ĩ:

ĩ=.sup.−1[G.sup.−1(s)F(s)X.sub.sl(s)s.sup.2]  (8)

[0064] Specifically, X.sub.sl(s)s.sup.2=[{umlaut over (x)}.sub.sl], {umlaut over (x)}.sub.s1 is the measured actual acceleration of the load.

[0065] The actual acceleration of the load is generated by the combination of the active force generated by the motor and the disturbance received by the system, that is, the theoretical value of the command drive current required for the measured actual acceleration of the load consists of the command drive current i.sub.cmd calculated by the controller in real time and the corresponding drive current i.sub.D overcoming disturbance. Written in the form of current, the drive current corresponding to the observed disturbance is:

i.sub.D=ĩ−i.sub.cmd  (9)

[0066] The motor drive current calculated by the control algorithm is:

i.sub.o=i.sub.cmd−i.sub.D+i.sub.f  (10)

[0067] Those skilled in the art can easily understand that the above are only preferred embodiments of the disclosure and are not intended to limit the disclosure. Any modification, equivalent replacement and improvement made within the spirit and principle of the disclosure should fall within the scope of the disclosure.