GPS Update
- Added many stability improvements
- Added GPS
- Organized some architecture