User Tools

Site Tools


lego_rip

Differences

This shows you the differences between two versions of the page.

Link to this comparison view

Both sides previous revisionPrevious revision
Next revision
Previous revision
lego_rip [2017/05/19 16:34] – [LEGO Rotary Inverted Pendulum Ver. 2.0] sangsinparklego_rip [2017/06/15 10:10] (current) – [NXC code for LEGO NXT Brick] sangsinpark
Line 36: Line 36:
 {{ lego_rip_v2:rip_equ2.jpg }} {{ lego_rip_v2:rip_equ2.jpg }}
 \\ \\
-  * HW. Derive the kinetic energy.+  * **HW.** Derive the kinetic energy.
 And the potential energy of the system is And the potential energy of the system is
 {{ lego_rip_v2:rip_equ3.jpg }} {{ lego_rip_v2:rip_equ3.jpg }}
Line 53: Line 53:
 {{ lego_rip_v2:rip_equ7.jpg }} {{ lego_rip_v2:rip_equ7.jpg }}
 \\ \\
-  * HW. Linearize the above nonlinear equations by Taylor expansion.+  * **HW.** Linearize the above nonlinear equations by Taylor expansion.
 For state-space representation, the equations are reconstructed. For state-space representation, the equations are reconstructed.
 {{ lego_rip_v2:rip_equ8.jpg }} {{ lego_rip_v2:rip_equ8.jpg }}
Line 70: Line 70:
 {{ lego_rip_v2:rip_equ11.jpg }} {{ lego_rip_v2:rip_equ11.jpg }}
 \\ \\
 +  * **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 DGain*d_Mrad;+   float U = PGain*error + IGain*M_errSum DGain*d_Mrad;
  
    if(U > FULL_SPEED)    if(U > FULL_SPEED)
lego_rip.1495236841.txt.gz · Last modified: by sangsinpark