replaced radian calculations with constants. added function head to normalize radian heading greater than 2pi