Но хочется помучаться.
Чтож, попробуйте. Кстати, это довольно интересно.
Осциллограф есть? Без него нормально отладить практически нереально.
Далее — схемы советую брать типовые из даташитов на ШИМ-контроллеры. Для начала определитесь с последним, параметрический поиск есть, например, на
терре.