1AUTOMAN-1型智能机器人使用说明书AUTOMAN-1型智能机器人由四大部分组成。一。底盘(见图1、图2)图1、图2图3由图1、图2可知:1.AUTOMAN-1是由三个相隔120度的车轮支撑,其中二个主动轮是专门设计的全橡胶车轮,具有高防滑性高和承载力大的特点。驱动二个主动轮的是二部带有金属减速器的大功率电动机,该电动机可以在2V—6V间可靠工作,转速可在6米/分钟—19米/分钟间调整,即可正转也可反转;由于是双电机驱动,所以可实现双向360度转弯。前轮为全塑料双轮万向轮,转动灵活,支撑有力。2.蓄电池为6V/1.3安时,在二公斤承重下可连续工作2小时以上.3.车身支架由2毫米厚镀锌铁板冲压而成,在其上的11个铜固定锣孔可固定主电路板和用户自制的支架及动作机构.车身支架的前部和后部均有传感器固定孔.二.主电路板(见图4)图41。主电路板有20个“输入/输出口”。每一个输入/输出口都有三个端子,其中1端为+5V输出,2端为信号输入/输出,3端为地。用户可将各种传感器和功率驱动部件接于输入/输出口。P0—PF口是PROG111M可编程序控电源灯制器的端口,在PROG111M中有专门指令控制,P00—P03是扩展口,可用专门子程序控制(见第三章)。注:机器人的前进、倒退、转弯、停止动作也用专门子程序控制(见第三章)。2。方式开关“1”、“2”均在断开位置选择“自动/手动”方式。在该方式下如不接无线摇控器则机器人完全由插在主电路板上的PROG111M可编程序控制器控制,此时机器人完全按照用户所编的程序运行。当接无线摇控器后,机器人不但可按程序运行还可通过无线摇控器人工控制。方式开关“1”、“2”均在接通(ON)位置选择“手动”方式。在该方式下机器人只能通过无线摇控器人工控制。3.传感器及用户支架固定孔。用户可利用该孔固定各种传感器及用户自制的支架及动作机构。该孔的直径为3毫米。4。穿线孔。该孔用于电路板下面的各种用电件的导线通过,也可以利用该孔固定各种传感器及用户自制的支架及动作机构。5。大负载供电口。该口“1”脚为蓄电池6V正,“2”脚为蓄电池负。当外接的控制部件耗电较大时应采用此端供电。6.主电路板上有红、黑电源线各一条,红线接蓄电池正(红),黑线接蓄电池负(黑),7.电源灯。当该灯闪亮或灭时表示蓄电池电压低于4V应充电了。三.PROG111M可编程序控制器对机器人扩展端口和机器人动作的控制1.PROG111M与机器人主电路板的通讯子程序所有的控制指令均是通过该子程序传送给主电路板的。通讯子程序使用了PROG111M的如下资源:*计数器9(]9)。*内存99(F99)。PE口。*PF口。2。停车程序3。前进程序4。后退程序5。前进左转6。前进右转7。速度1程序—F99—F99—F99—F99—F99—F99000001002003004005通讯程序—L99—L99—L99—L99—L99—L998。速度2程序9。速度3程序10。速度4程序11。P00输出112。P00输出013。P01输出1—H99(子程序入口)—F99—F99—F99—F99—F99—F99—]90(计数器9清0)006007008009010011—PE0(通讯启动)—L99—L99—L99—L99—L99—L99—PE114。P01输出015。P02输出116。P02输出017。P03输出118。P03输出0—┤PF(将F99的内容传送给PF口)—F99—F99—F99—F99—F99F99012013014015016—]91(计数器9加1)—L99—L99—L99—L99—L99—]9(计数器9如计数到8就执行下008一条指令,否则上条4步)注:速度1——速度4的速度是由快到慢的变化004000—PE0(通讯结束)—PE1—└┘(子程序返回)2PROG-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-H99000-255、A00-A07、E00-E99、F00-F99、FF0-FF9、]0-]9、0、1、L00-L99、P00-PF0、P01-PF1、]0-]9、]00-]90、]01-]91、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、E∩d、P0┌┐-PF┌┐。、H、C0-C9C.指令第三字节排列顺序:D.指令第四字节排列顺序:E.指令第五字节排列顺序:000-255、F00-F99000-255000-2557。“S”+“↑”为指令类型上翻键,每按动一次,显示内容就按表1的顺序上翻一级,例如:当前显示的是第一字节内容“—PF∩”,按一次K1+K4显示变为“—P0∩”,再按一次显示变为“—E∩d”,再按一次显示变为“—□PF”,再按一次显示变为“—□P0”,再按一次显示变为“—└┘”。。。。。。如此类推,循环进行。当选中了某一种指令后就可用“+”、“—”进行详细选择,从而加快了指令的输入速度。8。利用显示指令可在PROG111M的四位显示器上显示字符,表2说明了可显示的字符及排列顺序。表20123456789AbCdEF│├┤上□下□下┌┐]-上]P└┐L(无字符)└┘=。H9.程序编完后不要忘记在最后加上“E∩d”结束指令。10。“S”+“”为校验键,程序编完后一定要校验,否则PROG111无法运行。*校验无错显示“0000”,按“复位键”回复修改。*校验有错显示“0E∩d”,说明用户程序最后没有编程结束指令“E∩d”,按“复位键”回复修改。*校验有错显示“0程序顺序号”,该出错信息说明在调子程序时用户忘记输入与之对应的子程序标号指令或输入的有错误,按“复位键”回复修改。*校验有错显示“1程序顺序号”,该出错信息说明在子程序中无返回指令,按“复位键”回复修改。*校验有错显示“2程序顺序号”该出错信息说明该条指令有语法错误,按“复位键”回复修改。例1:出错信息“0152”该出错信息说明第152条指令(肯定是调用子程序指令L00-L99)无与之对应的子程序标号(H00-H99)。例2:出错信息“1765”该出错信息说明第765条指令(肯定是子程序标号指令H00-H99)无返回指令。例3:出错信息“2004”该出错信息说明第4条指令有语法错误。三指令介绍每条指令起始用“—”符号。KKK--上跳步数(000-255),以指令的第一字节计算步数而指令中间的内容不计算步数,即:每条指令只算一步。NNN--下跳步数(000-255)。以指令的第一字节计算步数而指令中间的内容不计算步数,即:每条指令只算一步。SSS—十进制数值(000-255)。r--端口数(0-F)。其中0-9为开关量输入/输出口,A-F为数字量输入/输出口。├--右移符号。┤--左移符号。]--大于符号。[--小于符号。=--等于符号。□--输入符号。F00-F99--内存共计100个。A00-A07—模拟量输入口共计8个。AA0-AA1--模拟量输出口共计2个。E00-E99--EEPROM内存共计100个。Pr--输入/输出口共计16个,P0-PF。L00-L99--调用子程序共计100个。H00-H99--子程序标号,共计100个.└┘--子程序返回。]0-]9--计数器共计10个,每个计数范围000-255。C0-C9--定时器共计10个,每个定时范围1秒-255秒。└--上跳。┐--下跳。--显示。E∩d--编程结束指令3传送及输入/输出指令1.将模拟输入口(ADC)的值传送给内存(该指令只在PROG111G型机中才有效)—F(00-99)例:—F02(将模拟输入口A05的值传送给内存F02)A(00-07)A052.将内存中的值传送给模拟输出口(DAC)(该指令只在PROG111G型机中才有效)—AA(0-1)例:—AA0(将内存F05的值传送给模拟输出口AA0)F(00-99)F053。输出口清0(继电器不工作)—Pr0例:—P50(输出口P5清0)4。输出口置1(继电器工作)—Pr1例:—P51(输出口P5置1)5。将数值传送给内存—F(00-99)例:—F68(将数值“37”传送给内存F68)SSS0376。将EEPROM存储器的内容传送给内存—F(00-99)例:—F20(将EEPROM存储器E99中的内容传送给内存F20)E(00-99)E997。将内存的内容传送给EEPRON存储器—E(00-99)例:—E20(将内存F99中的内容传送给EEPROM存储器E20)F(00-99)F998。计数器的内容传送给内存—F(00-99)例:—F06(将计数器)9的内容传送给内存F06)](0-9)]99。将内存的内容传送给计数器—](0-9)例:—]3(将内存F00的内容传送给计数器)3)F(00-99)F0010.将数值传送给计数器—](0-9)例:—]3(将数值100传送给计数器)3)SSS10000000000000011。内存的内容右移一次(循环—├例:—├(如原F22中值为33(对应二进制=00100001)执行该指令后F(00-99)F22F22中值为90(对应二进制=10010000))12。内存的内容左移一次(循环)—┤例:—┤(如原F22中值为33(对应二进制=00100001)执行该指令后F(00-99)F22F22中值为66(对应二进制=01000010))13.Pr口连带内存的内容右移一