Main working with ping, servo and stepper commands