Fixed problems in encoder_to_odom node