Implement Iterator.
It compiles.
Readying for review.
After eggrobin's review.
Merge pull request #254 from pleroy/Iterator

Reimplement some of the Trajectory methods using an internal Iterator class