Good progress, almost finished implementation of odomentry publisher. Unfinished, untested