GPS Changes

GPS seems to work better.  For some reason the estimated positions and
desired positions are exactly the same.  Not really sure why.