《PLC程序说明 (吴俊灏)》由会员分享，可在线阅读，更多相关《PLC程序说明 (吴俊灏)（8页珍藏版）》请在金锄头文库上搜索。
1、程序功能及说明PLC 1：完成整个系统变量的初始化，这里包括 io 设定，机器人参数常量设定及p变量和m变量的初始设置，以及对其他 plc 程序的调用。其中，plc11（卡使能检测进程），plc15 程序（限位状态检测进程） ，然后退出自身的运行。PLC 2：完成四个功能。功能1，实时采集电机的脉冲，计算机器人末端的位置。功能2，当机器人在工具坐标系下运动时，计算所需的余弦矩阵的值。功能3，上位机在主界面且自动模式下可以上主电。功能4，世界坐标系或工具坐标系运动实时采集速度，并取最大速度。PLC 3：示教，再现检测功能。由plc11启动以后，启动该进程监测系统当前的示教再现状态。当系统为示教状
2、态时，启动plc3（再现状态监测进程）和plc5（手压开关开检测进程） ，然后退出自身的运行。当系统为再现状态时，则一直运行该进程。PLC 4：伺服检测和控制功能。由plc11启动以后，启动该进程监测系统当前的主电源状态。当检测到主电源上电以后，延时上伺服，并将当前位置赋给指令位置，然后将电机闭环。PLC 5：当系统为示教状态时，由 plc3 启动该进程。监视系统的手压开关开状态。当手压开关打开时，则停止所有的坐标系运动及设置运动完成标志为1。且一直运行该操作，使系统一直处于停止状态。PLC 6：伺服检测和控制功能。由plc4启动以后，启动该进程监测系统当前的手压信号和手动模式或者自动模式下的
3、主电源信号。当检测到条件符合，断开伺服，并延时将将电机开环。PLC 7：当系统上电后，由 plc1 起动该进程。一旦运行后，该进程则不再退出，直到系统掉电。该进程用于判断运动程序的完成，除速度方式下的运动程序外，所有其他的运动程序都通过 m 变量来指示其程序的结束，当一个运动程序结束后，该程序通过判断相应的 m 变量来设置其标志变量为 0，表示程序完成。同时，当所有运动程序都完成时，置运动完成标志P3300=0。PLC 8：当系统上电后，由 plc11 起动该进程。当系统处于运行状态时，则该进程一直处于运行状态。该进程用于接收上位机发来的各种运动指令及相应的参数，并设置相应的参数到系统变量，然
4、后根据运动指令设置相应的轴到固定的坐标系，最后通过调用运动程序完成对各轴的运动控制。PLC 9：浇铸运动检测功能。检测浇铸运动是否到位，对应的M变量。如果得到外部的正确的信号后，停止浇铸运动并将运动标志位置位，反馈给上位机正确的信号，并退出其自身的运行。当检测不到外部正确的信号（到示教的最底点仍然得不到外部的检测信号），反馈给上位机错误的信号，并退出其自身的运行。PLC 10：运动学逆解解算监视功能。当系统上电后，由 plc1 起动该进程。并且一直处于运行状态直到系统掉电。该进程专门用于对运动学逆解解算状态的监视，当运动学逆解出现 “无解”或“奇异位形”时，该进程则停止一切运动程序。PLC 1
5、1：当系统上电后，由 plc1 起动该进程。当上位机发出使能标志（p3001=1）后，从上位机读取电机当前的位置，并赋予下位机寄存器。然后在判断驱动器是否有警告后对电机的闭环及 serv_on 信号的输出，启动 plc3（示教状态检测进程） ，plc4（伺服检测和控制功能进程），plc8（运动程序调度进程）和plc2。同时发伺服使能标志（p3005=1）给上位机，并退出其自身的运行。PLC 14：用于检测上位机对下位机的控制指令状态，当上位机发出关下位机指令时，停止所有的运动程序及 plc 程序，并关闭对驱动器的伺服使能信号。结束下位机的运动，等待关机。PLC 15：该进程用于判断各个电机轴是
6、否到限位状态，如果到限位状态则置限位标志 p3006 为 1，并置运动完成标志为 1。使能 plc16（出限位检测进程） ，检测电机轴的限位状态。最后退出其自身的运行。否则一直运行。PLC 16：当有电机轴进入限位状态后，由该进程监测电机周是否出限位，如果出限位状态则置限位标志 p3006 为 0，并启动 plc15（到限位检测进程）并退出其自身的运行。否则一直运行。PLC 17：该进程用于检测电机轴的开环状态，当电机出现开环时，则关闭对驱动器的伺服使能信号。用于电机轴出现意外时的保护。否则一直运行。PLC 28：由plc8调用，示教状态下完成工具坐标系和直角坐标系下的直线运动。程序变量及说明
7、P 变量的定义P2900 奇异点标志，在运动到奇异点时设置该标志，作为内部标志对程序作相应的处理。=0 (默认) 未到奇异位置=1 奇异位置P3001 pmac 使能信号， 在上位机初始化结束后由上位机给 pmac 发的使能信号，用于启动 pmac 卡，等于 0 时不使能 pmac 卡。=0 (默认) pmac 卡不使能 =1 pmac 卡使能P3005 servo on 信号pmac 发的指示外部伺服开或者关状态的信号。用于内部状态标识和上位机显示。=0 servo off =1 servo onP3006 限位标志当机器人各个关节轴中有一个关节或更多关节到限位时的状态指示 =0 未到限位（
8、默认） =1 到限位P3007 运行状态，是手动（示教）还是自动（再现）=0 手动（示教） =1 自动（再现）P3050 坐标系标志位 ,指示坐标系的变量 =0；世界坐标系（默认） =1；工具坐标系 =2；关节坐标系 P3100 运动模式标志, 由上位机指示当前运动指令的运动模式。=0，无运动模式， （默认） =1，单关节角度运动模式（给定单个关节角度值进行运动） =2，多关节直线运动模式一 （给定多个关节角度值进行点到点运动） =3，多关节直线运动模式二（给定机器人末端点位置和姿态进行直线插补运动） =4，多关节圆弧运动模式一（顺时针圆弧运动） =5，浇铸运动模式 =6，单关节停止运动模式
9、（单轴停止运动） =7，多关节同时停止运动模式=8，单关节速度方式运动模式（各个关节以速度方式运动） =9，多关节直线速度方式运动（沿坐标系各轴以速度方式运动） =14，完整圆运动模式=16，多关节连续运动模式P3200 运动任务指示 表示当前是否有未完成的任务。=0， （默认） ，无运动任务 =1，运动任务P3202 运动报警标志 ，指示下位机运行程序出错的标志 =0，无报警（默认值） =1，参数错误 =2，给定位置错误，无解（逆解解算错误） =3，奇异点，运动不可实现P3300 运动到位标志 ，指示程序运行状态 =0 ；运动到位 =1 ；运动没有到位参数变量零点位置参数P3501；1轴 绝
10、对位置零点（用于初始化时上位机给下位机传递绝对位置）(单位：度) P3502；2轴绝对位置零点 P3503；3轴绝对位置零点 P3504；4轴绝对位置零点 P3505；5轴绝对位置零点 P3506；6轴绝对位置零点工具坐标系定义参数 工具坐标系用一个位置及角度矩阵来定义，具体为：其逆矩阵定义为：单关节角度运动模式下参数 P4011；运动轴号 P4012；运动速度 (单位：脉冲/秒) P4013；运动角度 (单位：度)多关节角度运动模式一参数 P4016；thita1 末端点位置 （单位：度） P4017；thita2 末端点位置 P4018；thita3 末端点位置 P4019；thita4
11、末端点位置 P4020；thita5 末端点位置 P4021；thita6 末端点位置 P4022；运动速度 （单位：脉冲/秒） P4023；运动加速时间 （单位：毫秒） 多关节直线运动模式二参数 P4041；末端点 x 位置 （单位：毫米） P4042；末端点 y 位置 P4043；末端点 z 位置 P4044；末端点 alpha 位置 （单位：角度） P4045；末端点 beita 位置 P4046；末端点 gama 位置 P4050；运动速度 （单位：脉冲/秒 ）P4051；运动加速时间 （单位：毫秒 ）多关节圆弧顺时针运动模式 P4061；末端点 x 位置 （单位：毫米 ） P4062
12、；末端点 y 位置 P4063；末端点 z 位置 P4064；末端点 alpha 位置 （单位：角度 ） P4065；末端点 beita 位置 P4066；末端点 gama 位置 P4075；向量 I 值（对应 X 轴） P4076；向量 J 值（对应 Y 轴） P4077；向量 K 值（对应 Z 轴） P4091；运动速度 （单位：脉冲/秒 ） P4092；运动加速时间 （单位：毫秒 ）单关节停止运动模式 P4011；关节号(16) P4122；停止方式 P4123；停止加速度 （单位：脉冲/平方毫秒） 多关节同时停止运动模式 P4126；停止加速度 （单位：脉冲/平方毫秒） 单关节速度方式
13、运动模式 P4011；关节号 P4131；运行方向 =0 ；顺时针 =1；逆时针 P4132；关节速度 （单位：脉冲/秒）P4133；加速时间 （单位：毫秒）多关节直线速度方式运动 P3841；X 轴指令值 P3842；Y 轴指令值 P3843；Z 轴指令值 P3844；A 轴指令值 P3845；B 轴指令值 P3846；C 轴指令值 P4001；A 轴当前值 P4002；B 轴当前值 P4003；C 轴当前值 P4004；X 轴当前值 P4005；Y 轴当前值 P4006；Z 轴当前值 当前位置姿态矩阵P4101；绕 x 轴角度翻转标志 P4102；绕 y 轴角度翻转标志 P4103；绕 z
14、 轴角度翻转标志 P4135；运动轴号 =1；X 轴 =2；Y 轴 =3；Z 轴 =4；A 轴 =5；B 轴=6；C 轴 P4136；运动速度(有符号数) （单位：脉冲/秒） P4137；运动最大速度 （单位：脉冲/秒） P4138；加速时间 （单位：毫秒 ） P4139；单位时间内位置增量 P4140；单位时间内角度增量多关节连续运动模式P8005；连续运动的点数P4096；默认的运动速度P4097；默认的加速时间 （单位：毫秒 ）M854；运动速度模式选择（运动时间或运动速度）M858；运动时间或运动速度M860；thita1 末端点位置 （单位：度）M862；thita2M864；thita3M866；thita4M868；thita5M870；thita6浇铸运动模式P4716;浇铸完成方式标志，与上位机通讯P4718;浇铸正常完成方式标志位P4715；Z方向上的增量P4712；运动速度P4713；加速度时间M变量的定义通用输入 序号信号名称端子定义对应地址1HOME5 通用输入IN1M5202LEFT5通用输入 IN2M5213RIGHT5 通用输入 IN3M5224USER5 通用输入 IN4M5155HOME6 通用输入 I
