Gyro (yee-roh) Designed by Joshua Lewis. Introduction Inverted Pendulum ATMega MicroProcessor ...

10
Gyro (yee-roh) Gyro (yee-roh) Designed by Joshua Lewis Designed by Joshua Lewis

Transcript of Gyro (yee-roh) Designed by Joshua Lewis. Introduction Inverted Pendulum ATMega MicroProcessor ...

Page 1: Gyro (yee-roh) Designed by Joshua Lewis. Introduction  Inverted Pendulum  ATMega MicroProcessor  Inertial Measurement Unit  PID Control Algorithm.

Gyro (yee-roh)Gyro (yee-roh)

Designed by Joshua LewisDesigned by Joshua Lewis

Page 2: Gyro (yee-roh) Designed by Joshua Lewis. Introduction  Inverted Pendulum  ATMega MicroProcessor  Inertial Measurement Unit  PID Control Algorithm.
Page 3: Gyro (yee-roh) Designed by Joshua Lewis. Introduction  Inverted Pendulum  ATMega MicroProcessor  Inertial Measurement Unit  PID Control Algorithm.

IntroductionIntroduction

Inverted PendulumInverted Pendulum

ATMega MicroProcessorATMega MicroProcessor

Inertial Measurement UnitInertial Measurement Unit

PID Control AlgorithmPID Control Algorithm

Page 4: Gyro (yee-roh) Designed by Joshua Lewis. Introduction  Inverted Pendulum  ATMega MicroProcessor  Inertial Measurement Unit  PID Control Algorithm.

The Inverted PendulumThe Inverted Pendulum

Axis of RotationAxis of Rotation

Center of MassCenter of Mass

AttitudeAttitude

Page 5: Gyro (yee-roh) Designed by Joshua Lewis. Introduction  Inverted Pendulum  ATMega MicroProcessor  Inertial Measurement Unit  PID Control Algorithm.

Integrated SystemIntegrated System

Atmel ATMega128Atmel ATMega128 Inertial Measurement UnitInertial Measurement Unit Wheel EncodersWheel Encoders BlueSMiRF (Embedded Bluetooth Serial BlueSMiRF (Embedded Bluetooth Serial

RF Link)RF Link) Texas Instruments Motor DriverTexas Instruments Motor Driver Liquid Crystal DisplayLiquid Crystal Display

Page 6: Gyro (yee-roh) Designed by Joshua Lewis. Introduction  Inverted Pendulum  ATMega MicroProcessor  Inertial Measurement Unit  PID Control Algorithm.

Inertial Measurment UnitInertial Measurment Unit

Analog Devices ADXL330 AccelerometerAnalog Devices ADXL330 Accelerometer InvenSense IDG-300 GyroscopeInvenSense IDG-300 Gyroscope

Page 7: Gyro (yee-roh) Designed by Joshua Lewis. Introduction  Inverted Pendulum  ATMega MicroProcessor  Inertial Measurement Unit  PID Control Algorithm.

Control AlgorithmControl Algorithm

Hand Tuned Feedback LoopHand Tuned Feedback Loop

Page 8: Gyro (yee-roh) Designed by Joshua Lewis. Introduction  Inverted Pendulum  ATMega MicroProcessor  Inertial Measurement Unit  PID Control Algorithm.

Control AlgorithmControl Algorithm

One Dimensional Kalman FilterOne Dimensional Kalman Filter

Input Biased Angular Rate Gyro and Input Biased Angular Rate Gyro and Zeroed AccelerometerZeroed Accelerometer

Two State Output (Angle & Gyro Bias)Two State Output (Angle & Gyro Bias)

Angular Rate Byproduct of ComputationAngular Rate Byproduct of Computation

Page 9: Gyro (yee-roh) Designed by Joshua Lewis. Introduction  Inverted Pendulum  ATMega MicroProcessor  Inertial Measurement Unit  PID Control Algorithm.

PID Control AlgorithmPID Control Algorithm

Torque = Kp*Angle + Kd*AngleRate + Torque = Kp*Angle + Kd*AngleRate + Kv*WheelSpeedKv*WheelSpeed

Gain Coefficients Are Tweaked By User Gain Coefficients Are Tweaked By User During Run-Time Via Bluetooth Serial During Run-Time Via Bluetooth Serial Wireless LinkWireless Link

Page 10: Gyro (yee-roh) Designed by Joshua Lewis. Introduction  Inverted Pendulum  ATMega MicroProcessor  Inertial Measurement Unit  PID Control Algorithm.

THE END!THE END!