二关节机械臂计算力矩跟踪控制,包括阶跃信号和正弦信号,程序能完好运行,并画出跟踪效果