控制器设计,主程序控制算法实现,完成电机的迭代学习控制。PD闭环迭代学习控制,已知被控对象,及期望轨迹