Update to source

Added simple flight plan coordination algorithm.
Modularized the normalization function into Norm class.

Cleaned up code.