FormationControlSimulation/SOURCE/calcErrVec.m

8 lines
163 B
Matlab

function err = calcErrVec(edgeL,x)
pkg load symbolic
tmp = edgeL2adj(edgeL);
M = adj2inc(tmp) ;
%% 2 degree coordinate
err = kron(M,eye(2));
endfunction