www.gusucode.com > 机器人工具箱 - robot源码程序 > robot\demos\sljacobnt.m
function x = sljacobn(dh, u) N = numrows(dh); x = jacobn(dh, u(1:N))' * u((N+1):(N+6));