270 likes | 395 Vues
This document provides an in-depth introduction to quad rotor technology, focusing on the mechanics of stable hover and motion control. It discusses the key components such as motors, propellers, sensors, and their integration through software and hardware. The theory of operation covers essential maneuvers including upward motion, front and rightward tilting, and counter-clockwise yaw. Additionally, it examines the role of sonar and inertial measurement units (IMUs) in distance measurement and control, as well as the PID control system for maintaining stability during flight.
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