www.gusucode.com > 机器人工具箱 - robot源码程序 > robot\demos\sljacobni.m

    function x = sljacobn(dh, u)
	N = numrows(dh);
	x = inv(jacobn(dh, u(1:N))) * u((N+1):(N+6));