Update Competition Robot

Added the code for the Omni-Drive.