Wasn't using center of GPS waypoint for GCP
Changes