CN105974933A - Self-balance manned electric single-wheel vehicle control method - Google Patents
Self-balance manned electric single-wheel vehicle control method Download PDFInfo
- Publication number
- CN105974933A CN105974933A CN201610327241.6A CN201610327241A CN105974933A CN 105974933 A CN105974933 A CN 105974933A CN 201610327241 A CN201610327241 A CN 201610327241A CN 105974933 A CN105974933 A CN 105974933A
- Authority
- CN
- China
- Prior art keywords
- formula
- wheel
- balance
- matrix
- vehicle body
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 24
- 239000011159 matrix material Substances 0.000 claims description 33
- 230000001360 synchronised effect Effects 0.000 claims description 22
- 238000006073 displacement reaction Methods 0.000 claims description 12
- 230000003993 interaction Effects 0.000 claims description 9
- 238000013178 mathematical model Methods 0.000 claims description 6
- 238000011217 control strategy Methods 0.000 claims description 5
- 230000008878 coupling Effects 0.000 claims description 4
- 238000010168 coupling process Methods 0.000 claims description 4
- 238000005859 coupling reaction Methods 0.000 claims description 4
- 238000005516 engineering process Methods 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000013519 translation Methods 0.000 claims description 3
- 230000004927 fusion Effects 0.000 claims 1
- 230000003287 optical effect Effects 0.000 abstract 2
- 238000005259 measurement Methods 0.000 abstract 1
- 230000006870 function Effects 0.000 description 5
- 230000008569 process Effects 0.000 description 4
- 238000013461 design Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- VYPSYNLAJGMNEJ-UHFFFAOYSA-N Silicium dioxide Chemical compound O=[Si]=O VYPSYNLAJGMNEJ-UHFFFAOYSA-N 0.000 description 1
- 230000002567 autonomic effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000037396 body weight Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000005021 gait Effects 0.000 description 1
- 230000010349 pulsation Effects 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
- 239000000741 silica gel Substances 0.000 description 1
- 229910002027 silica gel Inorganic materials 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000005303 weighing Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
The invention discloses a self-balance manned electric single-wheel vehicle attitude balance control method. The method includes that the attitude information about inclination angle and inclination angle speed of a single-wheel self-balance vehicle body is obtained through measurement by an accelerometer and a gyroscope arranged on the electric single-wheel vehicle, and then on the basis of a system model, an attitude balance control method based on an LQR (Linear Quadratic Regulator) is designed to obtain the optical control quantity of an attitude balance controller through calculation, and at the end, the optical control quantity of the attitude balance controller is taken as the torque current given, a motor is driven by means of a vector control method to move based on the given torque to maintain the attitude balance of the vehicle body. According to the attitude balance control method based on an LQR (Linear Quadratic Regulator), the attitude balance controller based on the LQR is good in rapidity and stability, has the advantage of energy saving, and can realize the attitude balance control of the single-wheel self-balance vehicle.
Description
Technical field
The invention belongs to field of vehicles, autonomic balance before and after relating in a kind of traveling, left and right relies on bicyclist artificial
Control the control method of the Self-balance manned electric unicycle of balance.
Background technology
Purely mechanic wheelbarrow of riding is to need through ad hoc learning and train a kind of activity that just can complete.When riding,
Must simultaneously maintain fore-and-aft direction and left and right directions balance, and ride and need people to exert oneself, gait of march also compares
Low.Electric unicycle is by motor-driven device of riding, with similar, it is only necessary to the balance about grasp is the most permissible
Ride smoothly.Self-balance manned electric unicycle balances before and after controlling car body by reversible pendulum system principle, bicyclist's handle
Foot is individually placed on the folding step of wheel both sides, and body forward is inclined, and in order to keep balance, motor is so quick that to rotate forward,
Whole car body the most just moves forward.
Self-balance manned electric unicycle is the energy-conserving and environment-protective of a new generation, walking-replacing tool easily, by the internal limit of program
It is 18km/h the most at a high speed that system travels, it is ensured that driving safety.The electric unicycle bodily form is small and exquisite, lightweight, is convenient for carrying, permissible
It is placed directly in the boot of automobile, mentions family or office.
The patent of invention of Application No. 201410014863.4 proposes Self-balancing electronic wheelbarrow simple and compact for structure,
But it is not set forth in concrete control program.The patent of invention of Application No. 201210217335.X propose a kind of based on
The Self-balance manned monocycle of inertia balance wheel, it is achieved that left-right balance controls, but the existence of inertia balance wheel, control program
Complex it is not suitable for the most popular electric single-wheel bassinet structure yet.
Summary of the invention
Present invention aims to the deficiencies in the prior art, propose the control of a kind of Self-balance manned electric unicycle
Method.
It is an object of the invention to be achieved through the following technical solutions: the control of a kind of Self-balance manned electric unicycle
Method, the method comprises the steps:
(1) gather the accelerometer being placed on electric unicycle and the data of gyroscope, obtain electric unicycle xyz tri-axle
Accekeration and magnitude of angular velocity;Gather the Hall element signal on permagnetic synchronous motor and threephase stator electric current ia、ib、ic;
(2) accekeration and the magnitude of angular velocity of electric unicycle xyz tri-axle are carried out data by Kalman filtering algorithm
Merge and filter noise signal, obtaining tilt angle theta and the inclination angle speed omega of electric unicycle;
(3) Hall element signal is calculated, obtain actual speed n and the rotor position angle θ of permagnetic synchronous motor;
(4) threephase stator electric current is carried out successively Clarke and Park conversion, obtains the actual torque of permagnetic synchronous motor
Electric current iqWith exciting current id;
(5) take actual speed n, tilt angle theta, inclination angle speed omega are quantity of state, the state equation of system of setting up of deriving:On the basis of the system model set up, use posture balancing control strategy based on LQR, calculate
Excellent controlled quentity controlled variable U (t), U (t)=-R-1BTPX (t), wherein A is sytem matrix, and B is input matrix, and C is output matrix, and R is for controlling
The weight matrix of amount u (t), P is through the calculated positive definite matrix of Riccati equation, and X is state matrix, wherein
(6) give according to the torque current of permagnetic synchronous motorExciting current givesActual torque electric current iqWith encourage
Magnetoelectricity stream id, calculate the d shaft voltage u applied to permagnetic synchronous motordWith q shaft voltage uq;Described torque current is given as step
(5) optimum control amount u (t) that in, posture balancing controller calculates, i.e.Described exciting current gives
(7) according to d shaft voltage udWith q shaft voltage uq, utilize Park inverse transformation to calculate the u under α β coordinate systemαAnd uβ;
(8)uαAnd uβGenerated the control signal of three-phase inverter by SVPWM (space vector pulse width modulation) technology, pass through
Inverter applies three-phase voltage, permagnetic synchronous motor output torque T to permagnetic synchronous motorm, thus keep electric unicycle
Posture balancing.
Further, step (5) described optimum control amount U (t) obtains by the following method:
(5.1) respectively wheel, car body are carried out force analysis to be derived by the mathematical model of system.
Car body is along the x-axis direction from initial displacement point n0Move to np, list the equation of motion of car body:
In formula, n0For axletree central horizontal displacement, and there is n0=vt;npFor vehicle body barycenter horizontal displacement;apFor vehicle body matter
The vertical displacement of the heart.
The motion of wheel can be decomposed into before and after translation and around the rotation of axle, can list the equation of motion:
In formula, HfFrictional ground force suffered by wheel, VN is ground holding power suffered by wheel, H and V is respectively as wheel
And the level between vehicle body, vertical direction interaction force, TmElectromagnetic torque for motor output.
Vehicle body is that vehicle frame becomes a rigid body with people's Approximate Equivalent.Vehicle body barycenter is l to the distance of rotation shaft of wheel.Its motion
Can be decomposed into and move horizontally and around the rotation of axletree.
Set up the equation of motion of vehicle body:
In formula, T is the moment of torsion that wheel is applied to vehicle body, and has T=Tm。
N in formula (2-1)p、ap、n0、a0It is all the function of time t, to np、apSecond dervative is asked to obtain t respectively:
Formula (2-7) is substituted into formula (2-6) and solves interaction force H and V obtained between vehicle body and wheel:
Formula (2-8) is substituted into respectively formula (2-3) and formula (2-6) eliminates interaction force and can obtain:
To formula (2-8), takeFor state variable, u=TmInput is controlled for system
Amount,Export for system, obtain the mathematical model of this system:
In formula,
a1=m+mp+J/r2
a2=mpl
a3=Jp+mpl2
WhenTime, haveSystem (2-9) approximate linearization is processed,
To system linearity state equation:
(5.3) given LQR control optimal performance index functional:
In formula, YrT () is system idea output;Q is the weight matrix of quantity of state X;R be input quantity u weights square
Battle array.
(5.4) according to LQR control theory, the linear state equations of coupling system, obtain optimum control amount U (t)=-R-1B
(t) PX (t) so that quadratic optimal performance index J takes minima.
Further, described step 5.4 particularly as follows:
(5.4.1) performance indications J to be made are minimum, first construct Hamiltonian function:
(5.4.2) when input signal is unfettered, to H derivation and to make its reciprocal value be 0
Solve and obtain optimum control amount:
U (t)=R-1BTλ(t) (3-20)
In formula,
λ (t)=-P (t) X (t) (3-21)
(5.4.3) as t → ∞, P (t) levels off to constant value matrix, andThus obtain RICATTI equation:
PA+ATP+PBR-1BP+Q=0 (3-22)
Unique symmetric positive definite matrix P is solved according to Riccati equation.
(5.4.4) obtain system optimal to control to input:
U (t)=-R-1BTPX(t). (3-23)
In formula (3-23), U (t) is that the LQR quadratic optimal performance index J that enables to through being derived by minimizes value
System optimal controlled quentity controlled variable.
The beneficial effects of the present invention is: combine the application of native system, this LQR control problem can be described as: uses not
Big control energy, make the pitch tilt angle stabilization of single wheel Self-Balancing vehicle near equilibrium point, travel speed can follow the tracks of to
The change of definite value, and make tracking error the least.The present invention, by using posture balancing control strategy based on LQR, takes into account
The control energy consumption of single wheel Self-Balancing vehicle and control performance, use the fewest energy to obtain preferable control performance.By using
Vector control strategy drives electric machine rotation, effectively raises dynamic responding speed and the control accuracy of motor, reduces torque
The body oscillating that causes of pulsation and noise.
Accompanying drawing explanation
Fig. 1 is the structural representation of Self-balance manned electric unicycle;
Fig. 2 is the moving process side view of Self-balance manned electric unicycle
Fig. 3 is wheel and the force analysis figure of vehicle body of Self-balance manned electric unicycle.
Fig. 4 is the control system block diagram of Self-balance manned electric unicycle
Fig. 5 is the workflow diagram of Self-balance manned electric unicycle
Detailed description of the invention
The invention will be further described below in conjunction with the accompanying drawings.
The character definition that the present invention uses is as follows:
As the common knowledge of this area, the electric unicycle of the present invention, including auxiliary wheel 1, wheel 2, permanent magnet synchronous electric
Machine 3, pedal 4, shell 5, controller 6 and set of cells 7, wherein, described controller 6 and set of cells 7 lay respectively at the left and right of shell 4
In two grooves, then fixing with cover plate integral piece with silica gel protected pad, accelerometer and gyroscope 8 are positioned on controller 6, as
Shown in Fig. 1, the electric unicycle for different frame for movements can apply control method of the present invention to realize self-balancing and load
People rides function.The control method of the present invention is as follows:
(1) gather the accelerometer being placed on electric unicycle and the data of gyroscope, obtain electric unicycle xyz tri-axle
Accekeration and magnitude of angular velocity;Gather the Hall element signal on permagnetic synchronous motor and threephase stator electric current ia、ib、ic;
(2) accekeration and the magnitude of angular velocity of electric unicycle xyz tri-axle are carried out data by Kalman filtering algorithm
Merge and filter noise signal, obtaining tilt angle theta and the inclination angle speed omega of electric unicycle;
(3) Hall element signal is calculated, obtain actual speed n and the rotor position angle θ of permagnetic synchronous motor;
(4) threephase stator electric current is carried out successively Clarke and Park conversion, obtains the actual torque of permagnetic synchronous motor
Electric current iqWith exciting current id;
(5) take actual speed n, tilt angle theta, inclination angle speed omega are quantity of state, the state equation of system of setting up of deriving:On the basis of the system model set up, use posture balancing control strategy based on LQR, calculate
Excellent controlled quentity controlled variable U (t), U (t)=-R-1BTPX (t), wherein A is sytem matrix, and B is input matrix, and C is output matrix, and R is for controlling
The weight matrix of amount u (t), P is through the calculated positive definite matrix of Riccati equation, and X is state matrix, wherein
Specific as follows:
(5.1) respectively wheel, car body are carried out force analysis to be derived by the mathematical model of system.
As it is shown in figure 1, car body is along the x-axis direction from initial displacement point n0Move to np, list the equation of motion of car body:
In formula, n0For axletree central horizontal displacement, and there is n0=vt;npFor vehicle body barycenter horizontal displacement;apFor vehicle body matter
The vertical displacement of the heart.
As shown in Fig. 3 (a), the motion of wheel can be decomposed into before and after translation and around the rotation of axle, motion can be listed
Equation:
In formula, HfFrictional ground force suffered by wheel, VNGround holding power suffered by wheel, H and V is respectively as wheel
And the level between vehicle body, vertical direction interaction force, TmElectromagnetic torque for motor output.
Shown in vehicle body force analysis figure such as Fig. 3 (b).Vehicle body is that vehicle frame becomes a rigid body with people's Approximate Equivalent.Vehicle body matter
The heart is l to the distance of rotation shaft of wheel.Its motion can be decomposed into and move horizontally and around the rotation of axletree.
Set up the equation of motion of vehicle body:
In formula, T is the moment of torsion that wheel is applied to vehicle body, and has T=Tm。
N in formula (2-1)p、ap、n0、a0It is all the function of time t, to np、apSecond dervative is asked to obtain t respectively:
Formula (2-7) is substituted into formula (2-6) and solves interaction force H and V obtained between vehicle body and wheel:
Formula (2-8) is substituted into respectively formula (2-3) and formula (2-6) eliminates interaction force and can obtain:
(5.2) to formula (2-8), takeFor state variable, u=TmFor system control
Input quantity,Export for system, obtain the mathematical model of this system:
In formula,
a1=m+mp+J/r2
a2=mpl
a3=Jp+mpl2
Following several conclusions can be obtained by analyzing the system state equation being made up of formula (2-10) and formula (2-11).The
One, this system is a nonlinear system, in non-linear relation between output variable and input, between output variable and input quantity
Also in non-linear relation, between each state variable, there is coupling.Second, this system is a under-actuated systems, controls input quantity
Only one of which, controlling target has travel speed speed, luffing angle and angular velocity multiple.3rd, this system be a parameter not
Determine system, people's height l of single wheel Self-Balancing vehicle of riding, body weight mpCan be variant because of individual different etc. parameter, thus lead
Cause the uncertain of control object parameter.These characteristics of single wheel Self-Balancing vehicle, to controlling to bring difficulty, need during design controller
Consider these factors
Knowable to the system mathematic model set up above, single wheel Self-Balancing vehicle system is high-order, a nonlinear system, gives
The inconvenience of the analytic band of system performance.
(2) system model is carried out linearization process, obtain system linearity state equation
When single wheel Self-Balancing vehicle is properly functioning, luffing angle only changes in little scope near equilibrium point, therefore can be flat
Near weighing apparatus point, system model approximate linearization is processed, thus obtain system linearity state equation.
WhenTime, haveSystem (2-9) approximate linearization is processed,
To system linearity state equation:
(5.3) given LQR control optimal performance index functional:
In formula, YrT () is system idea output;Q is the weight matrix of quantity of state X;R be input quantity u weights square
Battle array.
Q and R chooses the control performance that can affect system, and in matrix Q, element is to the size of element in R, indicates design
Person controls the attention degree of both energy to tracking error and system.In Q and R matrix in real system, the value of each element needs
Determine through experiment, quantity of state weight matrix Q be listed below and control several the principles that energy weight matrix R chooses:
1) generally choosing Q and R is diagonal matrix, in actual application, the most first R value is fixed, and then changes each weights in Q
The numerical value of element, to meet the specific control performance requirement of system requirements
2) selection of Q and R is mutually restriction, interactional, if requiring that the control error of system is little, then the most inevitable
The consumption of energization;In like manner, in order to reduce energy expenditure, would have to sacrifice the required precision of control performance.
3) increase of a certain element in weighting matrices Q, the dynamic response process of its corresponding x (t) is improved, quickly
Property significantly improves;Meanwhile, the steady-state error of other quantity of states can increase, and dynamic response process is deteriorated.
Native system lays particular emphasis on the balance control performance of system, and controls speed real-time less demanding.Therefore take and bow
Elevation angle degree weight element q2More than speed controlling weights element q1Value, luffing angle stablized to obtain, quickly control
System.During real system debugging, first organize parameter according to mentioned above principle test more, eventually find a best parameter of control performance.
(5.4) according to LQR control theory, the linear state equations of coupling system, obtain optimum input quantity U (t)=-R-1B
(t) PX (t) so that quadratic optimal performance index J takes minima.Specific as follows:
(5.4.1) performance indications J to be made are minimum, first construct Hamiltonian function:
(5.4.2) when input signal is unfettered, to H derivation and to make its reciprocal value be 0
Solve and obtain optimum control amount:
U (t)=R-1BTλ(t) (3-20)
In formula,
λ (t)=-P (t) X (t) (3-21)
(5.4.3) as t → ∞, P (t) levels off to constant value matrix, andThus obtain RICATTI equation:
PA+ATP+PBR-1BP+Q=0 (3-22)
Unique symmetric positive definite matrix P is solved according to Riccati equation.
(5.4.4) obtain system optimal to control to input:
U (t)=-R-1BTPX(t). (3-23)
In formula (3-23), U (t) is that the LQR quadratic optimal performance index J that enables to through being derived by minimizes value
System optimal controlled quentity controlled variable.
(6) give according to the torque current of permagnetic synchronous motorExciting current givesActual torque electric current iqAnd excitation
Electric current id, calculate the d shaft voltage u applied to permagnetic synchronous motordWith q shaft voltage uq;Described torque current is given as step
(5) optimum control amount u (t) that in, posture balancing controller calculates, i.e.Described exciting current gives
Particularly as follows: described step (6) particularly as follows:
Torque current gives to use linear PI method to determine, formula is as follows:
Wherein,For torque current ring scale parameter,For torque current ring integral parameter,Give for torque current
Value, iqFor actual torque current value, eiqGive for torque currentWith actual torque electric current iqDifference.
Same, use linear PI algorithm to determine Ud, formula is as follows:
Wherein,For torque current ring scale parameter,For torque current ring integral parameter,Give for exciting current
Value, idFor actual exciting current value, eidGive for exciting currentWith actual exciting current idDifference.
(7) according to d shaft voltage udWith q shaft voltage uq, utilize Park inverse transformation to calculate the u under α β coordinate systemαAnd uβ;
(8)uαAnd uβGenerated the control signal of three-phase inverter by SVPWM (space vector pulse width modulation) technology, pass through
Inverter applies three-phase voltage, permagnetic synchronous motor output torque T to permagnetic synchronous motorm, thus keep electric unicycle
Posture balancing.
Claims (3)
1. the control method of a Self-balance manned electric unicycle, it is characterised in that the method comprises the steps:
(1) gather the accelerometer being placed on electric unicycle and the data of gyroscope, obtain adding of electric unicycle xyz tri-axle
Velocity amplitude and magnitude of angular velocity;Gather the Hall element signal on permagnetic synchronous motor and threephase stator electric current ia、ib、ic;
(2) accekeration and the magnitude of angular velocity of electric unicycle xyz tri-axle are carried out data fusion by Kalman filtering algorithm
And filter noise signal, obtain tilt angle theta and the inclination angle speed omega of electric unicycle;
(3) Hall element signal is calculated, obtain actual speed n and the rotor position angle θ of permagnetic synchronous motor;
(4) threephase stator electric current is carried out successively Clarke and Park conversion, obtains the actual torque electric current i of permagnetic synchronous motorq
With exciting current id;
(5) take actual speed n, tilt angle theta, inclination angle speed omega are quantity of state, the state equation of system of setting up of deriving:On the basis of the system model set up, use posture balancing control strategy based on LQR, calculate
Excellent controlled quentity controlled variable U (t), U (t)=-R-1BTPX (t), wherein A is sytem matrix, and B is input matrix, and C is output matrix, and R is for controlling
The weight matrix of amount u (t), P is through the calculated positive definite matrix of Riccati equation, and X is state matrix, wherein
(6) give according to the torque current of permagnetic synchronous motorExciting current givesActual torque electric current iqAnd exciting current
id, calculate the d shaft voltage u applied to permagnetic synchronous motordWith q shaft voltage uq;Described torque current is given as in step (5)
Optimum control amount u (t) that posture balancing controller calculates, i.e.Described exciting current gives
(7) according to d shaft voltage udWith q shaft voltage uq, utilize Park inverse transformation to calculate the u under α β coordinate systemαAnd uβ;
(8)uαAnd uβThe control signal of three-phase inverter is generated, through inversion by SVPWM (space vector pulse width modulation) technology
Device applies three-phase voltage, permagnetic synchronous motor output torque T to permagnetic synchronous motorm, thus keep the attitude of electric unicycle
Balance.
Method the most according to claim 1, it is characterised in that step (5) described optimum control amount U (t) is by with lower section
Method obtains:
(5.1) respectively wheel, car body are carried out force analysis to be derived by the mathematical model of system.
Car body is along the x-axis direction from initial displacement point n0Move to np, list the equation of motion of car body:
In formula, n0For axletree central horizontal displacement, and there is n0=vt;npFor vehicle body barycenter horizontal displacement;apFor vehicle body barycenter
Vertical displacement.
The motion of wheel can be decomposed into before and after translation and around the rotation of axle, can list the equation of motion:
In formula, HfFrictional ground force suffered by wheel, VNGround holding power suffered by wheel, H and V is respectively as wheel and car
Level between body, vertical direction interaction force, TmElectromagnetic torque for motor output.
Vehicle body is that vehicle frame becomes a rigid body with people's Approximate Equivalent.Vehicle body barycenter is l to the distance of rotation shaft of wheel.Its motion is permissible
It is decomposed into and moves horizontally and around the rotation of axletree.
Set up the equation of motion of vehicle body:
In formula, T is the moment of torsion that wheel is applied to vehicle body, and has T=Tm。
N in formula (2-1)p、ap、n0、a0It is all the function of time t, to np、apSecond dervative is asked to obtain t respectively:
Formula (2-7) is substituted into formula (2-6) and solves interaction force H and V obtained between vehicle body and wheel:
Formula (2-8) is substituted into respectively formula (2-3) and formula (2-6) eliminates interaction force and can obtain:
To formula (2-8), takeFor state variable, u=TmInput quantity is controlled for system,Export for system, obtain the mathematical model of this system:
In formula,
a1=m+mp+J/r2
a2=mpl
a3=Jp+mpl2
WhenTime, haveSystem (2-9) approximate linearization is processed, is
The linear state equations of system:
(5.3) given LQR control optimal performance index functional:
In formula, YrT () is system idea output;Q is the weight matrix of quantity of state X;R be input quantity u weight matrix.
(5.4) according to LQR control theory, the linear state equations of coupling system, obtain optimum control amount U (t)=-R-1B(t)PX
(t) so that quadratic optimal performance index J takes minima.
Method the most according to claim 2, it is characterised in that described step 5.4 particularly as follows:
(5.4.1) performance indications J to be made are minimum, first construct Hamiltonian function:
(5.4.2) when input signal is unfettered, to H derivation and to make its reciprocal value be 0
Solve and obtain optimum control amount:
U (t)=R-1BTλ(t) (3-20)
In formula,
λ (t)=-P (t) X (t) (3-21)
(5.4.3) as t → ∞, P (t) levels off to constant value matrix, andThus obtain RICATTI equation:
PA+ATP+PBR-1BP+Q=0 (3-22)
Unique symmetric positive definite matrix P is solved according to Riccati equation.
(5.4.4) obtain system optimal to control to input:
U (t)=-R-1BTPX(t). (3-23)
In formula (3-23), U (t) is that LQR quadratic optimal performance index J minimizes value is through enabling to of being derived by
System optimum control amount.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610327241.6A CN105974933A (en) | 2016-05-17 | 2016-05-17 | Self-balance manned electric single-wheel vehicle control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610327241.6A CN105974933A (en) | 2016-05-17 | 2016-05-17 | Self-balance manned electric single-wheel vehicle control method |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105974933A true CN105974933A (en) | 2016-09-28 |
Family
ID=56955732
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610327241.6A Pending CN105974933A (en) | 2016-05-17 | 2016-05-17 | Self-balance manned electric single-wheel vehicle control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105974933A (en) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106788076A (en) * | 2016-11-18 | 2017-05-31 | 广东高标电子科技有限公司 | A kind of balance car control method, apparatus and system |
CN109572343A (en) * | 2017-09-29 | 2019-04-05 | 上海领景智能科技有限公司 | A kind of active stabilization vehicle with control device |
CN109947099A (en) * | 2019-03-08 | 2019-06-28 | 安徽大学 | A kind of robot control method and device based on event trigger mechanism |
CN112859877A (en) * | 2021-02-01 | 2021-05-28 | 上海同普电力技术有限公司 | AGV four-steering-wheel synchronous control algorithm |
CN118112921A (en) * | 2024-04-28 | 2024-05-31 | 菏泽学院 | Wheelbarrow balance control method and system based on PID controller |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102079348A (en) * | 2010-12-03 | 2011-06-01 | 北京工业大学 | Self-balance manned monocycle system and control method thereof |
US20110175319A1 (en) * | 2010-01-17 | 2011-07-21 | Shane Chen | Recumbant Style Powered Unicycle |
CN203921102U (en) * | 2014-05-22 | 2014-11-05 | 卜涛 | Electronic self-balancing wheelbarrow control system |
CN104477052A (en) * | 2014-12-05 | 2015-04-01 | 浙江大学 | Control method of self-balancing man-riding electric unicycle |
CN104935226A (en) * | 2015-05-12 | 2015-09-23 | 合肥工业大学 | Control system of electric self-balance wheelbarrow and control method thereof |
-
2016
- 2016-05-17 CN CN201610327241.6A patent/CN105974933A/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110175319A1 (en) * | 2010-01-17 | 2011-07-21 | Shane Chen | Recumbant Style Powered Unicycle |
CN102079348A (en) * | 2010-12-03 | 2011-06-01 | 北京工业大学 | Self-balance manned monocycle system and control method thereof |
CN203921102U (en) * | 2014-05-22 | 2014-11-05 | 卜涛 | Electronic self-balancing wheelbarrow control system |
CN104477052A (en) * | 2014-12-05 | 2015-04-01 | 浙江大学 | Control method of self-balancing man-riding electric unicycle |
CN104935226A (en) * | 2015-05-12 | 2015-09-23 | 合肥工业大学 | Control system of electric self-balance wheelbarrow and control method thereof |
Non-Patent Citations (2)
Title |
---|
LELE WEI ET AL.: "Design and Implement of LQR Controller for a Self-balancing Unicycle Robot", 《PROCEEDING OF THE 2015 IEEE INTERNATIONAL CONFERENCE ON INFORMATION AND AUTOMATION》 * |
申晓峰: "自平衡载人电动独轮车的控制系统研究", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106788076A (en) * | 2016-11-18 | 2017-05-31 | 广东高标电子科技有限公司 | A kind of balance car control method, apparatus and system |
CN106788076B (en) * | 2016-11-18 | 2019-11-05 | 广东高标电子科技有限公司 | A kind of balance car control method, apparatus and system |
CN109572343A (en) * | 2017-09-29 | 2019-04-05 | 上海领景智能科技有限公司 | A kind of active stabilization vehicle with control device |
CN109572343B (en) * | 2017-09-29 | 2024-05-31 | 上海领景智能科技有限公司 | Active stabilization vehicle with control device |
CN109947099A (en) * | 2019-03-08 | 2019-06-28 | 安徽大学 | A kind of robot control method and device based on event trigger mechanism |
CN109947099B (en) * | 2019-03-08 | 2024-05-14 | 安徽大学 | Robot control method and device based on event trigger mechanism |
CN112859877A (en) * | 2021-02-01 | 2021-05-28 | 上海同普电力技术有限公司 | AGV four-steering-wheel synchronous control algorithm |
CN118112921A (en) * | 2024-04-28 | 2024-05-31 | 菏泽学院 | Wheelbarrow balance control method and system based on PID controller |
CN118112921B (en) * | 2024-04-28 | 2024-07-02 | 菏泽学院 | Wheelbarrow balance control method and system based on PID controller |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105974933A (en) | Self-balance manned electric single-wheel vehicle control method | |
CN110175428B (en) | Vehicle dynamic model-based vehicle motion characteristic simulation method and system | |
CN108597058B (en) | Distributed driving electric vehicle state cascade estimation method based on pseudo measurement information | |
CN104477052B (en) | A kind of control method of Self-balance manned electric unicycle | |
CN107839749B (en) | Method for controlling steering road feel and whole vehicle stability of electric wheel vehicle | |
CN102788704B (en) | Based on vehicle handling stability detection system and the detection method of pilot model | |
CN103687783B (en) | Inverted type moving body control setup, its control method and program | |
CN107368081A (en) | A kind of double-wheel self-balancing robot adaptive sliding mode variable structure control system | |
CN114578836B (en) | Jumping control method for double-wheel-foot robot | |
CN102815357A (en) | Self-balancing manned solowheel based on inertia balance wheel | |
CN104749955B (en) | Finite time self-balance control method of single-wheel robot | |
CN103792946B (en) | The signal processing method of motor type reversible pendulum system control and Intelligent self-balancing car whistle control system | |
Petrov et al. | Adaptive steering control for autonomous lane change maneuver | |
CN106452206A (en) | Sliding mode adaptive controller with built-in brushless DC motor current loop control for two-wheeled self-balancing robot | |
CN106078744B (en) | A kind of double-wheel self-balancing robot Sliding Mode Adaptive Control system | |
CN110109354A (en) | A kind of reaction wheel balance-bicycle robot adaptive sliding-mode observer method | |
CN111268011B (en) | Self-balancing vehicle and static balance control method, device, medium and equipment thereof | |
CN107363852A (en) | A kind of omni-directional mobile robots and control method for carrying planar inverted pendulum | |
CN205098368U (en) | Electronic wheel barrow of self -balancing based on gyroscope stabilizer | |
CN106335584A (en) | Double-wheel balance vehicle control system | |
CN201565951U (en) | Single wheel robot system | |
CN111284629B (en) | Self-balancing bicycle and control method thereof | |
JP6506196B2 (en) | Wheel controller | |
CN110379285B (en) | Rectangular pyramid three-dimensional inverted pendulum device and control method | |
CN116945832A (en) | Layered cooperative control method for vehicle active suspension and multi-axle steering system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20160928 |
|
RJ01 | Rejection of invention patent application after publication |