Reverted to working version before I added jiggle detection or motor response timer (b/c robot became very sluggish).