function ContMov(H)

globalVar;

XYZ = zeros(3);
disp(' ');
disp(' ** Leg - XYZ **');
XYZ(1,1) = input('Pos Xf [ ](mm): ');
% while (XYZ(1,1) ~= [-234:234])
%     XYZ(1,1) = input('Pos Xf [-234 234](mm): ');
% end
XYZ(1,2) = input('Pos Yf [ ](mm): ');
% while (XYZ(1,2) ~= [140:374])
%     XYZ(1,2) = input('Pos Yf [140 374](mm): ');
% end
XYZ(1,3) = input('Pos Zf [ ] (mm): ');
% while (XYZ(1,3) ~= [-84:384])
%     XYZ(1,3) = input('Pos Zf [-84 384](mm): ');
% end

XYZ(1,:) = (XYZ(1,:)+200)*10;

XYZ(2,1) = input('Time [0 5](s): ');
while (XYZ(2,1) ~= [0:0.01:5])
    XYZ(2,1) = input('Time [0 5](s): ');
end
XYZ(2,1) = XYZ(2,1)*100;

ord = input('Tipe of Order (3 or 5): ');
if isempty(ord)
    ord = 3;
end
XYZ(2,2) = ord;

Tramas = 2;
for i = 1:Tramas
    param1 = bitand(XYZ(i,1),MASK_HIGH) / 256;
    param2 = bitand(XYZ(i,1),MASK_LOW);
    param3 = bitand(XYZ(i,2),MASK_HIGH) / 256;
    param4 = bitand(XYZ(i,2),MASK_LOW);
    param5 = bitand(XYZ(i,3),MASK_HIGH) / 256;
    param6 = bitand(XYZ(i,3),MASK_LOW);
    sendServo(H,Tramas,15,param1,param2,param3,param4,param5,param6);
end

disp(' ');
disp(' ** RESULTS **');
[command,return1,return2,return3] = readServo(H);
if(command ~= 15)
    disp('OPERATION FAILED: Testing Inverse Kinetic');
end
switch (return1)
    case 0
        disp('OUT of Limits');
    case 1
        disp('Inverse Kinetic is Working');
    case 2
        disp('ERRO: OUT1 of WorkVolume');
    case 3
        disp('ERRO: OUT2 of WorkVolume');
    case 4
        disp('ERRO: OUT3 of WorkVolume');
    case 5
        disp('ERRO: OUT4 of WorkVolume');
    case 6
        disp('Not Used');
end

if (return1 == 1)
    pause(XYZ(2,1)/100);
    [command,return1,return2,return3] = readServo(H);
    time = return1*256+return2;;
    j = return3;
    %N = return3;
    %disp(['Movement with ', num2str(N), ' values.']);
    disp(['Movement with ', num2str(j), ' invalid InvKin.']);
    disp(['Time from PIC: ', num2str(time), ' ms']);
end
    
end