Abstract
Portable Robot.as compared with general arc—welding robot.has its unique characte r because of its portability Firstly on this pape r the mechanic architecture of portable robot is introduced Secondly.the hardware archi。tectu re of robot controller is introduced also Lastly.The design of the software architectu re is introduced in detail
Keywo~s:port~ le robot.robot controlle r
摘 è¦ï¼šä¾¿æ”œå¼æ©Ÿå™¨äººé«”ç©å°ï¼Œé‡é‡è¼•,攜帶方使,å¯ä»¥åœ¨ç‹¹å°ç©ºé–“內作æ¥ï¼Œèˆ‡æ™®é€šå¤ç„Šæ©Ÿå™¨äººç›¸æ¯”,具有ç¨ç‰¹çš„å„ªé»žã€‚æœ¬æ–‡é¦–å…ˆä»‹ç´¹äº†ä¾¿æ”œå¼æ©Ÿå™¨äººçš‹é«”çµæ§‹ï¼Œå…¶è£Šä»‹ç´¹äº†èª¼æŽ§åˆ¶å™¨çš„ç¡¬ä»¶çµæ§‹ï¼Œæœ€åŽä»‹ç´¹äº†æŽ§åˆ¶å™¨è»Ÿä»¶çš„è¨è¨ˆã€‚
é—œéµè©žï¼šä¾¿æ”œå¼æ©Ÿå™¨äººï¼Œæ©Ÿå™¨äººæŽ§åˆ¶å›‚
1 引言
由于目å‰å·¥å» é‡Œæ‰€ç”¨çš„æ™®é€šæ©Ÿå™¨äººï¼Œé‡‡ç”¨å›ºå®šç ¬ç½®å®‰è£ï¼Œæ‰€ä»¥å°äºŽæŸäº›ç‹¹å°ç©ºé–“和作æ¥ä½ç½®ä¸å›ºå®šçš„å ´åˆå°±ç„¡æ³•å‹ä»»ã€‚é‡å°é€™ç¨®æƒ…æ³æˆ‘å€‘ç ”åˆ¶å‡ºäº†ä¾¿æ”œå¼æ©Ÿå™¨äººï¼Œå®ƒæ”œå¸¶æ–¹ä¾¿ï¼Œåœ¨éœ€è¦ä½œæ¥çš„地方進行簡單安è£å°±èƒ½å·¥ä½œã€‚è©²ä¾¿æ”œæ©Ÿå™¨äººç”±æ©Ÿæ¢°æœ¬é«”ã€æŽ§åˆ¶å™¨å’Œç§»å‹•è£ç½®ç‰æ§‹æˆã€‚å°æ©Ÿæ¢°æœ¬é«”采用了類比性è¨è¨ˆã€‚出于å°ä¾¿æ”œå¼å¼§ç„Šæ©Ÿå™¨äººçš„æ©Ÿæ§‹ç‰¹é»žå’Œä½¿ç”¨ç‰¹æ€§çš„考慮,便攜å¼å¼§ç„Šæ©Ÿå™¨äººçš„é«”ç©å°ã€é‡é‡è¼•,軌跡è¦åŠƒç„¡é ˆè€ƒæ…®å¾©é›œçš„åŠ›çŸ©ç´„æŸã€‚但由于便攜å¼å¼§ç„Šæ©Ÿå™¨äººä¸»è¦æ‡‰ç”¨äºŽèˆ¹é«”內部ã€é‹çˆå…§éƒ¨ç‰ç‹¹å°ç©ºé–“ï¼Œå·¥ä½œç’°å¢ƒå¾©é›œï¼Œæ‰€ä»¥å°æ©Ÿå™¨äººæœ«ç«¯å¤¾æŒå™¨ï¼ˆç„Šæ§ï¼‰çš„é‹å‹•éˆæ´»æ€§è¦æ±‚較高。在è¨è¨ˆæŽ§åˆ¶å™¨æ™‚,å°åœ‹å…§å¤–çš„æ©Ÿå™¨äººæŽ§åˆ¶å™¨é€²è¡Œäº†å»£æ³›ç ”ç©¶??紤]äº†ç•¶å‰æ©Ÿå™¨äººæŽ§åˆ¶å™¨çš„發展方å‘,我們è¨è¨ˆå‡ºäº†å…·æœ‰ä¸€å®šé€šç”¨æ€§å’Œé–‹æ”¾çµæ§‹çš„æ©Ÿå™¨äººæŽ§åˆ¶å™¨ã€‚
2 ä¾¿æ”œå¼æ©Ÿå™¨äººæœ¬é«”
該機器人為å…è‡ªç”±åº¦é—œç¯€å¼æ©Ÿå™¨äººã€‚全部采用轉動é‹å‹•副。由交æµä¼ºæœé›»æ©Ÿé€šéŽè«§æ³¢æ¸›é€Ÿå™¨å¸¶å‹•。機械本體自é‡ç‚º30kgå·¦å³ï¼ŒæŒé‡å¤§ç´„5kgã€‚å°‡å¯¦ç‰©çµæ§‹åœ–進行簡化,按照DHæ³•å‰‡å»ºç«‹åæ¨™ç³»ï¼Œçµæžœå¦‚圖1所示機器人å„關節åŠé€£æ¡¿çš„çµæ§‹åƒé‡å¦‚表1所示。
[IMG]/uploadpic/THESIS/2008/3/2008032111414732596M.jpg[/IMG
]
3 æŽ§åˆ¶å™¨ç¡¬ä»¶çµæ§‹
å·¥æ¥æ©Ÿå™¨äººæŽ§åˆ¶å™¨ç¡¬ä»¶ä¸»è¦åŒ…括主機ã€ç¤ºæ•™ç›’ã€é‹å‹•電機ã€ç¢¼ç›¤ã€é©…動器和輸人輸出擴展å¡ç‰ã€‚在åƒè€ƒåœ‹å…§å¤–機器人控制器的基礎上,我們è¨è¨ˆäº†å¦‚圖2所示的機器人控制器,該控制器主è¦ç”±ä»¥ä¸‹ç¡¬ä»¶æ§‹æˆï¼š
[IMG]/uploadpic/THESIS/2008/3/2008032111424691662S.jpg[/IMG
(1)主機采用基于ISAç¸½ç·šçš„å·¥æ¥æŽ§åˆ¶æ©Ÿï¼ŒCPU為Pe nlinum1 66。
(2)通訊å¡ç¤ºæ•™ç›’和主機通訊é¸ç”¨MOXAå…¬å¸çš„C102通用RS一422ï¼485兩串å£é€šè¨Šå¡ï¼Œç¤ºæ•™ç›’和主機通訊采用RS422ç¸½ç·šæŽ¥å£æ¨™æº–.使得通訊抗干擾能力強,傳輸è·é›¢é•· 該å¡çš„å¦ä¸€ç«¯El留作備用。驅動器和主機的通訊采用M0XAçš„C168P通用八串El通訊å¡ã€‚其作用是將碼盤å饋的電機ä½ç½®ä¿¡æ¯å‚³çµ¦ä¸»æ©Ÿï¼Œä»¥ç¢ºå®šæ©Ÿå™¨äººçš„åˆå§‹ç²¾ç¢ºä½ç½®
(3)示教盒示教盒是機器人和æ“作者人機交互的工具。示教盒由盒體ã€éµç›¤ã€é¡¯ç¤ºå±ã€æŽ§åˆ¶é›»è·¯ç‰çµ„æˆã€‚ç¤ºæ•™ç›’é¢æ¿ä¸Šæœ‰55個éµï¼ŒæŒ‰éµé‡‡ç”¨è¼•巧超薄的薄膜開關。æ“縱者通éŽéµç›¤è¼¸å…¥ä¿¡æ¯ï¼Œé¡¯ç¤ºå±é‡‡ç”¨MGLS240 X 128é»žé™£å¼æ¶²æ™¶é¡¯ç¤ºå± 該液晶顯示å±å¯ä»¥é¡¯ç¤ºä¸æ–‡ï¼Œäººæ©Ÿç•Œé¢å‹å¥½ã€‚
(4)電機本控制器使用了å…個交æµä¼ºæœé›»æ©Ÿï¼Œè©²é›»æ©Ÿæœ¬èº«é…有碼盤,碼盤é¸ç”¨äº†ä¸€ç¨®ç°¡æ˜“的絕å°ç¢¼ç›¤ï¼Œé€™ç¨®ç¢¼ç›¤åªèƒ½å¤§è‡´è¨˜éŒ„機器人所處的絕å°ä½ç½®ï¼Œæ‰€ä»¥åœ¨æ©Ÿå™¨äººé–‹æ©Ÿå•Ÿå‹•時,關節電機è¦ä½œå¾ˆå°çš„轉動,以便確定出電機在一圈內所處的精確ä½ç½®ã€‚這種碼盤在一定程åºä¸Šå…¼å…·äº†çµ•å°ç¢¼ç›¤å’Œå¢žé‡ç¢¼ç›¤çš„優點。
(5)é‹å‹•控制æ¿é›»æ©Ÿé‹å‹•控制采用基于PMDçš„é‹å‹•控制æ¿ï¼Œä¸€å€‹æ¿å¯ä»¥æŽ§åˆ¶4個電機的連動,由于有6個電機,所以用了兩個控制æ¿??刂瓢逑èŒå¯—æ‚ é¬æ•µé²å§C驅動信號ã€ä¼ºæœONã€å ±è¦æ¸…é™¤ç‰æŽ§åˆ¶ä¿¡è™Ÿã€‚é©…å‹•å™¨çš„ä½œç”¨æ˜¯å°‡æŽ§åˆ¶ä¿¡è™Ÿæ”¾å¤§ï¼Œ
(6)lï¼O擴展 lï¼O擴展主è¦ç”¨äºŽå’Œå¤–部焊接控制器ã€å‚³æ„Ÿå™¨çš„é€šè¨Šä»¥åŠæ©Ÿå™¨äººæŽ§åˆ¶å™¨é¢æ¿æŒ‡ç¤ºç‡ˆé–‹æ»…以åŠéŒ¯å ±è¦ç‰ã€‚這里é¸ç”¨äº†å¨é”工控的ICP—DlO481ï¼O擴展å¡ã€‚
4 æŽ§åˆ¶å™¨è»Ÿä»¶çµæ§‹
機器人控制器軟件是一個大型的系統軟件,我們采用了é¢å‘éŽç¨‹çš„軟件è¨è¨ˆæ–¹æ³•進行軟件è¨è¨ˆã€‚這樣整個軟件被劃分為功能相å°ç¨ç«‹çš„æ¨¡å¡Šï¼Œä½¿å¾—è»Ÿä»¶çµæ§‹æ¸…晰,ä¸åƒ…易于è¨è¨ˆä¹Ÿæ˜“于閱讀和ç†è§£ ä¾¿æ”œå¼æ©Ÿå™¨äººæŽ§åˆ¶å™¨è»Ÿä»¶ç¸½é«”çµæ§‹å¦‚圖3所示

圖3 ç³»çµ±è»Ÿä»¶æ¨¡å¡Šçµæ§‹åœ–框
上é¢è™›ç·šæ¡†é‡Œé¢çš„éƒ¨åˆ†æ˜¯æŽ§åˆ¶å™¨è»Ÿä»¶çš„ä¸Šå±¤è»Ÿä»¶ï¼Œå®ŒæˆæŽ§åˆ¶å™¨çš„ä»»å‹™è¦åŠƒå’Œç›£æŽ§ã€‚ä¸‹é¢è™›ç·šæ¡†é‡Œæ˜¯ä¸‹å±¤è»Ÿä»¶ï¼ŒåŒ…括機器人é‹å‹•軌跡è¦åŠƒå’Œä¼ºæœé›»æ©ŸæŽ§åˆ¶ã€‚æ ¹æ“šä¾¿æ”œå¼å¼§ç„Šæ©Ÿå™¨äººçš„工作需求和軟件模塊的劃分原則,整個控制軟件劃分為以下幾個相å°ç¨ç«‹çš„æ¨¡å¡Šï¼š
(1)åˆå§‹åŒ–模塊該模塊主è¦ä½œç”¨æ˜¯è¨ç½®æŽ§åˆ¶å™¨çš„作æ¥ç’°å¢ƒã€‚
(2)監控模塊該模塊æä¾›ç¤ºæ•™ç›’與主機的通訊功能,處ç†éµç›¤æ“Šéµï¼Œè™•ç†æ©Ÿå™¨äººé‹è¡Œæ™‚çš„ä½ç½®è¶…é™ç‰æŽªæ–½ï¼Œlï¼Oæ¨¡å¡Šç®¡ç†æŽ§åˆ¶å™¨é¢æ¿ç‡ˆå’Œå ±è¦ã€‚
(3]示教模塊 該模塊主è¦å®Œæˆå°æ©Ÿå™¨äººçš„示教æ“作。å¯ä»¥åœ¨é—œç¯€ã€ç›´è§’ã€å·¥å…·å’Œç”¨æˆ¶å››ç¨®å標系下示教。示教模塊的輸出為è¦å®šæ©Ÿå™¨äººå†ç¾é‹å‹•æ–¹å¼çš„æŒ‡ä»¤æ–‡ä»¶å’Œè¨˜éŒ„示教點ä½ç½®ä¿¡æ¯çš„ä½ç½®æ–‡ä»¶ã€‚
(4)å†ç¾æ¨¡å¡Šè©²æ¨¡å¡Šä¸»è¦å®Œæˆæ©Ÿå™¨äººçš„å†ç¾æ“ä½œã€‚å®ƒèª¿ç”¨æ©Ÿå™¨äººèªžè¨€è§£é‡‹æ¨¡å¡Šå½¢æˆæ©Ÿå™¨å¯ä»¥ç†è§£çš„é‹å‹•æŒ‡ä»¤ï¼Œæ ¹æ“šä¸åŒçš„æŒ‡ä»¤åŽ»èª¿ç”¨ä¸‹å±¤è»Ÿä»¶é©…å‹•æ©Ÿå™¨äººå®Œæˆä½œæ¥ä»»å‹™ã€‚
(5ï¼‰æ–‡ä»¶ç®¡ç†æ©Ÿå™¨äººæŽ§åˆ¶å™¨ä¸æœ‰å„ç¨®å„æ¨£æ–‡ä»¶ï¼Œæ‰€ä»¥æŽ§åˆ¶å™¨è»Ÿä»¶è¨è¨ˆäº†ä¸€å€‹æ¨¡å¡Šä½œç‚ºæ–‡ä»¶ç®¡ç†ï¼ŒåŒ…括文件的改åã€åˆªé™¤ã€å¾©åˆ¶ç‰ã€‚æ–‡ä»¶ç®¡ç†æ¨¡å¡Šçš„作用類似于æ“作系統ä¸çš„æ–‡ä»¶ç®¡ç†åŠŸèƒ½
(6)軌跡è¦åŠƒè©²æ¨¡å¡ŠåŒ…æ‹¬æ©Ÿå™¨äººé‹å‹•叿£é€†é‹ç®—和軌跡æ’補。
(7ï¼‰ä¼ºæœæŽ§åˆ¶è©²æ¨¡å¡Šæ˜¯PMD控制æ¿çš„é›»æ©Ÿä¼ºæœæŽ§åˆ¶è»Ÿä»¶åŒ…ï¼Œè©²æŽ§åˆ¶åŒ…æä¾›äº†å°é‹å‹•電機控制的基本指令。
控制器軟件采用DOS作為æ“作系統,用C語言進行編程
5 é‹å‹•控制仿真
應用本控制器å°ä¾¿æ”œå¼æ©Ÿå™¨äººé€²è¡Œé‹å‹•控制實驗,å°åšåœ“å¼§é‹å‹•的數據進行記錄如下表
以第二組點(1,1.4,26),(1 1,2,4),(1,2,5,3ï¼‰ä½œåœ–ï¼Œæœ‰ä¸‹åœ–ï¼šå¯¦é©—è¡¨æ˜Žï¼Œæœ¬æŽ§åˆ¶å™¨èƒ½å¤ å®Œæˆå°ä¾¿æ”œå¼æ©Ÿå™¨äººæœ‰æ•ˆã€éˆæ´»çš„æŽ§åˆ¶ã€‚
6 çµè«–
開發“具有開放å¼çµæ§‹çš„æ¨¡å¡ŠåŒ–ã€æ¨™æº–åŒ–æ©Ÿå™¨äººæŽ§åˆ¶å™¨â€æ˜¯ç•¶å‰æ©Ÿå™¨äººæŽ§åˆ¶å™¨çš„一個發展方å‘。本課題的è¨è¨ˆå’Œç ”ç©¶ä¸ï¼Œæ—¢è€ƒæ…®åˆ°äº†ä¾¿æ”œå¼å¼§ç„Šæ©Ÿå™¨äººç¨æœ‰çš„特點,åˆè€ƒæ…®åˆ°äº†ç•¶å‰æ©Ÿå™¨äººæŽ§åˆ¶å™¨çš„發展方å‘。控制器在通用的硬件和軟件平臺上開發,é¸ç”¨åŠŸèƒ½å¼·å¤§çš„C語言作為編程工具,使得控制器具有一定的通用性,縮çŸäº†é–‹ç™¼çš„周期。

åƒè€ƒæ–‡ç»
1 黃通ç‰ï¼Œæ©Ÿå™¨äººé€šç”¨æŽ§åˆ¶ç³»çµ±çš„è¨è¨ˆèˆ‡å¯¦ç¾ï¼Œä¸åœ‹ç¬¬äº”å±†æ©Ÿå™¨äººå¸æœƒæœƒè°è«–文集,1997
2 èŒƒæ°¸ï¼Žèšæ°‘.機器人控制器的ç¾ç‹€åŠå±•望機器,L.1992 1
3 胡衛é¾ï¼Œå…自由度機器人軌跡è¦åŠƒçš„ç†è«–ç ”ç©¶åŠè»Ÿä»¶é–‹ç™¼ï¼Œå“ˆçˆ¾æ¿±å·¥æ¥å¤§å¸ç¢©å£«è«–文,1 999
4 Unimation.Unimate PUMA Mark _ 一VAL ll Robot 500Series(Models 552ï¼562)Equipment Manual 398 AH1 AWestinghouse Company.January 1987
5 E Freund.J Ré‚™mann Sysllems Approach to Robotics and Automation IEEE Intemational Confefence on Robo tics and Automation 0—7803—1965—6ï¼950 1995 3
6 John Wiley Robot Analysis and Contro1.1986
7 Moxa Teohnologies Co Ltd Moxa C1 02 Universal RS 一422ï¼485 2 Port Serial Boards User。S Manual 4th edition 1998 2
8 W indows—based PC Robot Controller YASKAWA NewsRelease 1997 10
9 Willian E Ford What is an Open Architecture Robot Controller?lEEE International Symposium on Intelligent Co nlr0l 1994