论文部分内容阅读
为了实现机械臂对给定轨迹的高精度实时跟踪,设计了分层循环MPC控制器。建立了6自由度机械臂的动力学模型和状态空间模型。从分钟级控制器和秒级控制器2个层次设计了控制器,分钟级控制器使用MPC控制实现,用于改善对给定轨迹的跟踪精度;秒级控制器使用PID控制实现,用于改善控制的实时性。将秒级控制器的控制结果反馈给分钟级控制器,分钟级控制器对控制律进行实时优化,实现了分层循环控制。经仿真验证,PID控制下机械臂末端轨迹的SSE为1840.9,分层循环MPC控制下机械臂末端轨迹SSE为1221.3,比PID控制结果