Fix a bug in the FixedFooYawCoMPlanning visualizer