First test of new node robot state.
Ground truth is working.
Dead reckoning is not working.