Added the odometry publishing thread. Phew. Glad that's over...