Arduino bugfix och speed-tweaks

Tilt är fortfarande usel, men det funkar-ish.