Added colour map to module, need to fix the range of values produced
by the depth map (currently they are at a higher res then simplecv can
handle, causes alot of (far away) data points to be pruned