fixed problem with distance calculation erratic behaviour due to interference between successive pings
compass change
some basic plotter test