Currently working, but need to address some issues.

Numerical failures occurring in gps/ att.
Position prediction not accurate.