removed unused global variables
used positioning sensor instead of homemade odometry:

add positioning sensor in the .argos config file
use it to get current position
This sensor is great! odometry data nearly perfect, collisions are taken in account