ekf_localization compute heading from gps motion?
My magnetometer is not working so great here, so I'm thinking about estimating mobile robot heading from changes in GPS location (as I think is used in car satnavs to get the heading). My question is, how to integrate this with the ekf_localization system? Should I write my own node which takes NMEA in and writes out headings, and fuse them into ekf_localization, or is ekf_localization or some other existing library node already set up to do this ?