Team 190 in 2k3 made a functional INS (Inertial Navigation System) system for a crab drive robot. I can't remember all that much about it other than it was a big challenge for the programmers, and we ran into some "drift" issues.
http://www.chiefdelphi.com/media/photos/14923