Create getXchZmpHaradaStep.m