Change move_base parameters, add better odometry and reading function. Not fast enough to provide the odometry though