rename watchdog function
remove prints
add watchdog in commutation
add watchdog & test velocity_ctrl
add watchdog & test position_ctrl
add watchdog and test torque_ctrl