Styrprogram som styr alla sätt roboten kan gå

* Kommentarer i python-programmet kommer senare när det städats upp