SafetyHeightFilter:
* skip move to safety height if only the height of a position changed
* simplified code

StepWidth:
* just skip small steps; don't change output formatting
* the output conversion will be done later in a more appropriate place