Changes in interface in RobotState:
   getRoot -> getLinkRoot
   getPose -> getRelativePose
   added getPose (urdf version)
Don't use the distortion coefficients if the camera is rectified