fix bug in heading
add hil gps
Merge branch 'hil' of local repository into hil_plane

Conflicts:
	src/imu.c