function [ CtrlEffort ] = CalcPID( errorV, kp, ki,kd )
%UNTITLED2 Summary of this function goes here
%   Detailed explanation goes here

 CtrlEffort = errorV(1)*kp+errorV(2)*ki+errorV(3)*kd;

end

