corrected joint connection problem
corrected Kinect-Ogre coordinate mapping