Finished refactoring. Point cloud and Kinect data grabbing are now seperate, cleaner code overall. Yay! Floor plane next.