Refactored the cpu a bit, basic movable robot implementation