fixed my math added testing to imu-to-yaw
Merge branch 'master' of github.com:ut-ras/IGVC2014