Added roll, pitch, and yaw conversion from quaternion
Added open loop servo gimbal control sketch
Added closed loop (PD) servo gimbal control sketch