PD controller  with varying kp

تو زمین تست شد
نمودار پله نسبتا خوبی داره