PID basing output was modified
Fixed PID default parameters
Fixed PID default parameters
some documentation in comments are added
Merge branch 'pid_biasing'

The branche of biasing is finished, the output of PID in the D term it's used directly of the output of the system.