Moving a camera along a path in KML

Question

Hi, I'm trying to generate KML(using JAK) that will contain first person perspective animation from my GPS data.

So I have collection of points (long, lat) sorted by timestamps and I would like to iterate over it and crate series of <gx:FlyTo> nodes.

Unfortunately camera doesn't move as I expected :(. My current algorithm:

1. find bearing between last and current points (good place to make mistakes, but I compared my results with Mathematica results and they ware quite similar)
2. add FlyTo object with Camera at long, lat of last point and with calculated heading
3. add Wait node
4. add FlyTo node with Camera at long, lat of current point and with calculated heading
5. add Wait node
6. repeat 1-5 for all nodes.

(waits are for separating rotation from translation)

Does it look O.K (if Yes I will provide more implementation details later)? Maybe it could be beater way to do that?