add library for heading calculations
add heading calculation
change simulated gps node name
add goal heading calculation node