updating cenv to robotPose class
added robotPose to cenv