quadcopter code for arduimu, needs adjusting