Big changes.  Moving depth camera functions into a class (don't know if it works yet).  Added a manual CoM function for testing without a camera.