型智能机器人使用说明书

AUTOMAN-1 型智能机器人使用说明书AUTOMAN-1型智能机器人由四大部分组成。一。底盘（见图1、图2） 图1、 图2 图3由图1、图2可知：1 AUTOMAN-1是由三个相隔120度的车轮支撑，其中二个主动轮是专门设计的全橡胶车轮，具有高防滑性高和承载力大的特点。驱动二个主动轮的是二部带有金属减速器的大功率电动机，该电动机可以在2V6V间可靠工作，转速可在6米/分钟19米/分钟间调整,即可正转也可反转; 由于是双电机驱动,所以可实现双向360度转弯。前轮为全塑料双轮万向轮，转动灵活，支撑有力。2 蓄电池为6V/1.3安时,在二公斤承重下可连续工作2小时以上.3 车身支架由2毫米厚镀锌铁板冲压而成,在其上的11个铜固定锣孔可固定主电路板和用户自制的支架及动作机构. 车身支架的前部和后部均有传感器固定孔.二.主电路板（见图4） 图41。主电路板有20个“输入/输出口”。每一个输入/输出口都有三个端子，其中1端为+5V输出，2端为信号输入/输出，3端为地。用户可将各种传感器和功率驱动部件接于输入/输出口。P0PF 口是PROG111M可编程序控电源灯 制器的端口，在PROG111M中有专门指令控制，P00P03是扩展口，可用专门子程序控制（见第三章）。注：机器人的前进、倒退、转弯、停止动作也用专门子程序控制（见第三章）。2。方式开关“1”、“2”均在断开位置选择“自动/手动” 方式。在该方式下如不接无线摇控器则机器人完全由插在主电路板上的PROG111M可编程序控制器控制，此时机器人完全按照用户所编的程序运行。当接无线摇控器后，机器人不但可按程序运行还可通过无线摇控器人工控制。方式开关“1”、“2”均在接通（ON）位置选择“手动” 方式。在该方式下机器人只能通过无线摇控器人工控制。3传感器及用户支架固定孔。用户可利用该孔固定各种传感器及用户自制的支架及动作机构。该孔的直径为3毫米。4。穿线孔。该孔用于电路板下面的各种用电件的导线通过，也可以利用该孔固定各种传感器及用户自制的支架及动作机构。5。大负载供电口。该口“1”脚为蓄电池6V正，“2” 脚为蓄电池负。当外接的控制部件耗电较大时应采用此端供电。6主电路板上有红、黑电源线各一条，红线接蓄电池正（红），黑线接蓄电池负（黑）， 7电源灯。当该灯闪亮或灭时表示蓄电池电压低于4V应充电了。三.PROG111M可编程序控制器对机器人扩展端口和机器人动作的控制 1PROG111M与机器人主电路板的通讯子程序所有的控制指令均是通过该子程序传送给主电路板的。通讯子程序使用了PROG111M的如下资源：* 计数器9 （ 9 ）。 * 内存 99 （F99） 。PE口。* PF口。2。停车程序 3。前进程序 4。后退程序 5。前进左转 6。前进右转 7。速度1程序F99 F99 F99 F99 F99 F99000 001 002 003 004 005通讯程序 L99 L99 L99 L99 L99 L99 8。速度2程序 9。速度3程序 10。速度4程序 11。P00输出1 12。P00输出0 13。P01输出1 H99 （子程序入口） F99 F99 F99 F99 F99 F99 90 （计数器9清0） 006 007 008 009 010 011PE0 （通讯启动） L99 L99 L99 L99 L99 L99PE1 14。P01输出0 15。P02输出1 16。P02输出0 17。P03输出1 18。P03输出0 PF （将F99的内容传送给PF口） F99 F99 F99 F99 F99F99 012 013 014 015 016 91 （计数器9加1） L99 L99 L99 L99 L99 9 （计数器9如计数到8就执行下008 一条指令，否则上条4步） 注：速度1 速度4的速度是由快到慢的变化004000PE0 （通讯结束）PE1 （子程序返回）PROG-111m 多功能可编程序控制器使用说明书一 PROG111的具体特点1 16个输入/输出口。2。有10个内部定时器C0-C9。3。有10个内部计数器 0 - 9。4。有100个内存F00-F99。5。有100个掉电可保持EEPROM存储器E00-E99。6。四位LED显示器不仅用于编程且还可在运行时显示用户需要的各种物理量，如：数值、电压、电流、时间、转速等。7。用户程序存储器最多可存储800条用户程序，并可反复修改10万次以上，在掉电情况下用户程序可保存40年以上。8。6个按键可完成所有编程功能，包括：输入指令、上下翻页、指令快速选择、删除、插入、校验。9。有单步仿真运行模式，对程序及设备的调试非常有用。10。有33条（六种类型）高效指令，二 总体结构见图1 （图1） （图2）三编程 1 进入编程模式将方式开关放在图2位置，接通电源或按动“复位键”就可进入编程模式，此时显示“。”，6秒钟后显示第一条程序内容，然后就可进行编程的其它操作了。 2 操作1。“+”、“” 键为“单个指令选择键”，通过它们用户可逐条改变当前显示的指令字节的内容。 2“”、“” 键为“上下翻页键”，通过它们用户可查看每一条程序。上翻页时，每按一次“” 键显示内容上跳到上一条指令的第一字节；下翻页时，用“” 键可查看每一条指令的所有字节。3“” 键为“快速下翻页键”，每按一次该键显示内容下跳10条程序，从而加快了查找速度。 4“S” 键为双功能键。“S”+“+”（先按“S”不松再按“+”）为插入键，其功能为：在当前显示的指令前插入一条指令，插入的指令最初显示为“AA0”，可用“+”、“”键将其改变为自己需要的指令，插入过程约需40秒，在这期间显示“。”。5“S”+“”为删除键，其功能为：将当前显示的指令删除，删除过程约需40秒，在这期间显示“。”。6。“S”+“”为指令类型下翻键，每按动一次，显示内容就按表1的顺序下翻一级，例如：当前显示的是第一字节内容“AA0”，按一次“S”+“”显示变为“AA1”，再按一次显示变为“C0 ”，再按一次显示变为“C9 ”，再按一次显示变为“C00”，再按一次显示变为“C90”。如此类推，循环进行。当选中了某一种指令后就可用“+”、“”进行详细选择，从而加快了指令的输入速度。 表1A.指令第一字节排列顺序： B指令第二字节排列顺序： AA0-AA1、C0-C9、C00-C90、d00-d04、E00-E99、F00-F99、H00-H99 000-255、A00-A07、E00-E99、F00-F99、FF0-FF9、0- 9、0、1、 L00-L99、P00-PF0、P01-PF1、0- 9、00- 90、01- 9 1、2、3、4、5、6、7、8、9、A、b、C、d、E、F、 02-92、P0-PF、P0- PF、00-99、 、上 、P、 、L、（无显示）、=、 00-99、P0-PF、Ed、P0- PF 。、H、C0-C9C指令第三字节排列顺序： D指令第四字节排列顺序： E指令第五字节排列顺序： 000-255、F00-F99 000-255 000-2557。“S”+“”为指令类型上翻键，每按动一次，显示内容就按表1的顺序上翻一级，例如：当前显示的是第一字节内容“PF”，按一次K1+K4显示变为“P0”，再按一次显示变为“Ed”，再按一次显示变为“PF”，再按一次显示变为“P0”，再按一次显示变为“”。如此类推，循环进行。当选中了某一种指令后就可用“+”、“”进行详细选择，从而加快了指令的输入速度。8。利用显示指令可在PROG111M的四位显示器上显示字符，表2说明了可显示的字符及排列顺序。表20 1 2 3 4 5 6 7 8 9 A b C d E F 上 下 下 - 上 P L （无字符） = 。 H9程序编完后不要忘记在最后加上“Ed”结束指令。10。“S”+“”为校验键，程序编完后一定要校验，否则PROG111无法运行。* 校验无错显示“0000”，按“复位键”回复修改。 * 校验有错显示“0Ed”，说明用户程序最后没有编程结束指令“Ed” ，按“复位键”回复修改。 * 校验有错显示“0程序顺序号”，该出错信息说明在调子程序时用户忘记输入与之对应的子程序标号指令或输入的有错误，按“复位键”回复修改。 * 校验有错显示“1程序顺序号”，该出错信息说明在子程序中无返回指令，按“复位键”回复修改。 * 校验有错显示“2程序顺序号” 该出错信息说明该条指令有语法错误，按“复位键”回复修改。例1：出错信息“0152” 该出错信息说明第152条指令（肯定是调用子程序指令L00-L99）无与之对应的子程序标号（H00-H99）。例2：出错信息“1765” 该出错信息说明第765条指令（肯定是子程序标号指令H00-H99）无返回指令。例3：出错信息“2004” 该出错信息说明第4条指令有语法错误。三 指令介绍l 每条指令起始用“”符号。l KKK-上跳步数（000-255），以指令的第一字节计算步数而指令中间的内容不计算步数，即：每条指令只算一步。l NNN-下跳步数（000-255）。以指令的第一字节计算步数而指令中间的内容不计算步数，即：每条指令只算一步。l SSS十进制数值（000-255）。l r-端口数（0-F）。其中0-9为开关量输入/输出口，A-F为数字量输入/输出口 。 l -右移符号。 -左移符号。 -大于符号。-小于符号。-等于符号。-输入符号。l F00-F99- 内存共计100个。 A00-A07模拟量输入口共计8个。 AA0-AA1-模拟量输出口共计2个 。E00-E99-EEPROM内存共计100个 。l Pr-输入/输出口共计16个，P0-PF。L00-L99-调用子程序共计100个 。H00-H99-子程序标号，共计100个.-子程序返回。l 0- 9-计数器共计10个，每个计数范围000-255。C0-C9- 定时器共计10个，每个定时范围1秒-255秒。 -上跳。 -下跳。dd-显示。Edd-编程结束指令传送及输入/输出指令1将模拟输入口（ADC）的值传送给内存 （该指令只在PROG111G型机中才有效） F(00-99) 例：F02 （将模拟输入口A05的值传送给内存F02）A(00-07) A052. 将内存中的值传送给模拟输出口（DAC） （该指令只在PROG111G型机中才有效） AA（0-1） 例：AA0 （将内存F05的值传送给模拟输出口AA0） F(00-99) F05 3。 输出口清0（继电器不工作） Pr 0 例：P50 （输出口P5清0）4。 输出口置1（继电器工作） Pr 1 例：P51 （输出口P5置1）5。将数值传送给内存 F（00-99） 例：F68 （将数值“37” 传送给内存F68） SSS 0376。将EEPROM存储器的内容传送给内存 F（00-99） 例：F20 （将EEPROM存储器E99中的内容传送给内存F20） E（00-99） E997。将内存的内容传送给 EEPRON存储器 E（00-99） 例：E20 （将内存F99中的内容传送给EEPROM存储器E20）F（00-99） F99 8。计数器的内容传送给内存 F（00-99） 例：F06 （将计数器 ）9的内容传送给内存F06）（0-9） 9 9。将内存的内容传送给计数器 （0-9） 例：3 （将内存F00的内容传送给计数器 ）3）F（00-99） F0010将数值传送给计数器 （0-9） 例：3 （将数值100传送给计数器 ）3） SSS 100 000 000 000 00011。内存的内容右移一次（循环 例： （如原F22中值为33（对应二进制=00100001）执行该指令后 F（00-99） F22 F22中值为90（对应二进制=10010000）12。内存的内容左移一次（循环） 例： （如原F22中值为33（对应二进制=00100001）执行该指令后 F（00-99） F22 F22中值为66（对应二进制=01000010） 13Pr口连带内存的内容右移一次（不循环） Pr 例1： P0 （如原F22中值为33（对应二进制=00100001），P0口的值为0执行该指令后 Pr口F(00-99) F（00-99） F22 F22中值为16（对应二进制=00010000）例2： P0 （如原F22中值为33（对应二进制=00100001），P0口的值为1执行该指令后F22 F22中值为144（对应二进制=10010000）14Pr口连带内存的内容左移一次（不循环），内存的最低位补 0 Pr Pr口F(00-99) F（00-99）例1： P0 （如原F22值为153（对应二进制=10011001），P0口的值为0执行改指令后F22 F22中值为50（对应二进制=00110010），P0口的值由0该为1）例2： P0 （如原F22中值为33（对应二进制=00100001），P0口的值为1执行该指令后F22 F22中值为66（对应二进制=01000010），P0口的值由1改为0）15。Pr口连带多个内存的内容右移一次（不循环），内存的范围由F00-F09可选择。 Pr FF（0-9） Pr口F00F01.F09注： FF0 为Pr口F00 例: P7 （如原F00=001,F01=002,F02=006 P7口的值为1,执行该指令后 FF1 为Pr口F00F01 FF2 F00=128,F01=129,F02=003 ） FF2 为Pr口F00F01F02 依此类推： FF9 为Pr口F00F01F02F03.F0916。Pr口连带多个内存的内容左移一次（循环），内存的范围由F00-F09可选择。 Pr FF（0-9） 例: P7 （如原F00=001,F01=002,F02=006 P7口的值为1,执行该指令后FF2 F00=002,F01=004,F02=012 P7口的值为0 -17Pr输出值取反 Pr 例: P40 （P4输出0） P4 （P4输出值取反，由0变为1）18. 定时器的内容传送给内存 F（00-99） 例: F09 （定时器C1的内容传送给内存F09） C（0-9） C1-二。显示指令1全显示器显示内存内容 d 00 例: d 00 （显示内存F03的内容） F(00-99) F032在个位显示字符 d 01 例: d 01 （在个位显示字符“=”）（字符） =3在十位显示字符 d 02 例: d 02 （在十位显示字符“P”）（字符） P4。在佰位显示字符 d 03 例: d 03 （在佰位显示字符“”）（字符） 5。在仟位显示字符 d 04 例: d 04 （在仟位显示字符“H”）（字符） H 三。条件跳转指令 1 上内存内容=下内存内容就执行下一条指令，否则上跳KKK步或下跳NNN步。 F（00-99） 例1: F12 （如F12=F13就执行下一条指令，否则下跳12步）注：KKK=000，NNN=000 自循环 = =KKK=000，NNN000 下跳NNN步 F（00-99） F13KKK000，NNN=000 上跳KKK步 KKK 000 KKK000，NNN000 上跳KKK步 NNN 012例2: F12 （如F12=F13就执行下一条指令，否则上跳211步） 例3: F12 （如F12=F13就执行下一条指令，否则上跳111步） = = F13 F13 211 111 000 012例4: F12 （如F12=F13就执行下一条指令，否则自循环） = F13 000 0002。上内存内容下内存内容就执行下一条指令，否则上跳KKK步或下跳NNN步。 F（00-99） 注：KKK=000，NNN=000 自循环 上 KKK=000，NNN000 下跳NNN步 F（00-99）KKK000，NNN=000 上跳KKK步 KKKKKK000，NNN000 上跳KKK步 NNN例1: F12 （如F12F13就执行下一条指令，否则下跳12步） 例2: F12 （如F12F13就执行下一条指令，否则上跳211步） 上 上 F13 F13 000 211 012 000例3: F12 （如F12F13就执行下一条指令，否则自循） 例4: F12 （如F12F13就执行下一条指令，否则上跳111步） 上 上 F13 F13 000 111 000 012 3激活定时器同时清0并开始定时，如定时时间到设定值就执行下一条指令同时定时器清0，否则上跳KKK步或下跳NNN步。 -C（0-9） 注：设定值 SSS=000 延时2.5毫秒 SSSSSS=001 定时1秒 KKK SSS=002 定时2秒 NNN 。 例1: C7 （如定时器C7延时到10秒就执行下一条指令，否则下跳255步） 。 010 SSS=255 定时255秒 000255 注： KKK=000，NNN=000 自循环 例2: C7 （如定时器C7延时到120秒就执行下一条指令，否则上跳11步）KKK=000，NNN000 下跳NNN步 120 KKK000，NNN=000 上跳KKK步 011KKK000，NNN000 上跳KKK步 000例3: C0 （如定时器C0延时到1秒就执行下一条指令，否则自循环） 例4: C4 （如定时器C4延时到10秒就执行下一条指令，否则上跳100步） 001 010 000 100 000 2554。Pr口输入为1执行下一条指令，否则上跳KKK步或下跳NNN步 例1：上P3 （如P3口输入为1就执行下一条指令，否则下跳10步） 上Pr 000 KKK 010 NNN 注：KKK=000，NNN=000 自循环 例2：上PF （如PF口输入为1就执行下一条指令，否则上跳56步）KKK=000，NNN000 下跳NNN步 056KKK000，NNN=000 上跳KKK步 000KKK000，NNN000 上跳KKK步例3：上P3 （如P3口输入为1就执行下一条指令，否则自循环） 例4：上P3 （如P3口输入为1就执行下一条指令，否则上跳34步） 000 034 000 0105如计数器计到设定值就执行下一条指令，否则上跳KKK步或下跳NNN步。注1：SSS-计数器设定值 （0-9） 例：00 (计数器0清零) SSS 01 （计数器0+1）KKK=000，NNN000 下跳NNN步 KKK 0 （计数器0如计数到128就执行下一条指令，否则上跳1步）KKK000，NNN=000 上跳KKK步 NNN 128KKK000，NNN000 上跳KKK步 001注2：在该指令中 KKK 和 NNN 不能均为 0 。 000四。跳转及调用指令1 上跳 （00-99） 例1： 68 （上跳68步 KKK 000注： KKK=000，上跳（00-99）步KKK000，上跳 KKK+（00-99）步 例2： 68 （上跳168步） 100例1： 68 （下跳68步）2。下跳 000注： KKK=000，下跳（00-99）步 （00-99） 例2： 68 （下跳168步） KKK000，下跳 KKK+（00-99）步 NNN 1003。调用子程序 L（00-99） 例3： L67 （调用子程序 H67 ）注：L 中的数值表示要调用的子程序标号4子程序标号 H（00-99）注1：H 指令一定在子程序的第一条注2：H 指令中的数值一定要和L指令中的数值一样注3：H 指令开始的子程序的最后一条指令一定是子程序返回指令“”。5子程序返回 例： H09 （这是一个完整的子程序结构） 。注：子程序返回指令一定在子程序的最后一条。 。注：子程序返回指令使程序返回到与该子程序对应的 L 指令的下一条处继续运行。 。注：每一个子程序的最后都有该指令。 注：子程序中不能再有子程序。 五。定时器计数器指令 1。计数器清零 (0-9)0 例： 80 （计数器 ）8 清零） 2。计数器+1 (0-9)1 例： 81 （计数器 ）8加1 ）3。计数器-1 (0-9)2 例： 82 （计数器 ）8减1 ）4。关定时器并清零 C (0-9)0 例： C40 （关定时器C4并清零）5。定时器时钟设定 C (0-9) 例: C4 (设定定时器时钟0.1秒) A-C C注：A-定时器时钟60秒 C0 （如定时器C0延时到0.1秒就执行下一条指令，否则自循环）B-定时器时钟1秒 001C-定时器时钟0.1秒 000程序开始必需执行该指令以确定时钟值。 000六。结束指令 Ed 注：用户程序的最后一条必需有该指令，七，编程格式及注意事项1