270 likes | 388 Views
Jose Morales. IMDL: Quad Rotor. Introduction. Four Propeller Flying Platform Goal: Stable Hover. Theory of Operation. Upward Motion Front Tilt and Forward Motion Right Tilt and Rightward Motion Counter-Clockwise Yaw. Hardware – Software Interaction. Mechanical Design.
E N D
Jose Morales IMDL: Quad Rotor
Introduction • Four Propeller Flying Platform • Goal: Stable Hover
Theory of Operation • Upward Motion • Front Tilt and Forward Motion • Right Tilt and Rightward Motion • Counter-Clockwise Yaw
Sonar • Determines Distances • Used to Determine Distance from Floor.
Accelerometer & Gyro • Inertial Measurement Unit (top) • 3 Axes Accelerometer • 2 Axes Gyroscope • Gyroscope (bottom) • 1 Axis Gyroscope • Missing Axis from IMU
Current Sensors • Hall Effect • Strength of Magnetic Field from Current • Measure current from each motor • Current to Thrust Mapping
Microprocessor • System Controller • PID calculation • Communication to FPGA
FPGA • Sensor Data Acquisition • Digital Filtering • Communication to uP
Analog Filters Filters the Analog Accelerometer And Gyroscope data.
PID Control UpdatePID(SPid * pid, double error, double position) { double pTerm, dTerm, iTerm; pTerm = pid->pGain * error; pid->iState += error; if (pid->iState > pid->iMax) pid->iState = pid->iMax; else if (pid->iState< pid->iMin) pid->iState = pid->iMin; iTerm= pid->iGain * iState; dTerm= pid->dGain * (position - pid->dState); pid->dState = position; return pTerm + iTerm - dTerm; }
Control • Accelerometer data used for Hover • Gyro Data used for movement • Integrating Gyro Data • Accelerometer Corrected Gyro • PID maintains height