float64 xg
float64 yg
float64 heading