Added PLL module for motor control and PWM logic clock. Changes to current control algorithm.