restructured code, added PWM sweep for servo, switched to external crystal with PLL