Add goal getter and setter
Sort conf in different functions
Patch shape robot method
Refactor project hierarchy
Create a world renderer class
Add xml parser