lego_rip
Differences
This shows you the differences between two versions of the page.
Both sides previous revisionPrevious revisionNext revision | Previous revision | ||
lego_rip [2017/05/19 16:34] – [LEGO Rotary Inverted Pendulum Ver. 2.0] sangsinpark | lego_rip [2017/06/15 10:10] (current) – [NXC code for LEGO NXT Brick] sangsinpark | ||
---|---|---|---|
Line 36: | Line 36: | ||
{{ lego_rip_v2: | {{ lego_rip_v2: | ||
\\ | \\ | ||
- | * HW. Derive the kinetic energy. | + | |
And the potential energy of the system is | And the potential energy of the system is | ||
{{ lego_rip_v2: | {{ lego_rip_v2: | ||
Line 53: | Line 53: | ||
{{ lego_rip_v2: | {{ lego_rip_v2: | ||
\\ | \\ | ||
- | * HW. Linearize the above nonlinear equations by Taylor expansion. | + | |
For state-space representation, | For state-space representation, | ||
{{ lego_rip_v2: | {{ lego_rip_v2: | ||
Line 70: | Line 70: | ||
{{ lego_rip_v2: | {{ lego_rip_v2: | ||
\\ | \\ | ||
+ | * **HW.** Derive a transfer function assuming that an output, y, is a α. | ||
===== Full state feedback control ===== | ===== Full state feedback control ===== | ||
Line 161: | Line 161: | ||
{ | { | ||
float error = refRad - Mrad; | float error = refRad - Mrad; | ||
- | float U = PGain*error + IGain*M_errSum | + | float U = PGain*error + IGain*M_errSum |
if(U > FULL_SPEED) | if(U > FULL_SPEED) |
lego_rip.1495236841.txt.gz · Last modified: by sangsinpark