Got waypointFollow.cpp to compile
Next step: Integrate waypointFollow and pathFollow into fw_pos_ctrl_main
Merge branch 'master' of https://github.com/PixHawk674/Firmware