function goStop(H,set)

globalVar;

sendServo(H,GO_STOP,set,0,0,0,0,0);
[command,return1] = readServo(H);

if(~(command == GO_STOP && return1 == 0))
    disp('OPERATION FAILED: Go/Stop');
end