Add a small omnidrive test program
Merge pull request #2 from cporter/master

Add a small omnidrive test program