Improved version of anti-gravity drive

Added repulsion against wall and against last position where robot
stopped.
Merge branch 'master' of https://github.com/eddy-geek/roboteamlg