Adding test pictures
Adding output files from scan
Working version with real-time 2D mapping that respects change of origin