shuxuett.m

机器人运行轨迹计算

syms nx ny nz ox oy oz ax ay az px py pz
TT=[nx,ox,ax,px;ny,oy,ay,py;nz,oz,az,pz;0,0,0,1];