draw path under robot.
Added obstacle drawing to mapper
Now we can see the sonars work.
Fix math bug in AutoJockey