Added initial quadcopter sketch (rate mode only)
Added attitude mode back