а вы ШИМ-то свой настроили? я привел код, который по идее ПОСЛЕ запуска ШИМ-а работать будет.
битва с дураками проиграна, победители торжествуют. слава победителям!
А то толком не понятно что вам надо