Reverted to old GPS implementation. Major optimizations.