rotz.m

有关机器人

function rotz=rotz(sita)
rotz=[cos(sita) -sin(sita) 0 0;
      sin(sita)  cos(sita) 0 0;
      0 0 1 0;
      0 0 0 1]