Small tweaking of the PIDs..Added Xtion helmet.