Added source and header files for Sonar, Kinect, Main