Added taget waypoint for GO_HOME/ GO_SPECIFIED_POS
Added function to calculate distance between two coordinates
Finished navigation rule for WAYPOINT mode, not yet tested
Merge branch 'add_OS_for_test' of https://github.com/ming6842/firmware into os_dev

Conflicts:
	program/controller/navigation.h
slower down gps info, also increase the rate fo heartbeat
Merge branch 'mavlink' of https://github.com/moon-bear/firmware into merge_new_mavlink

Conflicts:
	program/controller/navigation.c
Add a gdb command to check navigation wp list
Merge branch 'os_dev' of https://github.com/moon-bear/firmware into mavlink

Conflicts:
	program/bmp_gdbinit.gdb