RoboticsToolbookforMatlab9.10,机器人工具箱,设置路径后就可以用,里面有几个例子