基于PLCopen的六轴工业机器人运动控制功能块设计

针对工业机器人控制系统的开放性要求,设计符合PLCopen规范的六轴工业机器人运动控制功能块。基于CodeSys软件开发环境,结合SMC_CNC库中数组、结构体和功能块,采用IEC61131-3编程语言开发了六轴工业机器人运动控制功能块,包含：坐标变换、正逆运动变换、直线与圆弧插补运动等;在此基础上,开发了一系列机器人运动控制指令和可视化编程界面。最后,以埃夫特ER50六轴工业机器人为实验对象,采用研制的机器人运动控制器,实施机器人编程控制实验,结果表明所开发的机器人运动控制功能块及其指令达到了设计要求。