你用的是动力学方程还是运动学方程？几关节的？还是把机器人作为一个整体在一个大环境做的轨迹跟踪？如果你是以调节关节为对象的话，直接把输入改成正弦就好了。推荐一本书《机器人控制系统》，一本很厚的红色的书，2008年出版的，里面是用simulink仿真的，都是做的正弦曲线
simulink用m作外部调用
