Initial commit. Scanning is still a little unstable, but at least we get results for the distance calculation now