added ConvertCameraXYZ2RobotXYZ