Added localorigin get function sidie state. Got to do the same for hmsl, but haven't done yet.
Added test gps location to sirf.
Renamed state get function for local origin.
Fixed some small bugs.