Update main.c

PWM polarity and clock selection updated for channel 2.
Added second servo to test that both PWMs are working.
Merge