h = tf([0 0 K_p],[5 D K_t]);
step(h)