Added Tyler's navigation and imu code and updated README.md

Followed directions described in spsu-auv-team/Software#6