Added path tracting to kinect simulator, randomised paths to kinect simulator and velocity tracking. Code needs a clean up but it works.