Modify the K_P (P), K_I (I) and K_D (D) gain to adapt to your application
Specify the sampling interval time TIME_INTERVAL