major modification on gps_service and new test
new test for state estimate