Made it up to the first cave entrance.

Also removed a warning when setting a destination equal to the source
position as it can happen here.