Added a PID controller that can be used by the autopilots
Added the Navigator class. This object can be used to calculate the distance and bearing to a point on earth.