just got pwm working

need to refactor, not pushing yet
refactored motor init

still need to add the analog output for the 4 main motors