Navigation library added. Encoder and COMPAS updated with GPS.