initial commit

Code taken from https://www.inkling.com/read/making-things-see-borenstein-1e/chapter-3/viewing-the-point-cloud-in-color to figure out how to match color with depth points