Вот проверенный вариант, только ШИМить нужно частотой 200-300Гц
Chip скажи пожалуйста, почему нужна частота 200-300, а не больше или меньше?