Add C++ version of the same functionalities

This is a C++ version the same functionalities and there are more like
handling Kinect status problems.