刘金琨的《机器人控制系统的设计与MATLAB仿真》一书的PDF。相应代码已有多人上传过,自行搜索即可。