Flash with GPS project, tests in progress

Added functions in arith, bilineal derivative (not in use right now),
and ESC init.