Got Josephs stability fix working!!
Allow for the floor height to change (just in the visualizer).