Använd bool för automode också
Bortkommenterade funktion för nya steg-funktioner
Gå och sväng exakt x grader. Höftad längd/hastiget framåt.

*TODO: 0.6 överallt, kanske sätta det till en global variabel nånstans.
Rätta till en offset. Bör göra vissa saker bättre.