Omniwheel Test Code

From the Internet!