fixed typo switches and set goal switch to 0.3 distance
Set window to 6 and fixed topic top kinect