working catkin pkg encoder