Add rot and gps measurement update