Fixed two separate bugs that caused points to be more than MAX_STEP_SIZE apart.