- Added test class
- Suport for adding reference GPS point
- Bugfixes