2nd commit

Lat/Long and heading working in basic form