步进电机,伺服电机可编程控制器KH-01使用说明
一、 系统特点
● 控制轴数:单轴;
● 指令特点:任意可编程(可实现各种复杂运行:定位控制和非定位控制);
● 最高输出频率:40KHz(特别适合控制细分驱动器);
● 输出频率分辨率:1Hz;
● 编程条数:99条;
● 输入点:6个(光电隔离);
● 输出点:3个(光电隔离);
● 一次连续位移范围:—7999999~7999999;
● 工作状态:自动运行状态,手动运行状态,程序编辑状态,参数设定状态;
● 升降速曲线:2条(最优化);
● 显示功能位数:8位数码管显示、手动/自动状态显示、运行/停止状态显示、步数/计数值/程序显示、编辑程序,参数显示、输入/输出状态显示、CP脉冲和方向显示;
● 自动运行功能:可编辑,通过面板按键和加在端子的电平可控制自动运行的启动和停止;
● 手动运行功能:可调整位置(手动的点动速度和点动步数可设定);
● 参数设定功能:可设定起跳频率、 升降速曲线、 反向间隙、手动长度、 手动速度、中断跳转行号和回零速度;
● 程序编辑功能:可任意插入、删除可修改程序。具有跳转行号、数据判零、语句条数超长和超短的判断功能;
● 回零点功能:可双向自动回到零点;
● 编程指令:共14条指令;
● 外操作功能:通过参数设定和编程,在(限位A)A操作和(限位B)B操作端子上加开关可执行外部中断操作;
● 电源:AC220V(电源误差不大于±15%)。
1、 八位数码管显示
2、 六路输入状态指示灯
3、 三路输出状态指示灯
4、 CP脉冲信号指示灯
5、 CW方向电平指示灯
6、 按键:共10个按键,且大部分按键为复合按键,他们在不同状态表示的功能不同,下面的说明中,我们只去取功能之一表示按键
后面板图为接线端子,包括:
1、 方向、脉冲、+5V为步进电机驱动器控制线,此三端分别连至驱动器的相应端,其中:
脉冲————步进脉冲信号
方向————电机转向电平信号
+5V————前两路信号的公共阳端
CP、CW的状态分别对应面板上的指示灯
2、 启动:启动程序自动运行,相当于面板上的启动键。
3、 停止:暂停正在运行的程序,相当于面板上的停止键,再次启动后,程序继续运行。
4、 (限位A)A操作和(限位B)B操作是本控制器的一大特点:对于步进电机,我们一般进行定量定位控制,如控制电机以一定的速度运行一定的位移这种方式很容易解决,只需把速度量和位移量编程即可。但还有相当多的控制是不能事先定位的,例如控制步进电机从起始点开始朝一方向运行,直到碰到一行程开关后停止,当然再反向运行回到起始点。再例如要求步进电机在两个行程开关之间往复运行n次,等等。在这些操作中,我们事先并不知道步进电机的位移量的具体值,又应当如何编程呢?本控制器利用:“中断操作”,我们称之为“(限位A)A操作”和“(限位B)B操作”。以“(限位A)A操作”为例,工作流程为:当程序在运行时,如果“(限位A)A操作”又信号输入,电机作降速停止,程序在此中断,程序记住了中断处的座标,程序跳转到“(限位A)A操作”入口地址所指定的程序处运行程序。
5、 输入1和输入2通过开关量输入端。
6、 输出1、输出2和输出3通过开关量输出端。
7、 +24V、地—输入输出开关量外部电源,本电源为DC24V/0.2A,此电源由控制器内部隔离提供。
8、 ~220V控制器电源输入端。
输入信号和输出信号接口电路:
本控制器的“启动”、“停止”、“(限位A)A操作”、“(限位B)B操作”、“输入1”、“输入2”为输入信号,他们具有相同的输入接口电路。“输出1”、“输出2”、“输出3”称为输出信号。他们具有相同的输出接口电路。输入和输出电路都有光电隔离,以保证控制器的内部没有相互干扰,控制器内部工作电源(+5V)和外部工作电源(+24V)相互独立,并没有联系,这两组电源由控制器内部变压器的两个独立绕组提供。
开关量输入信号输出信号的状态,分别对应面板上的指示灯。对于输入量,输入低电平(开关闭合时)灯亮,反之灯灭;对于输出量,输出0时为低电平,指示灯灭,反之灯亮。
开关量输入电路:
操作流程图:控制器总是工作在四种状态之一:自动状态、手动状态、程序编辑状态、参数设定状态。上电或按<复位>后,控制器处于自动待运行状态且使坐标于零点,这时可以启动程序自动运行或切换到手动状态,程序编辑状态和参数设定状态只能在手动状态下切换。程序编辑完成或参数设定完成后,按<退出>键退回到手动状态(程序将自动被保护)。在手动状态下,如要切换到程序编辑状态,只需按<编辑>键,如要切换到参数设定状态,需按<编参>键2秒以上。
(注:上述所说的按键<编辑>、<编参>、<退出>其实是同一个按键,由三个功能复合,我们介绍某一功能时,按键的名字只取其一,下同)
参数设定:参数设定状态的进出方式为:在手动状态下,按住<编参>键2秒以上,直到进入参数设定状态后才能松开。参数设定完成后按<退出>键返回到手动状态(参数将被自动保护)。
参数分两行显示,第一行显示参数的名称,第二行显示参数数据。
参数修改方式:进入参数设定状态后,首先显示第一行<JF------->。且前2位的参数名称闪动显示:如按<∧>、<∨>,将会显示下一个或上一个参数名称。如按<回车>键,将进入(下一行)参数数据的编辑修改状态,这时数据的第一位闪动显示,如按<∧>、<∨>,数据将被改变。如按<<>、<>>键,将移至下一位进行修改,如此类推。数据修改后,按<回车>确认,按<取消>放弃修改。
总之,参数的设定通过<∧>、<∨>、 <<>、<>>、<回车>、<取消>六个按键完成的:通过移动左右键使光标移至相应位上,这时数码将跳动显示,再通过上下键改变数值;用回车键进入数据修改状态,数据修改完成后,再用回车键确认退出或用取消键放弃修改。请参考《操作流程速查表》。
程序编辑及指令详解:程序编辑状态的进出方式为:在手动状态下,按<编辑>键。即可进入到程序编辑状态。程序编辑完成后,按<退出>键返回到手动状态(参数将自动保存)。
本控制器的程序区最多可以编辑99条指令,程序中每一条指令有一个行号。行号为自动编号,从00开始按顺序排列,您可以在程序中插入或删除某行,但行号会重新分配。
程序格式是:每一条程序分两行显示(无参数程序除外),第一行显示行号和指令名称,第二行显示指令数据。程序的最后一条指令固定为“END”。
总之,程序的修改通过<∧>、<∨>、 <<>、<>>、<插入>、<删除>、<回车>、<取消>八个键来完成;通过移动左右键使光标移至相应位上,这时数码将跳动显示,再通过上下键改变数值:用回车键进入数据修改状态,数据修改完成后,再用回车键确认退出或用取消键放弃修改。请参与《操作流程速度表》。
手动运行方式:在自动状态下按<自动/手动>将进入手动状态,前二位数码管将显示为 ┥┝ ,以表示为手动状态。按
<>>或<<>,电机将按不同的方向手动运行,手动运行的位移量和速度由参数庙宇状态下的HL和HF值决定,请参考“控制器操作流程图”。
三、 自动运行方式:
控制器上电或按复位键后,自动使坐标值清零,并以此作为坐标零点,在把上一次的手动存盘的计数器的值调入计数器单元,然后处于自动待运行状态,按<启动>键或从端子上输入启动信号后,控制器将从第00行程序开始运行,直至运行到最后一条程序END,这时自动运行结束,控制器返回自动待运行状态。请参考“控制器操作流程图”
在自动状态下,又有3种不同的子状态:
1、 自动待运行状态,表示控制器准备运行程序,只需按<启动>键或端子上输入启动信号即可,程序完成运行后也将处于此状态;
2、 自动运行状态,表示控制器正在运行程序;
3、 自动运行停止状态,表示控制器正在运行程序时被<停止>键或端子上输入的停止信号中断运行程序将在断点处等待再次被启动。
在自动状态下,又有三种不同的显示方式:(通过按同一个键<步数>、<计数>、<∧>进行切换)
1、 步数显示方式:控制器显示当前的坐标值,单位:脉冲数;
2、 计数显示方式:控制器显示当前计数器单元的计数值,单位:个数;
3、 程序显示方式:控制器显示当前所处的程序行及程序名。
为了能在显示上很好的区分自动状态的三个子状态以及三种显示方式,我们用显示器前两位的不同显示方式来区别:(见下表)
外形尺寸及安装尺寸:本控制器采用嵌入仪表外壳,体积小重量轻(500G),前面板为71MM*71MM的方形,长度为120MM,具体尺寸见下图:
编辑及应用举例:例一:
参数要求:起跳频率2.5KHZ,升降速较快,间隙补偿为0;
运行要求:以2.9KHZ的速度运行98765步,再以15KHZ的速度反向运行8765步,停止。
参数清单:(进入参设定状态修改)JF=02500,rS=H,CC=0000。
清序清单:(进入程序编辑状态)
00 SPEED 02900 ;给下面的运行赋值速度2.9KHZ
01 G-LEN 00098765 ;电机正向运行98765步
02 SPEED 15000 ;给下面的运行赋值速度15KHZ
03 G-LEN -0008765;电机反向运行8765步
04 END ;程序结束
例二:
参数要求:起跳频率2.5KHZ,升降速较慢。间隙补偿为12;
运行要求:启动时要求蜂鸣器响一短声后以39KHZ的速度运行1234567步,使3个输出量为101状态,延时55.9秒后使后二位输出状态为11,程序在此处暂停,直到再次启动后使用电机以同样的速度返回起始点的另一侧第888步的位置,到位后发出一长声通知,结束。
参数清单:(进入参数设定状态修改)JF=02500,rS=L,CC=0012。
程序清单:(进入程序编辑状态)
00 OUT nnno ;使蜂鸣器响一短声
01 SPEED 39000 ;给下面的运行赋值速度39KHZ
02 G-LEN 01234567 ;电机正向运行1234567步
03 OUT 101n ;使3个输出量为101状态
04 DELAY 0055900 ;延时55.9秒
05 OUT n11n ;使后二位输出状态为11
06 PAUSE ;程序在此处暂停
07 GOTO-0000888 ;电机返回起始点的另一侧第888步的位置
08 OUT nnn1 ;使蜂鸣器响一长声
09 END ;程序结束
例三:
运行要求:(参数设定省略)有一物体,从零点以2.9KHZ的速度向前运行100步(此点作为物体的参考点);在参考点停止后输出010;检测输入位,若INI=0,电机同速度返回零。若INI≠0,电机以15KHZ的速度再向前运行10000步后使蜂鸣器短声报警;再以35KHZ的速度返回参考点。若这时INI=0,则返回零点,否则继续按第一次的方式循环,以此类推。要求返回零点后,蜂鸣器响长声报警。
程序清单:(进入程序编辑状态)
00 SPEED 02900 ;给下的运行赋值速度2,9KHZ
01 G-LEN 00000100 ;电机向前运行100步
02 OUT 010n ;使输出状态为010
03 SPEED 15000 ;INI≠0,则赋值新的速度15KHZ
04 G-LEN 00010000 ;再向前运行1000步
05 OUT nnn0 ;使蜂鸣器短声报警
06 SPEED 35000 ;给下面返回参考点的运行赋值速度35KHZ
07 GOTO 00000100 ;电机以15KHZ速度返回参考点
08 LOOP 03 00000 ;电机作无限循环,直到INI=0才返回零点
09 SPEED 02900 ;赋值返回零点的速度2.9KHZ
10 GOTO 00000000 ;电机以2.9KHZ速度返回零点
11 OUT nnn1 ;返回零点后蜂鸣器长声报警
12 END ;程序结束
例四:
运行要求:(参数设定省略)某一物体从零点处以高速39KHZ向前运行直到碰到前方的行程开关,再同速返回至零点处,结束。(假设此系统的起跳频率为500HZ,零点至接近开关的距离大于100000步,小于100010)。
设计分析:此运动的位移量并不知道其精确值,而只是知道一个大概范围(属于未知变量控制)。我们采用中断操作解决这一问题。我们把行程开关连接至(限位A)A操作端口,由于中断操作时电机降速停止,如果以高速直接运行至行程开关,必然会关生过冲,为了避免过冲,我们采用先高速后低速(低速低于起跳频率)。
参数设定:(进入参数设定状态改变)设定(限位A)A操作入口地址nA=04,其他参数略。
程序清单:(进入程序编辑状态)
00 SPEED 39000 ;赋值速度39KHZ
01 G-LEN 0099000 ;先高速接近,但不能碰上行程开关
02 SPEED 00400 ;低速值频率要低于起跳频率
03 G-LEN 07999999 ;任意设置一个大位移量去接确行程开关
04 SPEED 39000 ;(限位A)A操作入口,赋值回零速度39KHZ
05 GO-AB —A ;按反方向,运行相同位移量,回零
06 END ;程序结束
指令搜查表
参数速查表: