Reworked to use the Motor Shield API. Should work. Now we just need the numbers.