test pid calculate way
change pid calculate way
merge
Software timer sample and PID