Okay :) I spent way too much time on this...
Here's a code to teleport to flag waypoint (see video) -- not sure it's needed, but I wanted to do it.. and managed to make it work with the existing code type without asm!
I'm still working on the...
hahahaha I'm half way through a bag off my Volcano and my tolerance is way down because I haven't been smoking much lately, so I was a little slow to catch that that was what your angle was