型智能机器人使用说明书

型智能机器人使用说明书AUTOMAN-1型智能机器人由四大部分组成。一。底盘（见图1、图2）图1、图2图3由图1、图2可知：AUTOMAN-1是由三个相隔120度的车轮支撑，其中二个主动轮是专门设计的全橡胶车轮，具有高防滑性高和承载力大的特点。驱动二个主动轮的是二部带有金属减速器的大功率电动机，该电动机能够在2V—6V间可靠工作，转速可在6米/分钟—19米/分钟间调整,即可正转也可反转;由因此双电机驱动,因此可实现双向360度转弯。前轮为全塑料双轮万向轮，转动灵活，支撑有力。蓄电池为6V/1.3安时,在二公斤承重下可连续工作2小时以上.车身支架由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—└┘（子程序返回）PROG-111m多功能可编程序操纵器使用讲明书PROG111的具体特点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秒。└--上跳。┐--下跳。d--显示。E∩d--编程终止指令传送及输入/输出指令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口连带内存的内容右移一次（不循环）—├Pr例1：—├P0（如原F22中值为33（对应二进制=00100001），P0口的值为0执行该指令后Pr口→F(00-99)F（00-99）F22F22中值为16（对应二进制=00010000））例2：—├P0（如原F22中值为33（对应二进制=00100001），P0口的值为1执行该指令后F22F22中值为144（对应二进制=10010000））14．Pr口连带内存的内容左移一次（不循环），内存的最低位补0—┤PrPr口←F(00-99)F（00-99）例1：—┤P0（如原F22值为153（对应二进制=10011001），P0口的值为0执行改指令后F22F22中值为50（对应二进制=00110010），P0口的值由0该为1）例2：—┤P0（如原F22中值为33（对应二进制=00100001），P0口的值为1执行该指令后F22F22中值为66（对应二进制=01000010），P0口的值由1改为0）15。Pr口连带多个内存的内容右移一次（不循环），内存的范畴由F00-F09可选择。—├PrFF（0-9）Pr口→F00→F01….→F09→注：FF0为Pr口→F00→例:—├P7（如原F00=001,F01=002,F02=006P7口的值为1,执行该指令后FF1为Pr口→F00→F01→FF2F00=128,F01=129,F02=003）FF2为Pr口→F00→F01→F02→依此类推：FF9为Pr口→F00→F01→F02→F03→....F09→16。Pr口连带多个内存的内容左移一次（循环），内存的范畴由F00-F09可选择。—┤PrFF（0-9）例:—┤P7（如原F00=001,F01=002,F02=006P7口的值为1,执行该指令后FF2F00=002,F01=004,F02=012P7口的值为0----------------------------------------------------------------------------------------------------------------------------------------------17．Pr输出值取反—Pr┌┐例:—P40（P4输出0）—P4┌┐（P4输出值取反，由0变为1）18.定时器的内容传送给内存—F（00-99）例:F09（定时器C1的内容传送给内存F09）C（0-9）C1-----------------------------------------------------------------------------------------------------------------------------------------------二。显示指令1．全显示器显示内存内容—d00例:—d00（显示内存F03的内容）F(00-99)F032．在个位显示字符—d01例:—d01（在个位显示字符“=”）（字符）=3．在十位显示字符—d02例:—d02（在十位显示字符“P”）（字符）P4。在佰位显示字符—d03例:—d03（在佰位显示字符“□”）（字符）□5。在仟位显示字符—d04例:—d04（在仟位显示字符“H”）（字符）H三。条件跳转指令上内存内容=下内存内容就执行下一条指令，否则上跳KKK步或下跳NNN步。—F（00-99）例1:F12（如F12=F13就执行下一条指令，否则下跳12步）注：KKK=000，NNN=000自循环==KKK=000，NNN≠000下跳NNN步F（00-99）F13KKK≠000，NNN=000上跳KKK步KKK000KKK≠000，NNN≠000上跳KKK步NNN012例2:F12（如F12=F13就执行下一条指令，否则上跳211步）例3:F12（如F12=F13就执行下一条指令，否则上跳111步）==F13F13211111000012例4:F12（如F12=F13就执行下一条指令，否则自循环）=F130000002。上内存内容>下内存内容就执行下一条指令，否则上跳KKK步或下跳NNN步。—F（00-99）注：KKK=000，NNN=000自循环上］KKK=000，NNN≠000下跳NNN步F（00-99）KKK≠000，NNN=000上跳KKK步KKKKKK≠000，NNN≠000上跳KKK步NNN例1:F12（如F12>F13就执行下一条指令，否则下跳12步）例2:F12（如F12>F13就执行下一条指令，否则上跳211步）上］上］F13F13000211012000例3:F12（如F12>F13就执行下一条指令，否则自循）例4:F12（如F12>F13就执行下一条指令，否则上跳111步）上］上］F13F130001110000123．激活定时器同时清0并开始定时，如定时时刻到设定值就执行下一条指令同时定时器清0，否则上跳KKK步或下跳NNN步。-C（0-9）注：设定值SSS=000延时2.5毫秒SSSSSS=001定时1秒KKKSSS=002定时2秒NNN。例1:C7（如定时器C7延时到10秒就执行下一条指令，否则下跳255步）。010SSS=255定时255秒000255注：KKK=000，NNN=000自循环例2:C7（如定时器C7延时到120秒就执行下一条指令，否则上跳11步）KKK=000，NNN≠000下跳NNN步120KKK≠000，NNN=000上跳KKK步011KKK≠000，NNN≠000上跳KKK步000例3:C0（如定时器C0延时到1秒就执行下一条指令，否则自循环）例4:C4（如定时器C4延时到10秒就执行下一条指令，否则上跳100步）0010100001000002554。Pr口输入为1执行下一条指令，否则上跳KKK步或下跳NNN步例1：—上□P3（如P3口输入为1就执行下一条指令，否则下跳10步）—上□Pr000KKK010NNN注：KKK=000，NNN=000自循环例2：—上□PF（如PF口输入为1就执行下一条指令，否则上跳56步）KKK=000，NNN≠000下跳NNN步056KKK≠000，NNN=000上跳KKK步000KKK≠000，NNN≠000上跳KKK步例3：—上□P3（如P3口输入为1就执行下一条指令，否则自循环）例4：—上□P3（如P3口输入为1就执行下一条指令，否则上跳34步）0000340000105．如计数器计到设定值就执行下一条指令，否则上跳KKK步或下跳NNN步。注1：SSS--计数器设定值—］（0-9）例：—］00(计数器0清零)SSS—］01（计数器0+1）KKK=000，NNN≠000下跳NNN步KKK—］0（计数器0如计数到128就执行下一条指令，否则上跳1步）KKK≠000，NNN=000上跳KKK步NNN128KKK≠000，NNN≠000上跳KKK步001注2：在该指令中KKK和NNN不能均为0。000四。跳转及调用指令上跳—└（00-99）例1：—└68（上跳68步KKK000注：KKK=000，上跳（00-99）步KKK≠000，上跳KKK+（00-99）步例2：—└68（上跳168步）100例1：—┐68（下跳68步）2。下跳000注：KKK=000，下跳（00-99）步—┐（00-99）例2：—┐68（下跳168步）KKK≠000，下跳KKK+（00-99）步NNN1003。调用子程序—L（00-99）例3：—L67（调用子程序H67）注：L中的数值表示要调用的子程序标号4．子程序标号—H（00-99）注1：H指令一定在子程序的第一条注2：H指令中的数值一定要和L指令中的数值一样注3：H指令开始的子程序的最后一条指令一定是子程序返回指令“└┘”。5．子程序返回例：H09（这是一个完整的子程序结构）—└┘。注：子程序返回指令一定在子程序的最后一条。。注：子程序返回指令使程序返回到与该子程序对应的L指令的下一条处连续运行。。注：每一个子程序的最后都有该指令。└┘注：子程序中不能再有子程序。五。定时器计数器指令