Arduino code for direct thruster control