Do you have this coded for 3d movement (translation + rotation)? It looks like you are just playing around with each motor to make it move back and forth.
If you want, I can send you the drive code for my kiwi bot:
http://www.team195.com/files/kiwi.wmv