I posted the code on Basilisk's page so if you want to take a look you don't have to download and extract my robot. Thanks again!
