400 hz quadcopter code