Add a small omnidrive test program