Refactor & debloat robot.py

[IngmarNT]

Robot.py is getting very large and hard to read, it would be nice if we could clean it up and move functionality that doesn't need to be in robot.py into other files.