CN107643760A - A kind of coaxial two wheels robot balance controller based on LQR algorithms - Google Patents
A kind of coaxial two wheels robot balance controller based on LQR algorithms Download PDFInfo
- Publication number
- CN107643760A CN107643760A CN201710732832.6A CN201710732832A CN107643760A CN 107643760 A CN107643760 A CN 107643760A CN 201710732832 A CN201710732832 A CN 201710732832A CN 107643760 A CN107643760 A CN 107643760A
- Authority
- CN
- China
- Prior art keywords
- mtd
- mrow
- mtr
- msub
- mover
- 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 claims abstract description 7
- 238000004458 analytical method Methods 0.000 claims description 3
- 230000037396 body weight Effects 0.000 claims description 2
- 230000000694 effects Effects 0.000 claims description 2
- 238000004088 simulation Methods 0.000 claims description 2
- 239000011159 matrix material Substances 0.000 claims 4
- 238000013461 design Methods 0.000 abstract description 3
- 238000013459 approach Methods 0.000 abstract description 2
- 238000006073 displacement reaction Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000013480 data collection Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 230000035515 penetration Effects 0.000 description 1
Landscapes
- External Artificial Organs (AREA)
Abstract
The present invention devises a kind of coaxial two wheels robot balance controller based on LQR algorithms, establishes coaxial two wheels robot nonlinear model according to Newtonian mechanics analytic approach first, and then linearizes and decouple the model, finally designs balance controller according to inearized model;It is characterized in that:Described coaxial two wheels robot is that one kind is rigidly connected in being studied herein, i.e., the car body of robot and wheel are independent;The balance controller of described coaxial two wheels robot is to be based on feedback of status Method of Pole Placement, i.e., using the characteristic of controlled system arbitrary disposition limit in the case of controllable, coaxial two wheels robot is reached plateau within the short time in the case of initial interference;The balance controller of described coaxial two wheels robot introduces LQR algorithms, when controlled system be it is linear or linearisation, can take into account multinomial performance index with optimum control, coaxial two wheels robot is reached plateau within the short time in the case of initial interference.
Description
Technical field
The present invention relates to a kind of coaxial two wheels robot balance controller based on LQR algorithms, specifically controller is base
Designed in the thought of feedback of status with Method of Pole Placement and LQR algorithms, then by MATLAB simulation analysis control performances,
Mainly solve the balance control problem of coaxial two wheels robot, belong to robot technology research field.
Background technology
With the fast development of society, the mankind are also improving to the demand of intelligence degree, and the appearance of robot is when drawing
Generation, it according to the thought of people, can assist or substitute the work of human work, such as production industry, manufacturing industry or dangerous work;
And coaxial two wheels robot is because of its unique texture, efficient and convenient, flexibility and the characteristic such as easily controllable, be widely used in industrial production,
Civilian or show business, has research on theory and practice meaning, and the present invention is namely based on coaxial two wheels robot extensively using property and spirit
On the basis of activity, then data collection and first pertinent literature balance control problem to solve it.
The content of the invention
The present invention designs a kind of coaxial two wheels robot balance controller based on LQR algorithms.
The present invention is achieved by the following technical solutions:A kind of coaxial two wheels robot balance controller based on LQR algorithms,
Coaxial two wheels robot nonlinear model is established according to Newtonian mechanics analytic approach first, and then linearizes and decouples the model, finally
Balance controller is designed according to inearized model.
Described coaxial two wheels robot is that one kind is rigidly connected in being studied herein, i.e., the car body of robot and wheel are independent
's.
The balance controller of described coaxial two wheels robot is to be based on feedback of status Method of Pole Placement, i.e., is existed using controlled system
The characteristic of arbitrary disposition limit in the case of controllable, finally makes coaxial two wheels robot reach steady within the short time in the case of initial interference
State.
The balance controller of described coaxial two wheels robot introduces LQR algorithms, when controlled system be it is linear or linearisation, fortune
Multinomial performance index can be taken into account with optimum control, coaxial two wheels robot is reached steady within the short time in the case of initial interference
State.
The usefulness of the invention is, for coaxial two wheels robot moving equilibrium problem, to be balanced setting for controller herein
Meter, the controller using the quantity of state that system export as research point of penetration, using feedback of status thought, introducing Method of Pole Placement with
LQR algorithms, design is simple, and control performance is good, and LQR controllers can make robot reach plateau, stability in the short time again
More preferably, this is exactly the coaxial two wheels robot target to be reached.
Brief description of the drawings
Accompanying drawing 1 is coaxial two wheels robot stress diagram
In figure:M is car body weight, and m is wheel weight, JωIt is wheel to wheel shaft rotary inertia, JθZ-axis is rotated for wheel used
Amount, JθIt is wheel to y-axis rotary inertia, R is radius of wheel, and D is wheel spacing, and L is the distance that Z axis arrives car body barycenter, and C is defeated
Enter torque, f is to smear frictional force.
Accompanying drawing 2 is POLE PLACEMENT USING simulating schematic diagram
In figure:Subsystem is coaxial two wheels robot nonlinear model.
Accompanying drawing 3 is pitch angle control curve map
In figure:1 is rate curve, and 2 be inclination angle rate curve, and 3 be displacement curve, and 4 be tilt curves.
Accompanying drawing 4 is Bit andits control curve map
In figure:1 is inclination angle rate curve, and 2 be rate curve, and 3 be tilt curves, and 4 be displacement curve.
Accompanying drawing 5 is LQR simulating schematic diagrams
Accompanying drawing 6 is pitch angle control curve map
In figure:1 is rate curve, and 2 be displacement curve, and 3 be tilt curves, and 4 be inclination angle rate curve.
Accompanying drawing 7 is Bit andits control curve map
In figure:1 is tilt curves, and 2 be displacement curve, and 3 be rate curve, and 4 be inclination angle rate curve.
For the ordinary skill in the art, according to the teachings of the present invention, do not depart from the principle of the present invention with
In the case of spirit, the changes, modifications, replacement and the modification that are carried out to embodiment still fall within protection scope of the present invention it
It is interior.
Claims (4)
1. a kind of coaxial two wheels robot balance controller based on LQR algorithms, comprises the following steps:Analyzed according to Newton classic mechanics
The nonlinear model that method establishes coaxial two wheels robot is as follows:
<mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>M</mi>
<mo>+</mo>
<mn>2</mn>
<mi>m</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>J</mi>
<mi>&omega;</mi>
</msub>
</mrow>
<msup>
<mi>R</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>M</mi>
<mi>L</mi>
<mrow>
<mo>(</mo>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mo>-</mo>
<msup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mi>R</mi>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>l</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>J</mi>
<mi>p</mi>
</msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>M</mi>
<mi>g</mi>
<mi>L</mi>
<mi> </mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&theta;</mi>
<mo>-</mo>
<msup>
<mi>ML</mi>
<mn>2</mn>
</msup>
<msup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&theta;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mo>-</mo>
<msup>
<mi>ML</mi>
<mn>2</mn>
</msup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<msup>
<mi>sin</mi>
<mn>2</mn>
</msup>
<mi>&theta;</mi>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<mfrac>
<mrow>
<mi>L</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
</mrow>
<mi>R</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>l</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<mi>L</mi>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<mfrac>
<msub>
<mi>J</mi>
<mi>&omega;</mi>
</msub>
<msup>
<mi>R</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>(</mo>
<mi>D</mi>
<mi>m</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>J</mi>
<mi>&delta;</mi>
</msub>
</mrow>
<mi>D</mi>
</mfrac>
<mo>+</mo>
<mfrac>
<mrow>
<msub>
<mi>DJ</mi>
<mi>&omega;</mi>
</msub>
</mrow>
<msup>
<mi>R</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>)</mo>
<mover>
<mi>&delta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mi>R</mi>
</mfrac>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>l</mi>
</msub>
<mo>-</mo>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
Due to non-linear factor be present, control degree-of-difficulty factor greatly compared with, therefore herein for robot nonlinear model carry out it is linear
Change is handled, and model is as follows:
<mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>M</mi>
<mo>+</mo>
<mn>2</mn>
<mi>m</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>J</mi>
<mi>&omega;</mi>
</msub>
</mrow>
<msup>
<mi>R</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>M</mi>
<mi>L</mi>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mi>R</mi>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>l</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>J</mi>
<mi>P</mi>
</msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>M</mi>
<mi>g</mi>
<mi>L</mi>
<mi>&theta;</mi>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<mfrac>
<mi>L</mi>
<mi>R</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>l</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<mi>L</mi>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<mfrac>
<msub>
<mi>J</mi>
<mi>&omega;</mi>
</msub>
<msup>
<mi>R</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>(</mo>
<mi>D</mi>
<mi>m</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>J</mi>
<mi>&delta;</mi>
</msub>
</mrow>
<mi>D</mi>
</mfrac>
<mo>+</mo>
<mfrac>
<mrow>
<msub>
<mi>DJ</mi>
<mi>&omega;</mi>
</msub>
</mrow>
<msup>
<mi>R</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>)</mo>
<mover>
<mi>&delta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mi>R</mi>
</mfrac>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>l</mi>
</msub>
<mo>-</mo>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
Lienarized equation is converted into matrix form again:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>M</mi>
<mo>+</mo>
<mn>2</mn>
<mi>m</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>J</mi>
<mi>&omega;</mi>
</msub>
</mrow>
<msup>
<mi>R</mi>
<mn>2</mn>
</msup>
</mfrac>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>M</mi>
<mi>L</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mn>2</mn>
<mi>L</mi>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<mfrac>
<msub>
<mi>J</mi>
<mi>&omega;</mi>
</msub>
<msup>
<mi>R</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<msub>
<mi>J</mi>
<mi>P</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>D</mi>
<mi>m</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>J</mi>
<mi>&delta;</mi>
</msub>
</mrow>
<mi>D</mi>
</mfrac>
<mo>+</mo>
<mfrac>
<mrow>
<msub>
<mi>DJ</mi>
<mi>&omega;</mi>
</msub>
</mrow>
<msup>
<mi>R</mi>
<mn>2</mn>
</msup>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&delta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mfrac>
<mn>1</mn>
<mi>R</mi>
</mfrac>
</mtd>
<mtd>
<mfrac>
<mn>1</mn>
<mi>R</mi>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>M</mi>
<mi>g</mi>
<mi>L</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mi>R</mi>
</mfrac>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mi>R</mi>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mfrac>
<mn>1</mn>
<mi>R</mi>
</mfrac>
</mtd>
<mtd>
<mfrac>
<mn>1</mn>
<mi>R</mi>
</mfrac>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>&theta;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>C</mi>
<mi>l</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
Wherein, M is car body weight, and m is wheel weight, JωIt is wheel to wheel shaft rotary inertia, JθIt is wheel to z-axis rotary inertia,
JθIt is wheel to y-axis rotary inertia, R is radius of wheel, and D is wheel spacing, and L is the distance that Z axis arrives car body barycenter, and C is inputs
Torque.
Found out according to matrix form, it will be seen that coefficient matrices A is block diagonal matrix, that is, is shown on balancing 4 with speed control
Individual state variable is unrelated with 2 state variables on course changing control, therefore for the ease of theory analysis, utilizes decoupling side herein
Method carries out decoupling processing to the matrix form of lienarized equation, and substitutes into relevant parameter and obtain following two subsystems:
Balance and forward system:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mn>23.7097</mn>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>83.7742</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>x</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>&theta;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>1.8332</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>-</mo>
<mn>4.9798</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<msub>
<mi>C</mi>
<mi>&theta;</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
Steering:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mover>
<mi>&delta;</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&delta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>&delta;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&delta;</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>5.1519</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<msub>
<mi>C</mi>
<mi>&delta;</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
The balance control problem of this paper primary study coaxial two wheels robots, i.e., balance controller is designed according to above-mentioned formula (7), recycled
The effect of MATLAB simulation analysis balance control.
2. the coaxial two wheels robot balance controller according to claim 1 based on LQR algorithms, it is characterised in that:Described
Coaxial two wheels robot is that one kind is rigidly connected in being studied herein, i.e., the car body of robot and wheel are independent.
3. the coaxial two wheels robot balance controller according to claim 1 based on LQR algorithms, it is characterised in that:Described
The balance controller of coaxial two wheels robot is to be based on feedback of status Method of Pole Placement, i.e., using controlled system in the case of controllable it is any
The characteristic of assigned pole, coaxial two wheels robot is finally set to reach plateau within the short time in the case of initial interference.
4. the coaxial two wheels robot balance controller according to claim 1 based on LQR algorithms, it is characterised in that:Described
The balance controller of coaxial two wheels robot introduces LQR algorithms, can be simultaneous with optimum control when controlled system is linear or linearisation
Multinomial performance index is cared for, coaxial two wheels robot is reached plateau within the short time in the case of initial interference.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710732832.6A CN107643760A (en) | 2017-08-24 | 2017-08-24 | A kind of coaxial two wheels robot balance controller based on LQR algorithms |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710732832.6A CN107643760A (en) | 2017-08-24 | 2017-08-24 | A kind of coaxial two wheels robot balance controller based on LQR algorithms |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107643760A true CN107643760A (en) | 2018-01-30 |
Family
ID=61110622
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710732832.6A Pending CN107643760A (en) | 2017-08-24 | 2017-08-24 | A kind of coaxial two wheels robot balance controller based on LQR algorithms |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107643760A (en) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100292840A1 (en) * | 2009-05-15 | 2010-11-18 | Beijing University Of Technology | Flexible two-wheeled self-balancing robot system and its motion control method |
CN104298113A (en) * | 2014-10-22 | 2015-01-21 | 五邑大学 | Self-adaptive fuzzy balance controller for two-wheeled robot |
CN106078744A (en) * | 2016-06-30 | 2016-11-09 | 杭州电子科技大学 | A kind of double-wheel self-balancing robot Sliding Mode Adaptive Control system |
-
2017
- 2017-08-24 CN CN201710732832.6A patent/CN107643760A/en active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100292840A1 (en) * | 2009-05-15 | 2010-11-18 | Beijing University Of Technology | Flexible two-wheeled self-balancing robot system and its motion control method |
CN104298113A (en) * | 2014-10-22 | 2015-01-21 | 五邑大学 | Self-adaptive fuzzy balance controller for two-wheeled robot |
CN106078744A (en) * | 2016-06-30 | 2016-11-09 | 杭州电子科技大学 | A kind of double-wheel self-balancing robot Sliding Mode Adaptive Control system |
Non-Patent Citations (3)
Title |
---|
GAO X S等: "Two typesTwo types of coaxial self-balancing robots of coaxial self-balancing robots" * |
杨慧;王富东;: "自平衡两轮移动机器人的LQR控制策略研究" * |
武俊峰;孙雷;: "两轮自平衡机器人的控制方法研究" * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106647783B (en) | Three rotor wing unmanned aerial vehicle posture of tilting type and height adaptive robust control method | |
CN106125728B (en) | A kind of 4 wheel driven wheeled mobile robot trace tracking and controlling method | |
CN105116729B (en) | A kind of double-wheel self-balancing robot adaptive sliding mode variable structure control method | |
CN108445895B (en) | Robust control method for position control of tilting type three-rotor unmanned aerial vehicle | |
CN102163059B (en) | Attitude control system and attitude control method of variable thrust unmanned aerial vehicle | |
CN109116860B (en) | Nonlinear robust control method for three-rotor unmanned aerial vehicle | |
CN105676641A (en) | Nonlinear robust controller design method based on back-stepping and sliding mode control technologies and aimed at nonlinear model of quad-rotor unmanned plane | |
CN107608367A (en) | The rotor wing unmanned aerial vehicle track of multivariable interference compensation four and posture cooperative control method | |
CN105946858A (en) | Method for optimizing parameters of four-driving electric car state observer based on genetic algorithm | |
CN105159305A (en) | Four-rotor flight control method based on sliding mode variable structure | |
CN104765272A (en) | Four-rotor aircraft control method based on PID neural network (PIDNN) control | |
CN108090302B (en) | Helicopter flight mechanics simulation method and system | |
CN103853050A (en) | PID optimization control method of four-rotor aircraft | |
CN108803648A (en) | Unmanned vehicle robust attitude control method, device and electronic equipment | |
CN103869817A (en) | Vertical take-off and landing control method for quad-tilt-rotor unmanned aerial vehicle | |
CN107092725A (en) | A kind of vehicle distributed load Optimization Design based on closed-loop simulation | |
CN102707616B (en) | Aircraft triangle model-based controller area design method | |
CN102880051A (en) | Fuzzy sliding mode drive control method for wheeled mobile robot | |
CN102692928B (en) | Controller region design method based on quaternion model of aircraft | |
CN114089780B (en) | Urban space-oriented multi-rotor unmanned aerial vehicle path planning method | |
CN103268368B (en) | A kind of crin Gen Beierge bevel gear contact adjusting method | |
CN111061282A (en) | Four-rotor unmanned aerial vehicle suspension flight system control method based on energy method | |
CN102707722B (en) | Omni-dimensional controller area designing method based on normal aircraft model | |
CN110377044A (en) | A kind of the finite time height and Attitude tracking control method of unmanned helicopter | |
CN102566427A (en) | Aircraft robust control method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20180130 |
|
WD01 | Invention patent application deemed withdrawn after publication |