Merge the refactor/sergio+ed branch for tue_robocup