Simply renamed kin_model to robot_model for more proper naming convension