function dirKin(H,q1,q2,q3)

globalVar;

q1 = round((((q1+ANGLE_MAX)*VAL_ANGLE_RANGE)/ANGLE_RANGE)+VAL_ANGLE_MIN);
param1 = bitand(q1,MASK_HIGH) / 256;
param2 = bitand(q1,MASK_LOW);
q2 = round((((q2+ANGLE_MAX)*VAL_ANGLE_RANGE)/ANGLE_RANGE)+VAL_ANGLE_MIN);
param3 = bitand(q2,MASK_HIGH) / 256;
param4 = bitand(q2,MASK_LOW);
q3 = round((((q3+ANGLE_MAX)*VAL_ANGLE_RANGE)/ANGLE_RANGE)+VAL_ANGLE_MIN);
param5 = bitand(q3,MASK_HIGH) / 256;
param6 = bitand(q3,MASK_LOW);

sendServo(H,DIR_KIN,param1,param2,param3,param4,param5,param6);
% [command,return1,return2,return3] = readServo(H);
% 
% if(~(command == DIR_KIN && ~return1 && ~return2 && ~return3))
%     disp('OPERATION FAILED: Testing Direct Kinetic');
% end

end


