Added zeroing functionality into homing commands so that the robot state
will be preserved across homing.