Move matrix conversion code from SkeletonFitting to MiscUtils
RGBDCamera now returns its matrices as references and not copies.
SkeletonFitting divided refine_four_sections code into 3 methods