Почитал про настройку ПИД. Похоже я ошибся, нужно было увеличивать диф. коэффициент, а не уменьшать пропорциональный.