Changes to angle detection and math involving angles
reset encoders after reaching heading
Began EasyLCD interface for the DSLCD
Cleaned up position related code
minor changes here and there