Checked in fix to check that the header of the incoming gps message matches the desired header.

Still junk code before cleanup.