Range sensor now plots distance when scanning, also moved plot legends