Added functions to change kp and kd via bus-command