Added all motor code, tested on robot base.  Speed values need fine-tuning.