You might need to adj the servo throw a little - sounds like servo is not quite getting shift lever to fully engaged position. When it does this, try moving the shift lever by hand and see if that completes the shift. If it does, then you need to 'english' the servo horn enough to get it to completely engage.