shuxue3.m

机器人运行轨迹计算

syms c s d
T=[cos(c),-sin(c),0,0;
    sin(c),cos(c),0,0;
    0,0,1,d;
    0,0,0,1];
inv(T)