Geotagging Issues APM Plane and Zubax UAVCAN

When flying a survey mission using Zubax GNSS 2 mission planner is always complaining about compass issues. The plane will fly the mission however all the geotags have the exact same location in the log so we are unable to geotag our photos. This looks like a firmware issue using UAVCAN as far as I can tell.