Do not use forward kinematics to update the height of feet when contact happens, use reference instead

Reset newPhase_ to false at each call of Gait::update so that it is only true during 1 iteration and not 20 iterations when the gait changes