This is what I made for the code. Its really simple and it can't do more than drive and climb but thats something. I took last year's code and removed all the stuff that was not that important and this is whats left with the omnidrive added.