Store heading in radians, thanks @fredj