Codesys SCARA机器人控制
1.添加运动学模型
选择Scara2模型(Scara2模型只包含大臂小臂两个关节,Z轴和旋转轴是附加轴)
把机器人关节参数填上
2.方向运动学
选择第一个
3.映射轴到轴组中
4.程序编程
1)轴组使能
调用SMC_GroupPower 和MC_GroupEnable使能SCARA轴组,与单轴使能用法类似。
2)原定设定
轴组使能后直接调用MC_Home分别对每个轴回零即可。
3)关节点动
轴组使能后分别调用单轴MC_Jog指令即可做机器人的关节点动操作。
4)SCARA手系
上使能后默认为左手系,如果只做关节点动不用考虑手系变换,如果要做笛卡尔空间点动操作,必须提前更换手系,否则可能会报错。
换手如下图所示功能块