oop is my girlfriend

add new class smoothing
add new class pid (support mode swithcing)

code less, do more