Milestone 3

This code will fly for Milestone 3. Stood up Navigation Task and it can
do basic decision making based on incoming sensor data. Data needs to be
ideal, it can't handle noise right now.