Move stats output
Visualization problems with 'publish_freq' smaller than 100
Split between fixed and moving joints
Delay for fixed joints