Cleaned up code, switched Drive Jags to PWM

Added a "convenience.h" containing convenient things.