Current Robot Working Code

Latest version testing robot movement. Note: turning is disabled because
I was testing if the spin out problem was the caster wheel.