Good to know and glad you've managed to get a result.
Yes, Alexandru and I were chatting offline about it and the initial code is 'way OTT' for a fixed position application.
This is why I think you have some 'misleading complication' in the calculation routines which for a fixed position application, shouldn't be in there.......and when it comes to a simple modification like yours, it overcomplicates it further.
If you get chance, have a look in the AS Manual in the Sample Programs section.
You will see a very 'basic example' which pretty much reflects your application (IMHO) and you'll see the comparable difference between that and yours.
I actually seen that the other day when I was thumbing through the AS manual. I plan to make this much more clean and user friendly soon. I've given myself a crash coarse in AS and Kawasaki this weekend. It's becoming mush more clear what I need to do. Thank You for all your help.