Cleaned some MultiWii code and updates to Console