Testing of the PID algos

Signed-off-by: Maslov Nikita <wkernelteam@gmail.com>