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));