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

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

Embed Size (px)

Citation preview

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!