Drive around obstacle

Signed-off-by: Sædvanlige ændringer :D <Emil@10.16.106.85>
Merge branch 'master' of https://github.com/emilhein/CDIOROBOT.git