Nghiên cứu thiết kế, chế tạo các robot thông minh phục vụ cho các ứng dụng quan trọng - Nhóm sản phẩm ROBOT RP

Mục lục Mở đầu 4 Phần 1. Robocar RP 10 I. Giới thiệu chung 10 II. Cơ cấu chấp hành linh hoạt 13 2.1. Phân tích và chọn lựa cơ cấu tay máy phỏng sinh 13 2.2. Xây dựng các hệ hình động học và động lực 18 III. Hồ sơ thiết kế cải tiến Robot RP 27 3.1. Thiết kế tổng thể 27 3.2. Cụm chi tiết chủ yếu 31 IV. Động học xe Robocar 39 4.1. Động học xe 3 bánh 39 4.2. Động học xe 4 bánh 43 V. Môđun xe di chuyển 46 5.1. Những vấn đề chung 46 5.2. Môđun xe di chuyển cho RP-01 47 5.3. Môđun xe di chuyển cho RP-02 51 VI. Hệ thống thiết bị điều khiển 56 6.1. Giới thiệu chung 56 6.2. Hệ điều khiển Robot RP 56 6.3. Điều khiển Robocar RP-01 bằng PLC 68 6.4. Hệ điều khiển Robocar RP-02 72 Phần 2. các sản phẩm Robocar ứng dụng 80 I. Giới thiệu chung 80 II. Robocar TN trong phòng thí nghiệm 81 2.1. Giới thiệu chung 81 2.2. Thiết kế, chế tạo TN 81 2.3.Các sensors đ-ợc sử dụng 90 2.4. Những nhận xét qua thử nghiệm 95 III. Robocar “Chữ thập đỏ” 97 3.1. Giới thiệu chung 97 3.2. Kết cấu các bộ phận chấp hành 97 3.2.1. Kết cấu xe di chuyển 97 3.2.2. Cơ cấu robot 100 3.2.3. Hệ thống bơm phun 102 3.3. Xây dựng mô hình động học Robocar – Camera 103 3.3.1. Chọn các hệ tọa độ 103 3.3.2. Mô tả đối t-ợng quan sát trong hệ tọa độ 104 3.3.3. Xác định vị trí điểm quan sát trên màn hình camera 106 3.3.4. Khống chế vùng hiển thị trên màn hình 107 3.4. Vấn đề xử lý hình ảnh và các ph-ơng pháp dẫn đ-ờng cho robot 108 3.4.1. Vấn đề xử lý ảnh 108 3.4.2. Các ph-ơng pháp dẫn đ-ờng cho robot 111 3.5. Thiết lập hệ thống điều khiển tìm kiếm đối t-ợng theo màu sắc 112 3.5.1. Mô tả hoạt động của hệ thống 113 3.5.2. Ch-ơng trình dẫn đ-ờng tự động 114 3.5.3. Các b-ớc của ch-ơng trình xử lý ảnh 115 3.6. Các ứng dụng thử nghiệm b-ớc đầu 116 IV. Xe lăn và xe ghế tự động 126 V. Kết luận 133 Tài liệu tham khảo 135

pdf258 trang | Chia sẻ: banmai | Lượt xem: 1771 | Lượt tải: 2download
Bạn đang xem trước 20 trang tài liệu Nghiên cứu thiết kế, chế tạo các robot thông minh phục vụ cho các ứng dụng quan trọng - Nhóm sản phẩm ROBOT RP, để xem tài liệu hoàn chỉnh bạn click vào nút DOWNLOAD ở trên
Öu chung Sau khi hoµn thµnh phiªn b¶n 01 Robocar RP, tõ ®©y sÏ gäi t¾t lµ Robocar RP-01, §Ò tµi ®· triÓn khai giai ®o¹n kh¶o nghiÖm. Qua ®ã ®· ®i ®Õn nh÷ng nhËn ®Þnh sau: - Trong thùc tÕ ë c¸c ph©n x−ëng c«ng nghiÖp th«ng th−êng mµ §Ò tµi cã thÓ tiÕp cËn ®−îc hÇu nh− kh«ng cã nhu cÇu dïng robot “th«ng minh hãa”. V× vËy, cÇn thay ®æi ®Þnh h−íng “phôc vô c«ng nghiÖp” mµ §Ò tµi tù ®Æt ra khi triÓn khai c«ng viÖc thiÕt kÕ Robocar RP-01. Ph¹m vi mµ §Ò tµi nh»m øng dông lµ phôc vô c«ng t¸c phßng dÞch bÖnh vµ phôc vô ng−êi giµ yÕu tµng tËt. Sù chuyÓn h−íng ®ã cã thÓ lµ do nhËn thøc ®−îc c¸c nhu cÇu thùc tÕ trong t−¬ng lai gÇn, nh−ng còng cã thÓ do t¸c ®éng cña xu thÕ cña thÕ giíi chuyÓn tõ “robot c«ng nghiÖp” sang ®Çu t− cho “robot dÞch vô”. Sù chuyÓn h−íng ®ã tá ra lµ ®óng ®¾n bëi v× sau khi “tiÕp thÞ” nh÷ng s¶n phÈm míi §Ò tµi ®· nhËn ®−îc mét vµi n¬i “®Æt hµng”. - ViÖc triÓn khai ý t−ëng “th«ng minh hãa” cho robot kh«ng thÓ chung chung ®−îc mµ ph¶i nh»m thùc hiÖn mét lo¹i viÖc cô thÓ nµo ®ã. V× vËy theo con ®−êng tiÕp tôc ph−¬ng ph¸p ghÐp nèi nh÷ng kÕt qu¶ ®· ®−îc nghiªn cøu m«®un hãa trong phßng thÝ nghiÖm thµnh nh÷ng s¶n phÈm theo nhu cÇu øng dông, §Ò tµi ®· thiÕt kÕ chÕ t¹o ra mét robocar cì nhá, gäi tªn lµ Robocar FI, ®Ó cã thÓ ch¹y trong phßng thÝ nghiÖm qu¸ chËp hÑp víi môc ®Ých thö nghiÖm víi c¸c m«®un ®iÒu khiÓn dïng c¸c lo¹i sensor kh¸c nhau. 80 Theo sù chuyÓn h−íng míi vÒ ph¹m vi øng dông vµ c¸ch tiÕp cËn vÊn ®Ò “th«ng minh hãa” nh− ®· tr×nh bµy ë trªn §Ò tµi ®· hßan thµnh mét sè kÕt qu¶ nh− Robocar “Ch÷ thËp ®á”, xe l¨n ®iÖn ch¹y tù ®éng, xe ghÕ ®iÖn tù ®éng vµ mét vµi lo¹i thiÕt bÞ nh− Robocar PHC, Robocar BB ®ang triÓn khai ®Ó dïng 2 bÖnh viÖn ë Hµ Néi. II. Robocar TN trong phßng thÝ nghiÖm 2.1. Giíi thiÖu chung §Ó cã ®iÒu kiÖn tiÕp tôc c¸c néi dung nghiªn cøu vËn hµnh khi ®−îc trang bÞ nh÷ng lo¹i sensor ®Ó thao t¸c nh÷ng c«ng viÖc kh¸c nhau, §Ò tµi ®· thiÕt kÕ, chÕ t¹o ra mét Robocar kÝch cì nhá ®Ó thö nghiÖm trong phßng, gäi tªn lµ Robocar TN. Robocar TN gåm mét m«®un xe di chuyÓn cì nhá, trªn ®ã cã thÓ g¸ l¾p nhiÒu lo¹i sensor kh¸c nhau tïy theo c«ng viÖc thö nghiÖm. PhÇn robot ®Æt trªn xe lµ Robot SCA cã 4 bËc tù do thùc hiÖn ®−îc c¸c thao t¸c c«ng g¾p. B¶n th©n Robocar TN ®ång thêi còng lµ mét s¶n phÈm ®éc lËp. Nã ®−îc thiÕt kÕ lµm bé phËn chñ yÕu cho nh÷ng thiÕt bÞ phôc vô ng−êi tµn tËt, giµ yÕu, nªn tho¹t ®Çu cßn ®Æt tªn lµ Robocar FI (Robocar For Invalid). Tuy kh«ng thµnh s¶n phÈm ®éc lËp nh− tªn gäi, nh−ng ®· ®−îc dïng rÊt hiÖu qu¶ ®Ó thö nghiÖm c¸c m«®un ghÐp nèi víi sensor c¸c lo¹i, dïng cho c¸c s¶n phÈm xe l¨n ®iÖn, xe ghÕ ch¹y tù ®éng sau nµy. 2.2. ThiÕt kÕ chÕ t¹o Robocar TN - C¸c h×nh 1.2.1. tõ trang 82 ®Õn trang 85 lµ mét sè b¶n vÏ chñ yÕu (®· ghi chó tªn gäi trªn b¶n vÏ) thiÕt kÕ cho bé phËn di ®éng cña Robocar FI. - H×nh 1.2.4 trªn tõ trang 86 lµ ¶nh chôp c¸c bé phËn cÊu thµnh Robocar TN 81 - H×nh 1.2.5 trang 87 lµ ¶nh chôp bé phËn c¶m biÕn tÝn hiÖu dÉn ®−êng dïng c¸c sensor nhËn biÕt mÇu. - H×nh 1.2.6 trang 88 lµ ¶nh chôp sensor hång ngo¹i dïng cho Robocar TN - H×nh 1.2.7 trang 89 lµ ¶nh chôp sensor siªu ©m dïng cho Robocar FI. 85 Bé phËn cÊu thµnh Robocar TN H×nh 1.2.4. Robot TN trong phßng thÝ nghiÖm 86 H×nh 1.2.5. Bé phËn c¶m biÕn tÝn hiÖu dÉn ®−êng dïng c¸c sensor nhËn biÕt mµu 87 Sensor hång ngo¹i dïng cho Robocar TN H×nh 1.2.6 .C¸c sensor hång ngo¹i dïng cho Robocar TN 88 H×nh 1.2.7. Sensor siªu ©m dïng cho Robocar TN 89 2.3. C¸c sensor ®−îc sö dông 2.3.1. M«®un c¶m biÕn siªu ©m ph¸t hiÖn ch−íng ng¹i vËt Khái niệm về cảm biến: Các thiết bị cảm biến (sensors) trang bị cho robot để thực hiện việc nhận biết và biến đổi thông tin về hoạt động của bản thân robot và loại cảm biến dùng trong kỹ thuật robot, có thể phân ra 2 loại: - Cảm biến nội tín hiệu (internal sensors) đảm bảo thông tin về vị trí, về vận tốc, về lực tác động trong các bộ phận quan trọng của robot. Các thông tin này là những tín hiệu phản hồi phục vụ cho việc điều chỉnh tự động các hoạt động của robot. - Cảm biến ngoại tín hiệu (external sensors) cung cấp thông tin về đối tác và môi trường làm việc, phục vụ cho việc nhận dạng các vật xung quanh, thực hiện di chuyển hoặc thao tác trong không gian làm việc. Để làm được việc đó, cần có các loại cảm biến tín hiệu xa, cảm biến tín hiệu gần, cảm biến “xúc giác” và cảm biến “thị giác” v.v. Để thực hiện nhiệm vụ của các loại cảm biến nội tín hiệu và ngoại tín hiệu nói trên có thể dùng nhiều kiểu cảm biến thông dụng hoặc chuyên dụng. Các cảm biến thông dụng không chỉ dùng cho kỹ thuật robot mà còn dùng nhiều trong các thiết bị kỹ thuật khác. Có nhiều tài liệu kỹ thuật về các kiểu cảm biến này. Tuỳ theo các dạng tín hiệu cần nhận biết mà phân thành các kiểu cảm biến khác nhau: cảm biến lực, vận tốc, gia tốc, vị trí, áp suất, lưu lượng, nhiệt độ v.v. Tuỳ theo cách thức nhận tín hiệu lại phân ra các kiểu khác nhau. Ví dụ, cũng là cảm biến vị trí nhưng có kiểu cảm ứng, kiểu điện dụng, kiểu điện trở, kiểu điện quang v.v. 90 Nguyên lý cơ bản của cảm biến siêu âm: Cảm biến siêu âm phát hiện mục tiêu bằng chùm sóng âm mà nó phát ra (hình 1.2.8) Cảm biến phát ra một chùm sóng âm ngắn cường độ cao từ một bộ phận chuyển đối áp điện. Chùm sóng này khi gặp vật sẽ bị dội ngược lại. Cảm biến xác định được khoảng cách bằng phép đo thời gian từ lúc phát đi chùm sóng tới lúc nhận được tín hiệu trở lại. Phương pháp cảm nhận này có độ tin cậy cao mà không phụ thuộc vào màu sắc, chất liệu của vật đối tượng. Hình 1.2.8 Trên hình 1.2.9. mô tả cấu tạo một loại cảm biến siêu âm dùng trong kỹ thuật robot để nhận biết tín hiệu gần. Phần chủ yếu là bộ biến âm dùng chất gốm điện (1) được bảo vệ bằng chất nhựa tổng hợp (2). Tiếp theo là phần giảm âm (3), cáp điện (4), vỏ kim loại (5) và vỏ bọc (6) Hình 1.2.9. Để tìm hiểu hoạt động của cảm biến siêu âm, cần phân tích các tín hiệu khi nhận cũng như khi truyền âm lượng. Dạng điển hình của các tín hiệu này cho trên hình 1.2.10 A là tín hiệu mang, B là các tín hiệu phát ra (1) và tín 91 hiệu phản lại (2). Các xung C tách biệt tín hiệu truyền và tín hiệu nhận. Để phân biệt sự khác nhau giữa các xung, tương ứng với tín hiệu mang và tín hiệu phản lại, tạo ra tín hiệu D. ∆t là khoảng thời gian đo nhỏ nhất, còn t1 + t2 là khoảng đo lớn nhất. Các khoảng thời gian này tương ứng với khoảng truyền sóng trong môi trường khi nhận được tín hiệu phản lại (lúc đó tín hiệu D có giá trị lớn nhất) sẽ hình thành tín hiệu E và sẽ có giá trị bằng không khí kết thúc xung tín hiệu A. Cuối cùng tín hiệu F sẽ hình thành khi xuất hiện xung tín hiệu E và sẽ là tín hiệu ra của cảm biến siêu âm hoạt động theo chế độ nhị phân. Hình 1.2.10 3.2. Mô tả các loại cảm biến siêu âm Caûm bieán sieâu aâm laø giaûi phaùp lyù töôûng ñeå ño vò trí vaø khoaûng caùch khoâng tieáp xuùc trong taát caû caùc laõnh vöïc coâng nghieäp, ñaëc bieät trong moâi tröôøng nhieàu buïi, khoùi hoaëc hôi nöôùc coù khaû naêng aûnh höôûng xaáu ñeán caûm bieán. Coù theå doø caùc chaát raén, chaát loûng trong phaïm vi xa vôùi ñoä chính xaùc cao. Caûm bieán phaùt tín hieäu töông töï hoaëc tín hieäu soá taïi coång ra. 92 Hình 1.2.11 Ñaëc tröng : - Hieäu chænh nhieät ñoä ngang baèng söï dao ñoäng vaän toác aâm thanh do söï thay ñoåi nhieät ñoä khoâng khí - Ñoàng boä hoùa tín hieäu vaøo nhaèm traùnh nhieãu xuyeân aâm khi nhieàu boä caûm bieán ñöôïc laép ñaët gaàn nhau. - Caûm bieán vôùi tín hieäu ra töông töï vaø/hoaëc soá - Phaïm vi phaùt hieän roäng - Phaïm vi phaùt hieän coù theå ñieàu chænh ñöôïc - Coù khaû naêng buø nhieät ñoä - Coång ra linh ñoäng - Coù nhieàu hình daïng khaùc nhau - Giaûm ñoä oàn cao - Coù theå giao tieáp vôùi maùy tính - Hoaït ñoäng ñoàng thôøi vôùi thieát bò giao tieáp Hình 1.2.12 Phaïm vi hoaït ñoäng coù theå ñieàu chænh = Caøi ñaët chuyeån maïch DIP 93 Hình 1.2.13 Phaïm vi hoaït ñoäng coù theå ñieàu chænh ñöôïc Gaén ñaàu noái chöông trình - Giôùi haïn gaàn - Giôùi haïn xa - Chöùc naêng taùc ñoäng coång ra Coù theå thay ñoåi chöông trình baèng phaàn meàm Hình 1.2.14 Caùc loaïi coång ra raát linh ñoäng • - Coång ra coâng taéc • - Coång ra töông töï • - Coång ra 8 Bits BCD • - Giao tieáp RS 232 Nhieàu daïng khaùc nhau Loaïi cô baûn (UB) - 2 taùc ñoäng coång ra - 2 coång ra ñoäc laäp - 5 chöùc naêng coång ra khaùc nhau Hình 1.2.15 - Phaïm vi hoaït ñoäng coù theå ñieàu chænh qua chöông trình 94 2.4. Nh÷ng nhËn xÐt qua thö nghiÖm Sau khi hoµn thµnh viÖc chÕ t¹o, l¾p r¸p Robocar TN ®É tiÕn hµnh nhiÒu thö nghiÖm víi mét vµi lo¹i sensor kh¸c nhau. Víi ®Þnh h−íng ban ®Çu cho Robocar phôc vô lµ ng−êi tµn tËt, giµ yÕu, nªn ®· chän ®Þa h×nh thao t¸c lµ c¸c c¨n phßng kh«ng cã lèi ®Ý dµnh riªng cho Robocar. C¸c ph−¬ng ph¸p di chuyÓn cã ®−êng dÉn chØ ®Þnh tr−íc còng ®−îc thö nghiÖm, nh−ng thÊy sÏ kh«ng phï hîp cho kh¶ n¨ng øng dông thùc tÕ. V× vËy §Ò tµi tËp trung ®i s©u nghiªn cøu c¸c néi dung: - C¸c ph−¬ng ¸n kh¶ thi ®Ó ®iÒu khiÓn tù ®éng Robocar khi kh«ng cã ®−êng dÉn chØ ®Þnh tr−íc. Trong ®ã dÆc biÖt chó ý ®Õn sensor siªu ©m, sensor hång ngo¹i vµ hÖ thèng camera gi¸ thµnh thÊp. - Sù t−¬ng thÝch gi÷a ®é nh¹y cña c¸c sensor víi møc ®é ®¸p øng cña c¬ cÊu chÊp hµnh cña Robocar. - TiÕp cËn ®Õn lÜnh vùc thÞ gi¸c m¸y (Computer Vision) t−¬ng ®èi míi mÎ. Sau nhiÒu lÇn thö nghiÖm víi c¸c néi dung nãi trªn ®· hiÖn thùc ®−îc c¸c gi¶i ph¸p tin cËy vµ víi møc ®Çu t− t−¬ng ®èi thÊp, nªn cã triÓn väng tèt trong øng dông. Cô thÓ lµ: 1) Dïng hÖ thèng 2 sensor hång ngo¹i l¾p bªn h«ng Robocar cã thÓ ®¶m b¶o mét hµnh lang di chuyÓn cho nã ®i men theo t−êng ch¾n vµ lu«n lu«n gi÷ kho¶ng c¸ch víi t−êng ch¾n. Nh− vËy Robocar cã thÓ di chuyÓn trong c¨n phßng mµ kh«ng cÇn chØ ®Þnh tr−íc ®−êng dÉn. 2) Sensor siªu ©m cïng bé phËn nèi ghÐp víi bé xö lý cã thÓ x©y dùng nh− mét m«®un t−¬ng ®èi ®éc lËp ®Ó ghÐp nèi víi hÖ thèng ®iÒu khiÓn Robocar ®Ó tù xö lý khi gÆp ch−íng ng¹i hoÆc ®¬n thuÇn chØ lµ ®Ó c¶nh b¸o, tïy theo møc ®é cÇn thiÕt vµ møc ®é ®Çu t−. 95 3) Dïng camera vµ xö lý ¶nh cho robot lµ mét lÜnh vùc ®a d¹ng øng dông ph−¬ng ph¸p nµo lµ phô thuéc vµo nhiÖm vô ®Æt ra. ë ®©y nhiÖm vô lµ ph¸t hiÖn c¸c ®å vËt theo mµu s¾c. Trong nhiÖm vô 2 cña §Ò tµi khi nghiªn cøu gi¶i ph¸p dïng robot ph©n lo¹i s¶n phÈm theo mµu s¾c, dïng ph−¬ng ph¸p “d¹y häc” cho robot nhËn biÕt mµu. Cßn ë ®©y ®Ó cho Robocar tù ph¸t hiÖn vµ ®i tíi chç ®Æt ®å vËt cã mµu s¾c nhÊt ®Þnh, ®· dïng ph−¬ng ph¸p cña “thÞ gi¸c m¸y” (Computer Vision), tøc lµ nh×n vµ xö lý qua mµn h×nh m¸y tÝnh. C¸c hÖ thèng thiÕt bÞ cïng víi c¸c sensor nãi trªn ®· ®−îc thö nghiÖm trªn Robocar TN vµ ®· ®−îc c¶i tiÕn hßan chØnh thµnh c¸c m«®un l¾p trªn c¸c s¶n phÈm øng dông nh− Robocar “Ch÷ thËp ®á” hoÆc trªn xe l¨n ®iÖn vµ xe ghÕ ch¹y ®iÖn tù ®éng, khi tr×nh bµy c¸c s¶n phÈm øng dông nµy sÏ m« t¶ chi tiÕt c¸c m«®un nãi trªn. 96 III. Robocar “Ch÷ thËp ®á” 3.1. Giíi thiÖu chung VËn dông c¸c kÕt qu¶ nghiªn cøu vÒ Robocar RP vµ theo ®Þnh h−íng míi chuyÓn tõ phôc vô c«ng nghiÖp sang phôc vô c¸c dÞch vô, trong ®ã cã phôc vô søc kháe con ng−êi, §Ò tµi ®· thµnh c«ng trong viÖc t¹o ra mét robocar phôc vô phßng dÞch bÖnh vµ ®Æt tªn lµ Robocar “Ch÷ thËp ®á”. Vµo thêi gian ®ã còng míi xuÊt hiÖn dÞch SARS vµ ®−îc biÕt th«ng tin tõ VTV1 r»ng ë Trung Quèc ®ang triÓn khai nghiªn cøu chÕ thö Robocar ®Ó phßng chèng dÞch. 3.2. KÕt cÊu c¸c bé phËn chÊp hµnh 3.2.1. KÕt cÊu xe di chuyÓn VËn dông c¸c kÕt qu¶ nghiªn cøu vÒ m«®un xe di chuyÓn cña Robocar RP ®· ®−îc tr×nh bµy chi tiÕt ë phÇn I, trong môc nµy chØ tr×nh bµy c¸c hå s¬ kü thuËt vµ c¸c b¶n vÏ thiÕt kÕ cho tr−êng hîp cô thÓ cña Robocar “Ch÷ thËp ®á”. VÒ c¬ b¶n ®Òu gièng nh− c¸c b¶n vÏ dïng cho m«®un xe di chuyÓn cña Robocar RP, chØ thay ®æi mét sè chç ®Ó phï hîp víi c¸c thiÕt bÞ l¾p trªn nã nh− hÖ thèng b¬m phun vµ c¬ cÊu robot mang ®Çu phun. H×nh 1.2.16. lµ b¶n vÏ l¾p m«®un xe di chuyÓn cña Robocar “Ch÷ thËp ®á” H×nh 1.2.17. B¶n vÏ l¾p tæng thÓ cña Robocar “Ch÷ thËp ®á” 97 H×nh 1.2.16. B¶n vÏ l¾p m«®un xe di chuyÓn cña Robocar 175 90 0 640 M od ul x e D uy Öt N gµ y G S. N gu yÔ n T hi Ön P hó c H −í ng d Én T hi Õt k Õ C hø c n¨ ng H ä vµ tª n C h÷ k ý § H B K - H N T ru ng t© m n gh iª n cø u T § H T Ø l Ö 1: 1 1 2 3 4 5 V Ët li Öu K ý hi Öu 3 25 4 1 V Þ tr Ý 2 22 2 B ¸n h r¨ ng lí n § én g c¬ B ¸n h xe B ¸n h r¨ ng n há SL T ªn g äi T rô c 1 G hi ch ó T hi Õt k Õ ch Õ t¹ o " R ob oc ar C h÷ th Ëp ® á " H oµ ng A nh § ¹i G S. N gu yÔ n T hi Ön P hó c C hñ n hi Öm N gu y? n V an M in h 98 H×nh 1.2.17. B¶n vÏ l¾p tæng thÓ cña Robocar “Ch÷ thËp ®á” N gu y? n Th i? n Ph úc T ªn g äi C ôm ta y b¬ m H ép ® iÒ u kh iÓ n 1370 90 0 12 40 640 4 3 3 H uí ng d Én C hñ n hi Öm D uy ?t N gu y? n V an M in h G S. N gu yÔ n T hi Ön P hó c Th i? t k ? Tr . n hi ?m 2 1 V Þ t rÝ H oµ ng A nh § ¹i H ? và tê n ¾p q ui 4 B ×n h ph un 882 1 2 51 0 1 S? lu ?n g: 1 Đ ? tà i K C - 03 - 08 Tr un g tâ m N C K T T? d ?n g hó a Tr u? ng Đ ?i h ?c B ác h K ho a H à N ?i B ¶ n v Ï l¾ p R O B O C A R " c h ÷ t h Ëp ® á " V Ët li Öu N gà y K ý 2 1 S è l− în g B ?n v ? s? : § ¬n v Þ K hè i l −î ng T æn g sè T? l? : 1: 1 G hi c hó 1 99 3.2.2. C¬ cÊu robot C¬ cÊu robot trªn Robocar “Ch÷ thËp ®á” lµ mét d¹ng ®¬n gi¶n cña Robot RP, chØ cßn l¹i 3 bËc tù do chñ yÕu: quay th©n quanh trôc th¼ng ®øng, thay ®æi tÇm v−¬n xa vµ v−¬n cao cña c¸nh tay. NhiÖm vô cña robot nµy lµ mang ®Çu phun (phun hãa chÊt phßng dÞch) quÐt trong kh«ng gian thao t¸c vµ kh«ng ®ßi hái ®é chÝnh x¸c qu¸ cao. Tuy nhiªn robot l¹i cÇn thao t¸c linh ho¹t, gän nhÑ vµ c¸c bé truyÒn ®Òu ®Æt kÝn ë phÝa d−íi. Nh− vËy c¬ cÊu pantograph víi 2 con tr−ît chñ ®éng lµ hßan toµn thÝch hîp lµm c¬ cÊu robot nµy vµ lý thuyÕt tÝnh to¸n vÒ c¬ cÊu nµy ®· tr×nh bµy khi nghiªn cøu vÒ robot RP. VËn dông c¸c kÕt qu¶ nghiªn cøu ®ã cho tr−êng hîp Robocar “Ch÷ thËp ®á” víi tinh th©n ®¬n gi¶n hãa ®i nhiÒu ®Ó h¹ gi¸ thµnh nh»m cho nhiÒu n¬i cã thÓ ®Çu t− øng dông ®−îc. H×nh 1.2.18 lµ b¶n vÏ kÕt cÊu m«®un robot cña Robocar “Ch÷ thËp ®á” 100 H×nh 1.2.18. B¶n vÏ kÕt cÊu m«®un robot 1 2 3 4 D uy Öt 1 7 K hí p qu ay 2 H −í ng d Én T hi Õt k Õ C hø c n¨ ng V Þ tr Ý16 45 23 1 T Êm g ¸ 1 K ý hi Öu C h÷ k ý N gµ y H ä vµ tª n T ªn g äi SL æ bi T hÐ p hé p ta y N èi tr ôc V Ýt m e K hí p qu ay 1 4 22 21 10 89 T ha nh tr uî t T rô c tr ¬n T Êm g ¸ 2 1 12 G hi ch ó V Ët li Öu 5 6 9 10 8 7 T Ø l Ö 1: 1 M od ul C ¸n h ta y § H B K - H N T ru ng t© m n gh iª n cø u T § H G S. N gu yÔ n Th iÖ n Ph óc 44 5 390 12 0 T hi Õt k Õ ch Õ t¹ o " R ob oc ar C h÷ th Ëp ® á " H oµ ng A nh § ¹i C hñ n hi Öm G S. N gu yÔ n T hi Ön P hó c N gu y? n V an M in h 101 3.2.3. HÖ thèng b¬m phun Hệ thống bơm hóa chất của Robocar phun hóa chất phòng dịch ta có thể lựa chọn các phương án. + Phương án 1: Dùng một bơm điện để bơm trực tiếp hóa chất từ thùng chứa ra vòi phun. Đặc điểm của phương án này là phương pháp bơm đơn giản. Áp suất vòi phun phụ thuộc vào công suất của động cơ. Nó có nhược điểm là dung dịch hóa chất sẽ đi qua bơm. Ảnh hưởng tới công suất làm việc của động cơ. + Phương án 2: Sử dụng bình phun có bộ phận tích áp và một Pitong nén khí. Bộ phận tích áp có tác dụng giúp cho áp suất vòi phun luôn ở mức cố định. Ta dùng cơ cấu trục khuỷu để truyền chuyển động giữa động cơ và Pitông + Phương án 3: Sử dụng bơm khí nén để phun hóa chất. Nếu sử dụng phương án này sẽ có ưu điểm, đơn giản về kết cấu, hóa chất sẽ không đi qua bơm. Tuy nhiên trên thị trường loại bơm khí nén dùng nguồn điện một chiều 24V có rất ít. Với nhưng phương án đã trình bày thì chúng ta sử dụng phương án 2 để thiết kế hệ thống bơm cho Robot. * Kết cấu cơ khí của hệ thống bơm hóa chất - Thông số động cơ : dùng động cơ điện một chiều DK có P= 0,15kW; sbn = 80 v/ph ; khối lượng động cơ M = 1,7 kg - Bình chứa hóa chất dung tích V = 1,8 m3 - Cơ cấu trục khuỷu : + Cần lắc có độ dài l1 = 40 mm. + Thanh truyền có độ dài l2 = 100 mm. + Cần lắc có độ dài l3 = 250 mm 102 Hình 1.2.19 : Kết cấu cơ khí của hệ thống bơm hóa chất 3.3. X©y dùng m« h×nh ®éng häc cña hÖ thèng Robocar – Camera 3.3.1. Chän c¸c hÖ täa ®é Trªn h×nh 1.2.20 m« t¶ vÞ trÝ cña camera vµ robocar trong hÖ to¹ ®é cè ®Þnh X, Y, Z. §©y lµ tr−êng hîp camera l¾p trªn robocar vµ di ®éng cïng víi robocar. Chän hÖ to¹ ®é Xk, Yk, Zk g¾n liÒn víi robocar t¹i ®iÓm K n»m trong mÆt ph¼ng trung t©m Zk, Yk cña robocar vµ t¹i vÝ trÝ h×nh chiÕu trªn trôc Yk cña ®iÓm P, ®iÓm ®Æt cña gi¸ quay camera. Gäi hÖ to¹ ®é g¾n liÒn víi gi¸ quay cña camera t¹i ®iÓm gèc P lµ Xp, Yp, Zp. V× gi¸ quay cña camera g¾n liÒn víi robocar nªn gi÷a Xp, Yp, Zp vµ Xk, Yk, Zk kh«ng cã chuyÓn ®éng t−¬ng ®èi víi nhau. Víi c¸ch chän ®iÓm K nh− trªn th× xem nh− dêi gèc to¹ ®é cña hÖ Xk, Yk, Zk ®i mét ®o¹n KP däc theo trôc Zk ta sÏ cã hÖ Xp, Yp, Zp. §Æt hÖ to¹ ®é g¾n liÒn víi camera lµ Xc, Yc, Zc. Trôc Zc trïng víi trôc thÊu kÝnh cña camera. MÆt ph¼ng Xc, Yc lµ mÆt ph¼ng chiÕu. T©m C cña mÆt ph¼ng chiÕu chän trïng víi ®iÓm P cho ®¬n gi¶n viÖc m« t¶. NÕu kh¸c ®i th× chØ cÇn thùc hiÖn thªm phÐp tÞnh tiÕn mÆt ph¼ng chiÕu däc trôc Zc. VÝ trÞ ban ®Çu cña c¸c trôc Xc, Yc, Zc trïng víi Xp, Yp, Zp t−¬ng øng. PhÐp chuyÓn tõ Xp, 103 Yp, Zp sang Xc, Yc, Zc ®−îc thùc hiÖn theo 2 b−íc: 1) Quay gãc φ quanh trôc Zp, gãc φ gäi lµ “gãc h−íng”; 2) Quay tiÕp gãc θ quanh trôc Xc ë vÞ trÝ míi, gãc θ gäi lµ “gãc tÇm”. ChiÒu cña c¸c gãc quay φ vµ θ ®Òu theo quy t¾c “vÆn nót chai” th«ng dông. H×nh 1.2.20 3.3.2. M« t¶ ®èi t−îng quan s¸t trong c¸c hÖ to¹ ®é Gäi M lµ mét ®iÓm bÊt kú cña ®èi t−îng quan s¸t. Trong hÖ to¹ ®é cè ®Þnh ®iÓm M ®−îc x¸c ®Þnh b»ng b¸n kÝnh vÐct¬ r . TZYXr )1,,,(= (1) Cßn trong hÖ to¹ ®é g¾n liÒn víi camera Xc, Yc, Zc ®iÓm M nµy ®−îc x¸c ®Þnh b»ng b¸n kÝnh vect¬ cr . cr = Aco . r (2) víi Aco = Acp. Apk. Ako (3) O X Y Z Xk K Yk Z Xc XP Yp Zc PC ZP φ −θ rk 104 Trong ®ã: Ako = ⎥⎥ ⎥⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎣ ⎡ 1000 100 010 001 kz ky kx r r r (4) Apk = ⎥⎥ ⎥⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎣ ⎡ 1000 100 0010 0001 h , h = PK (5) Acp = ⎥⎥ ⎥⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎣ ⎡ − ⎥⎥ ⎥⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎣ ⎡ − 1000 0cossin0 0sincos0 0001 1000 0100 00cossin 00sincos θθ θθφφ φφ (6) Tõ biÓu thøc (2) ta cã: COCcCO rArAr . 1 == − (7) ⎥⎥ ⎥⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎣ ⎡ − −−= 1000 0coscossinsinsin 0sincoscossin.cos 00sincos θφθφθ θφθφθ φφ cpA (6*) TÝch ma trËn nghÞch ®¶o tõ biÓu thøc (3): 11111 )( −−−−− == CPPKKOKOPKCPCO AAAAAAA (8) ⎥⎥ ⎥⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎣ ⎡ +++−− +−+−− + = 1000 cos)(cos.sinsincoscossinsinsin sin)(coscossincossincoscossincos sincos0sincos θφθθθφθφθ θφθθθφθφθ φφφφ hrrr hrrr rr A KZKYKX KZKYKX KYKX CO (8*) ⎥⎥ ⎥⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎣ ⎡ +−− − −−− == 1000 )(cossin0 cossincoscossin sinsinsincoscos 1 hr r r AA KZ KY KX COOC θθ φθφθφ φθφθφ (8**) 105 3.3.3. X¸c ®Þnh vÞ trÝ ®iÓm quan s¸t trªn mµn h×nh camera Trªn h×nh 1.2.21 m« t¶ s¬ ®å phÐp chiÕu quang häc. HÖ to¹ ®é Xc, Yc, Zc g¾n liÒn víi camera. Trôc Zc trïng víi trôc chÝnh qua t©m thÊu kÝnh vµ mÆt ph¼ng XcYc lµ mÆt ph¼ng chiÕu. Nh− vËy gèc cña hÖ to¹ ®é nµy trïng víi t©m C cña mÆt ph¼ng chiÕu, cßn t©m thÊu kinh cã to¹ ®é lµ (0, 0, λ) víi λ lµ kho¶ng c¸ch tiªu cù. H×nh 1.2.21 H×nh chiÕu phèi c¶nh cña ®iÓm M trªn mÆt ph¼ng chiÕu Xc, Yc lµ ®iÓm m. Nh− ®· nªu trong [1] to¹ ®é cña ®iÓm m ®−îc x¸c ®Þnh b»ng ph−¬ng tr×nh sau: ⎥⎥ ⎥⎥ ⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎢ ⎣ ⎡ +− = ⎥⎥ ⎥⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎣ ⎡ ⎥⎥ ⎥⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎣ ⎡ − = 111/100 0100 0010 0001 ~ λλ C C C C C C C cm Z Z Y X Z Y X r (9) vÐct¬ më réng cmr~ biÓu thÞ ®iÓm m trong hÖ to¹ ®é ®ång nhÊt b»ng 4 thµnh phÇn, cßn trong hÖ to¹ ®é thùc 3 chiÒu th×: ⎥⎥ ⎥⎥ ⎥⎥ ⎥ ⎦ ⎤ ⎢⎢ ⎢⎢ ⎢⎢ ⎢ ⎣ ⎡ − − − = C C C C C C C Z Z Z Y Z X r λ λ λ λ λ λ (10) [1] NguyÔn ThiÖn Phóc, Robot C«ng nghiÖp, NXB KH&KT, Hµ Néi, 2004 C Z Y M X m c c c λ 106 Hai thµnh phÇn ®Çu cña vÐct¬ Cr lµ h×nh chiÕu m (Xcm, Ycm) cña ®iÓm M trªn (mÆt ph¼ng chiÕu) mµn h×nh camera. Thµnh phÇn thø 3 kh«ng tån t¹i trªn mÆt ph¼ng chiÕu. Nãi kh¸c ®i, m kh«ng chØ lµ h×nh chiÕu cña mét ®iÓm M mµ lµ cña tÊt c¶ c¸c ®iÓm n»m trªn ®−êng th¼ng sau: ⎪⎭ ⎪⎬ ⎫ −= −= )( )( c cm c c cm c Z Y Y Z X X λλ λλ (11) Râ rµng lµ nÕu chØ biÕt to¹ ®é h×nh chiÕu m (Xcm, Ycm) trªn mÆt ph¼ng chiÕu th× ch−a ®ñ ®Ó x¸c ®Þnh vÞ trÝ cña ®iÓm ®ã trong kh«ng gian 3 chiÒu, mµ cÇn bæ sung thªm th«ng tin kh¸c, vÝ dô to¹ ®é Zc. Tuy nhiªn khi cho biÕt ®iÓm M cña ®èi t−îng ®−îc quan s¸t, th× 2 to¹ ®é Xcm vµ Ycm lµ ®ñ ®Ó x¸c ®Þnh ®iÓm m h×nh chiÕu trªn mµn h×nh camera. c c cm Z XX −= λ λ (12) c c cm Z YY −= λ λ (13) Theo (2) ta cã: θφθφθ θφθφθ θφθφθ θφθφθ φφ φφφφ cos)(cossinsinsin coscossinsinsin sin)(coscossincos sincoscossincos sin)(cos)( sincossincos hrrr ZYXZ hrrr ZYXY rYrX rrYXX KZKYKX C KZKYKX C KYKX KYKXC +++− −++−= +−+− −−+−= +++= =+++= (13*) NÕu dïng kÕt hîp chóng víi ph−¬ng tr×nh (12) vµ (13) ta cã thÓ x¸c ®Þnh Xcm, Ycm theo c¸c to¹ ®é cña ®iÓm M trong hÖ to¹ ®é cè ®Þnh: Xcm = f1 (X, Y, Z) (14) Ycm = f2 (X, Y, Z) (15) 3.3.4. Khèng chÕ vïng hiÓn thÞ trªn mµn h×nh 107 Bµi to¸n ®−îc ®Æt ra nh− sau: cho biÕt ®èi t−îng cÇn quan s¸t chØ xuÊt hiÖn trong vïng kh«ng gian sau: Xmin ≤ X ≤ Xmax (16) Ymin ≤ Y ≤ Ymax (17) Zmin ≤ Z ≤ Zmax (18) §Ó ®¶m b¶o cho h×nh chiÕu trªn mµn h×nh camera cña ®èi t−îng quan s¸t lu«n lu«n n»m trong vïng mong muèn: Xcmin≤ Xc ≤ Xc max (19) Yc max ≤ Yc ≤ Yc max (20) CÇn ph¶i khèng chÕ ph¹m vi c¸c gãc quay cña camera: φ ≤ φmax (21) θ ≤ θmax (22) Trªn c¬ së c¸c ph−¬ng tr×nh (14), (15) vµ chó ý r»ng quan hÖ gi÷a X, Y, Z vµ Xc, Yc, Zc, nh− thÊy râ trong c¸c biÓu thøc (2) ÷ (7), phô thuéc vµo c¸c gãc φ vµ θ. Tõ c¸c biÓu thøc quan hÖ ®ã cã thÓ tÝnh to¸n ra gi¸ trÞ c¸c gãc φ vµ θ theo gi¸ trÞ tøc thêi X, Y, Z. 3.4. VÊn ®Ò xö lý ¶nh vµ c¸c ph−¬ng ph¸p dÉn ®−êng cho Robocar 3.4.1. VÊn ®Ò xö lý ¶nh Chúng ta cảm nhận được màu sắc của một vật thể là do mắt ta thu nhận ánh sáng sáng phản xạ từ vật thể đó. Ánh sáng là một dạng sóng điện từ và dải tần số của ánh sáng mắt người nhìn thấy được tương đối hẹp (bước sóng trong khoảng 400-700nm). Một đối tượng có độ phản xạ tương đối cân bằng ở mọi bước sóng trong dải nhìn được sẽ có màu trắng trong mắt người quan sát, còn những đối tượng chỉ phản xạ ánh sáng có bước sóng trong những giới hạn nhất định sẽ xuất hiện với các màu sắc khác. Ví dụ, với các vật màu xanh lục ánh 108 sáng phản xạ có bước sóng chủ yếu nằm trong khoảng 500-570nm, còn phần lớn năng lượng của các bước sóng nằm ngoài khoảng đó bị hấp thụ. Căn cứ vào cấu trúc của mắt người, mọi màu sắc được coi là tổ hợp của ba màu cơ bản: Đỏ (Red), Xanh lục (Green), và Xanh lam (Blue), có bước sóng tương ứng là 700nm, 546,1nm, và 435,8nm. Vì vậy, để mô tả màu sắc người ta thường sử dụng mô hình RGB hay còn gọi là mô hình màu cộng (Hình 1.2.22). Mô hình này sử dụng hệ tọa độ Đề-các ba chiều. Mỗi giá trị màu có ba thành phần, tương ứng với ba màu cơ bản. Mỗi thành phần có giá trị thực nằm trong khoảng [0,1]. Trong thực tế, để thuận tiện cho việc tính toán và lưu giữ trên máy tính, người ta thường sử dụng số nguyên để biểu diễn các giá trị màu. Ví dụ, nói một bức ảnh số là ảnh màu 24-bit có nghĩa là mỗi điểm màu trên bức ảnh được mã hóa bằng một giá trị nhị phân có độ dài 24 bits, trong đó mỗi thành phần (R, G, và B) của giá trị màu được biểu diễn bằng 8 bits, tương đương với một giá trị nguyên nằm trong khoảng [0,255]. Để phân biệt các màu sắc khác nhau người ta thường căn cứ vào ba thuộc tính: tông màu (Hue), độ bão hòa (Saturation), và cường độ sáng R G B Đỏ (1,0,0) Xanh lục (0,1,0) Xanh lam (0,0,1) Trắng (1,1,1) 1 1 1 0 Hình 1.2.22. Mô hình màu RGB. 109 (Intensity). Một màu sắc tương ứng với một dải tần số nhất định, trong đó tần số tập trung nhiều năng lượng nhất tương ứng với màu chủ đạo. Tông màu là thuộc tính đại diện cho màu chủ đạo của một màu sắc, còn độ bão hòa đại diện cho độ thuần nhất của màu sắc. Các thuộc tính này là cơ sở cho mô hình HSI. Ưu điểm của mô hình này là nó tách thuộc tính cường độ sáng (I) khỏi các thông tin về màu (H và S). Vì vậy, nếu như mô hình RGB là mô hình thông dụng nhất để biểu diễn màu sắc, thì trong các ứng dụng xử lý ảnh màu người ta lại thường sử dụng mô hình HSI. Việc chuyển đổi biểu diễn màu sắc từ RGB sang HSI được thực hiện bằng các công thức sau: ⎟⎟⎠ ⎞ ⎜⎜⎝ ⎛ −−+− −−= ))(()(2 2arccos 2 BGBRGR BGRH 0 1 I Trắng Đen 0 1 Đỏ Vàng Xanh lục Xanh lam Hình 1.2.23. Mô hình màu HSI. S H 0o 110 BGR BGRS ++−= },,min{31 3 BGRI ++= ở đó các giá trị R, G, và B nằm trong khoảng [0,1]. Giá trị của tông màu, H, đo bằng góc trong khoảng [0o,360o], tương ứng với màu biến đổi từ Đỏ (0o) tới Vàng (60o), Xanh lục (120o), Xanh lam (240o), rồi quay về Đỏ (360o), còn giá trị của S và I đều nằm trong khoảng [0,1]. 3.4.2. C¸c ph−¬ng ph¸p dÉn ®−êng cho Robocar Một đặc điểm của robot di động là chúng có khả năng di chuyển tự do trong môi trường làm việc. Hoạt động không theo một quỹ đạo định sẵn thường đòi hỏi robot phải có khả năng thu thập và xử lý một khối lượng lớn dữ liệu trong khoảng thời gian rất ngắn, cùng với nhiều vấn đề phức tạp vẫn còn chưa được giải quyết trọn vẹn. Vì vậy bài toán dẫn đường cho robot di động là vấn đề vô cùng phức tạp và là một trong những lĩnh vực trọng tâm trong các nghiên cứu về robot di động thông minh. Các phương pháp điều khiển robot di động rất đa dạng, từ các hệ thống điều khiển cần có người vận hành tới các hệ dẫn đường hoàn toàn tự động. Do độ phức tạp cao của việc điều khiển, phần lớn các robot di động hiện nay là robot được điều khiển từ xa bởi con người. Tuy nhiên, các robot thông minh có khả năng hoạt động độc lập với các hệ thống dẫn đường tự động mới là mục tiêu được hướng tới. Chúng ta có thể chia các phương pháp dẫn đường thành hai nhóm chính: • Các phương pháp dẫn đường theo tọa độ: với các phương pháp này chương trình dẫn đường thường phải có sẵn bản đồ địa hình vùng hoạt động của robot, và đường đi của robot sẽ được vạch ra trên bản đồ. Vị trí của robot tại mỗi thời điểm có thể xác định trực tiếp bằng các sensor vị trí như GPS (Global Positioning System) -- hệ thống xác định tọa độ toàn cầu dựa vào vệ tinh, hay bằng phương pháp gián tiếp. Nhược điểm 111 của việc sử dụng GPS là tín hiệu từ các vệ tinh mà sensor phải thu nhận có thể bị nhiễu do nhiều lý do khác nhau, gây ra sai số có thể lên tới hàng trăm mét. Ở các phương pháp gián tiếp, vị trí của robot tại mỗi thời điểm được tính toán căn cứ vào tọa độ vị trí ban đầu của robot, quãng đường robot đã đi qua kể từ điểm đó, hướng di chuyển của robot… Trong trường hợp đó robot phải được trang bị các sensor đo vận tốc hay quãng đường chuyển động, hướng chuyển động, góc nghiêng của robot… Nhược điểm của phương pháp gián tiếp là sai số sẽ tăng dần theo quãng đường đi của robot. Một nhược điểm nữa của các phương pháp dẫn đường theo tọa độ là chúng không có khả năng nhận biết và xử lý khi robot gặp phải các vật cản không có trên bản đồ, vì vậy các hệ dẫn đường sử dụng những phương pháp này thường có kết hợp cả các phương pháp khác để xử lý những tình huống như vậy. • Các phương pháp dẫn đường theo khung cảnh: với các phương pháp này chương trình dẫn đường điều khiển robot theo nhận thức của nó về môi trường xung quanh robot như địa hình, các đối tượng như vật cản, mục tiêu, vạch dẫn đường, đèn hiệu… Để làm được điều đó robot cần được trang bị các sensor nhận biết địa hình và các đối tượng trong môi trường. Loại sensor được sử dụng phổ biến nhất cho các robot di động là các sensor khoảng cách, từ những loại đơn giản như sensor âm thanh (sonar) và hồng ngoại đến các loại đắt tiền như radar và laser scanner. Tuy nhiên, các sensor khoảng cách chỉ có thể mang lại thông tin về địa hình và vật cản, trong khi để nhận thức đầy đủ về các đối tượng trong môi trường người ta còn cần tới những thông tin như màu sắc, hình dáng, cấu trúc… Để có được những thông tin này người ta thường dùng các sensor hình ảnh, phổ biến nhất là các loại CCD và CMOS camera. Phương pháp dẫn đường theo hình ảnh sử dụng các kỹ thuật của Thị giác Máy (Computer Vision), bao gồm các kỹ thuật xử lý ảnh và nhận dạng. 3.5. ThiÕt lËp hÖ thèng ®iÒu khiÓn t×m kiÕm ®èi t−îng theo mµu s¾c 112 3.5.1. M« t¶ ho¹t ®éng cña hÖ thèng Hệ thống gồm 2 phần: a) Máy tính trung tâm đóng vai trò bộ xử lý và điều khiển trung tâm; b) Robocar cùng camera di chuyển trong phạm vi không quá xa chỗ đặt máy tính trung tâm. Hai phần này được liên hệ với nhau bằng kết nối không dây. Hình 1.2.24. Màn hình của chương trình điều khiển robocar Các hình ảnh camera thu nhận sẽ được truyền đi bằng bộ phát tín hiệu cao tần gắn liền với camera và được nhận lại bởi bộ thu tín hiệu rồi đi qua bộ chuyển đổi tín hiệu tương tự sang số, nối với máy tính qua cổng USB. Còn tín hiệu điều khiển từ máy tính được truyền tới các bộ phận chấp hành cũng bằng sóng radio. Hình ảnh máy tính nhận được từ camera sẽ được hiển thị trên màn hình. Trên hình 1.2.24 là màn hình của chương trình điều khiển robocar. Khi robocar hoạt động ở chế độ có người điều khiển, người vận hành quan sát khung cảnh chung quanh robocar qua hình ảnh gửi về từ camera và điều khiển robocar tiến lùi, rẽ phải, rẽ trái v.v. bằng bàn phím hay chuột. Người điều khiển cũng có thể ra lệnh cho camera quay sang trái hay phải để quan sát được rộng hơn. 113 Ở chế độ tự động, hình ảnh máy tính nhận được từ camera sẽ được chương trình điều khiển tự đông xử lý và phân tích liên tục. Chương trình sẽ liên tục phát lệnh điều khiển chuyển động tới robocar. 3.5.2. Chương trình dẫn đường tự động Lưu đồ của chương trình dẫn đường tự động theo hình ảnh được thể hiện ở hình 1.2.25 Hình 1.2.25. Lưu đồ của chương trình dẫn đường tự động cho robocar Với chương trình dẫn đường tự động theo hình ảnh này đã tiến hành thử nghiệm thành công cho robocar “Chữ thập đỏ” ở Trung tâm NCKT Tự động hoá, ĐHBK - HN. Chương trình này cho phép robocar tìm kiếm và hướng theo các đối tượng có màu sắc được xác định trước. Hình 1.2.25 là Robocar “Chữ thập đỏ” được điều khiển bằng chương trình dẫn đường tự động theo hình ảnh có màu đỏ. Ảnh chụp lúc Robocar “Chữ thập đỏ” đã tìm thấy và chạy hướng tới chiếc hộp màu đỏ trước mặt. Start Đọc khung hình từ camera vào vùng đệm Xử lý ảnh trong vùng đệm Tìm được mục tiêu? Mục tiêu nằm giữa màn hình? Đúng Sai Quay tìm mục tiêuTiến thẳng Đúng Chế độ tự động. Đúng End Sai Mục tiêu nằm bên phải? Quay trái Sai Quay phải Đúng Sai 114 Hình 1.2.26. Ảnh chụp Robocar “Chữ thập đỏ” được điều khiển bằng chương trình dẫn đường tự động theo hình ảnh 3.5.2. Các bước của chương trình xử lý ảnh Một chương trình xử lý ảnh thường bao gồm các bước: Thu nhận ảnh Æ Tiền xử lý Æ Phân đoạn Æ Xác định thuộc tính Æ Nhận dạng. Chương trình dẫn đường tự động của robocar có chức năng điều khiển robocar tìm kiếm, nhận dạng và bám theo đối tượng căn cứ vào màu sắc, cụ thể là màu đỏ được sử dụng làm tín hiệu dẫn đường cho robocar. Phần xử lý ảnh của chương trình khá đơn giản, nhưng cũng bao gồm đầy đủ các bước của một chương trình xử lý ảnh như trên: - Thu thập ảnh: chương trình đọc ảnh từ camera vào một vùng đệm. Camera được sử dụng với robocar cho phép ghi được tới 30 khung hình/giây. Tuy nhiên, do đặc điểm của việc xử lý ảnh cho hệ dẫn đường của robocar là phải xử lý trong thời gian thực, chương trình phải xử lý xong một khung hình trước khi đọc vào khung hình tiếp theo, mà với các máy tính hiện có ở phòng thí nghiệm chương trình chỉ có khả năng xử lý 10-15 khung hình/giây. Hình ảnh được ghi vào vùng đệm ở dạng ma trận điểm với độ phân giải 320x240, 24bits/điểm ảnh, sử dụng mô hình màu cộng (RGB). 115 `- Tiền xử lý: trong bước này ảnh RGB (mô hình màu cộng) được chuyển đổi sang biểu diễn ở dạng mô hình HSI (với I là cường độ sáng, H và S biểu thị thông tin về màu)và được lọc bớt nhiễu. - Phân đoạn: ảnh được chia thành các vùng, mỗi vùng bao gồm các điểm có màu sắc tương tự nhau và liên tục. Các vùng không dính liền nhưng chỉ cách nhau vài điểm và có màu sắc gần giống nhau sẽ được nhập lại làm một vì có nhiều khả năng chúng thuộc về cùng một đối tượng. - Xác định thuộc tính: tính toán các giá trị H, S, và I trung bình cùng diện tích của và tâm của mỗi vùng. - Nhận dạng: tìm các vùng trong ảnh có màu đỏ (H trong khoảng [0o,20o] hay [340o,360o], S > 0,5) và cường độ sáng vừa phải (0,4 < I < 0,8) vì rất khó phân biệt màu sắc khi quá sáng hoặc quá tối. Trong những vùng này chọn vùng có diện tích lớn nhất làm mục tiêu để điều khiển robocar bám theo. Để viết chương trình xử lý ảnh, đã sử dụng thư viện OpenCV của Intel. Đây là một thư viện mã nguồn mở sử dụng cho ngôn ngữ lập trình C/C++ trong môi trường Windows và Linux, cung cấp nhiều chức năng xử lý và nhận dạng ảnh. 3.6. C¸c øng dông thö nghiÖm b−íc ®Çu VËn dông c¸c kÕt qu¶ nghiªn cøu vÒ Robocar RP. §Ò tµi ®· tiÕp tôc t¹o ra mét s¶n phÈm míi nh»m phôc vô cho viÖc phun hãa chÊt phßng chèng dÞch bÖnh. V× thÕ cã tªn gäi lµ Robocar “Ch÷ thËp ®á”. Còng nh− Robocar RP, ë ®©y Robocar “Ch÷ thËp ®á” cã 3 bé phËn chñ yÕu: M«®un xe di chuyÓn, c¬ cÊu robot vµ bé ®iÒu khiÓn. VÒ c¬ b¶n th× ë ®©y xe di chuyÓn theo nguyªn mÉu nh− Robocar RP, nh−ng c¬ cÊu robot l¹i ®¬n gi¶n hãa ®i cho phï hîp víi c«ng viÖc. Riªng hÖ thèng ®iÒu khiÓn th× l¹i trë 116 nªn phøc t¹p h¬n vÝ dô ph¶i dïng hÖ thèng camera ®Ó ®¸p øng ®−îc nh÷ng yªu cÇu cña c¸c c¬ së y tÕ cã yªu cÇu ¸p dông lo¹i robocar nµy. Thµnh c«ng ®Çu tiªn lµ nhê cã Robocar “Ch÷ thËp ®á” tiÕp thÞ nªn ®· cã c¸c bÖnh viÖn §èng §a, U b−íu, Thanh Nhµn Hµ Néi muèn ®−îc ¸p dông lo¹i robocar nµy. Thµnh phè Hµ néi ®· cÊp kinh phÝ ®Ó øng dông kÕt qu¶ nghiªn cøu vµ c¸c néi dung nµy ®ang ®−îc triÓn khai. Sau khi kh¶o s¸t t×nh h×nh ë mét sè bÖnh viÖn vµ tr×nh diÔn t¹i bÖnh viÖn Thanh Nhµn ®· kh¼ng ®Þnh ®−îc nh÷ng kÕt qu¶ c¬ b¶n, nh−ng còng cÇn bæ sung mét sè néi dung cho phï hîp víi thùc tÕ cña bÖnh viÖn. Cã thÓ rót ra nh÷ng nhËn xÐt sau ®©y: - M«®un xe cña Robocar nh− ®· thiÕt kÕ lµ cã thÓ ®iÒu khiÓn ®−îc trªn mÆt b»ng hµnh lang ch−a ®¹t tiªu chuÈn ë nhiÒu bÖnh viÖn ë ta. Tuy nhiªn vÉn ph¶i ®Ò nghÞ bÖnh viÖn söa sang l¹i nhiÒu ®o¹n chuyÓn tiÕp cã bËc cao hoÆc qu¸ dèc. - C¬ chÕ dïng sensor hång ngo¹i t¹o hµnh lang di chuyÓn men theo t−êng ch¾n lµ hoµn toµn kh¶ thi. - ViÖc ®iÒu khiÓn Robocar dïng ph−¬ng ph¸p “thÞ gi¸c m¸y” (computer Vision) lµ hîp lý vµ rÊt cã triÓn väng. - Ngoµi nhiÖm vô phun hãa chÊt phßng dÞch, cÇn cã nh÷ng robocar ®Ó b−ng bª c¸c thïng r¸c nhiÔm khuÈn, nhiÔm ®éc lµ nhu cÇu bøc sóc ë nh÷ng n¬i cã dÞch. - Dïng sensor siªu ©m ®Ó b¸o hiÖu vµ xö lý khi Robocar gÆp ch−íng ng¹i trªn ®−êng di chuyÓn trong lÇn tr×nh diÔn nµy ®· gÆp nhiÒu khã kh¨n v× sè bÖnh nh©n ®i l¹i rÊt lén xén trªn hµng lang còng nh− trong phßng. Thùc ra khi thiÕt kÕ theo nhiÖm vô ®Æt ra lµ ®iÒu khiÓn Robocar trong khu vùc cã bÖnh dÞch, hÇu nh− kh«ng cã ng−êi qua l¹i. Tuy nhiªn, tõ viÖc ®ã cã thÓ nhËn thÊy trong thùc tÕ chØ nªn dïng sensor siªu ©m nµy ®Ó c¶nh b¸o khi gÆp ch−íng ng¹i th«i. 117 C¸c trang tiÕp theo lµ ¶nh chôp Robocar “Ch÷ thËp ®á” vµ c¸c ¶nh lÊy tõ b»ng video quay c¸c c¶nh Robocar tr×nh diÔn ë BÖnh viÖn Thanh Nhµn vµ ®· chiÕu trªn VTV2. TiÕp theo lµ c¸c ¶nh chôp Robocar PHC (Phun hãa chÊt) ®−îc t¹o ra teo mÉu vµ cã c¶i tiÕn Robocar “Ch÷ thËp ®á, vµ Robocar BB (B−ng bª c¸c thïng r¸c nhiÔm khuÈn, nhiÔm ®éc hoÆc nhiÔm x¹). C¸c thiÕt bÞ nµy cßn ®ang triÓn khai theo nguån kinh phÝ cña thµnh phè Hµ Néi ®Ó lµm cho c¸c bÖnh viÖn. H×nh 1.2.27. Mét vµi ¶nh chôp Robocar “Ch÷ thËp ®á” H×nh 1.2.28. C¸c c¶nh Robocar tr×nh diÔn phun hãa chÊt phßng dÞch ë Bönh viÖn Thanh Nhµn (TrÝch tõ b¨ng Video chiÕu trªn VTV2) H×nh 1.2.29. Mét sè h×nh ¶nh ®ang l¾p r¸p Robocar PHC theo mÉu Robocar “Ch÷ thËp ®á” H×nh 1.2.30. Robocar BB-01 H×nh 1.2.31. L¾p r¸p Robocar BB-02 118 H×nh 1.2.27. Mét vµi ¶nh chôp Robocar “Ch÷ thËp ®á” 119 H×nh 1.2.28. C¸c c¶nh Robocar tr×nh diÔn phun hãa chÊt phßng dÞch ë BÖnh viÖn Thanh Nhµn (TrÝch tõ b¨ng Video chiÕu trªn VTV2) 120 H×nh 1.2.29. Mét sè h×nh ¶nh ®ang l¾p r¸p Robocar PHC theo mÉu Robocar “Ch÷ thËp ®á” 121 H×nh 1.2.30. Robocar BB – 01 H×nh 1.2.31 L¾p r¸p Robocar BB – 02 122 H×nh 1.2.32. B¶n vÏ l¾p Robocar PHC 2 5 6 3 14 78 § Ò tµ i K C 0 3- 08 2 S en so r q ua ng 8 57 6 C am er a 4 S en so r s iª u ©m § én g c¬ q ua y ta y m ¸y 12 1 1 T æn g sè K hè i l −î ng V Ët li Öu S è l− în g § ¬n v Þ 11 1 G hi c hó M « ®u n ta y m ¸y p hu n hã a ch Êt T hï ng c hó a hã a ch Êt 1 M « ®u n di c hu yÓ n V Þ t rÝ T ªn g äi B ¬m 3 2 N gu y? n Th i? n Ph úc N gu y? n V an M in h D uy ?t Th i? t k ? Tr . n hi ?m K i? m tr a H ? và tê n K ý N gà y S? lu ?n g: Tr un g tâ m N CK T T? d ?n g hó a Tr u? ng Đ ?i h ?c B ác h K ho a H à N ?i B? n v? s? : T? l? : H oµ ng A nh § ¹i R O B O C A R P H C B ¶ n v Ï l¾ p N gu y? n Th i? n Ph úc C h? n hi ?m 123 H×nh1.2.32. Robocar BB - 02 25 230 38 70 90 0 24 0 210 20 80 658 320 45 14 7 Tr ác h nh i?m H ? và tê n Ch ? kí N gà y Th i? t k ? K i? m tr a Du y? t K h? i l u? ng : T? l? : T? s? : S? t? : Ro bo ca r B B0 2 B? n v? s? : Tr un g tâ m N CK T t? d ?n g ho á Tr u? ng Đ ?i h? c B ác h K ho a H à N ?i B? N V? L ?P 545 1: 1 N gu y? n Đ ?c Q ua ng N gu y? n V an M in h Ng uy ?n th i?n P hú c V ? t rí Tê n g? i V ?t li? u S. lu ?n g G hi ch ú 1234567 Đ ? Á N T? T NG HI ?P 44 124 IV. Xe l¨n vµ xe ghÕ tù ®éng XuÊt ph¸t tõ c¸c kÕt qu¶ nghiªn cøu vÒ Robocar RP, sau khi chuyÓn h−íng kÞp thêi sang lµm robot dÞch vô (service robot), nhÊt lµ vËn dông nh÷ng kÕt qu¶ thö nghiÖm trªn Robocar TN. §Ò tµi ®· nhanh chãng hßan thµnh mét phiªn b¶n ®Çu tiªn Xe l¨n ch¹y ®iÖn tù ®éng dïng khung xe l¨n mua cña Viha. §©y lµ sù thÓ hiÖn tinh thÇn phôc vô cña nhãm c¸n bé §Ò tµi, nh¹y c¶m tr−íc nh÷ng sè liÖu tæng kÕt cña Bé Lao ®éng Th−¬ng binh x· héi cã ®Õn 10% d©n sè lµ th−¬ng binh vµ th−¬ng tËt. Còng v× tinh thÇn ®ã §Ò tµi ®· ®em ngay ®Õn C«ng ty Viha tr×nh bµy kÕt qu¶ nghiªn cøu vÒ xe l¨n tù ®éng (XLT§) nµy vµ ®· nhÊt trÝ víi c«ng ty hîp t¸c nghiªn cøu hßan thiÖn s¶n phÈm ®Ó ®−a vµo s¶n xuÊt, thËm chÝ cßn viÕt hé phÇn khoa häc, kü thuËt cña thuyÕt minh §Ò tµi, Dù ¸n cÊp Thµnh phè. RÊt tiÕc r¨ng khi kinh phÝ cña Thµnh phè ®· ®−îc cÊp th× C«ng ty l¹i cè t×nh l·ng tr¸nh sù hîp t¸c ®· tháa thuËn (!). Phiªn b¶n ®Çu tiªn vÒ XLT§ nµy, §Ò tµi ®· theo ph−¬ng ¸n dïng 2 ®éng c¬ 1 chiÒu th«ng th−êng, qua bé truyÒn xÝch truyÒn tíi 2 b¸nh. Nh− ®· ph©n tÝch trong phÇn nghiªn cøu vÒ m«®un xe di ®éng cña Robocar RP, theo ph−¬ng ¸n nµy rÊt khã ®¶m b¶o xe ch¹y theo ®−êng th¼ng, nhÊt lµ khi mÆt ®−êng kh«ng qu¸ b»ng ph¼ng vµ ®ång ®Òu. KÕt qu¶ nghiªn cøu tiÕp theo vÒ XLT§ nµy lµ mét ph−¬ng ¸n rÊt ®éc ®¸o lµ dïng ®éng c¬ xe ®¹p ®iÖn bäc b¸nh lèp trùc tiÕp lµm b¸nh xe chñ ®éng. Xe cã thÓ l¸i b»ng tay hoÆc tù ®éng. §ång thêi kh«ng l¾p cho khung xe l¨n n÷a lµ l¾p ngay cho c¸c ghÕ ngåi th«ng th−êng vµ ký hiÖu v¾n t¾t lµ XGT§ (xe ghÕ ch¹y ®iÖn tù ®éng). XLT§-02 vµ XGT§-02 lµ ph−¬ng ¸n xe l¨n tù ®éng vµ xe ghÕ tù ®éng dïng 1 b¸nh chñ ®éng b»ng b¶n th©n ®éng c¬ xe ®¹p ®iÖn (X§§) ®−îc bäc trùc tiÕp b¸nh lèp. Ph−¬ng ¸n nµy cã rÊt nhiÒu −u ®iÓm: 125 - §éng c¬ X§§ lµ lo¹i ®éng c¬ 1 chiÒu kh«ng chæi than (brushless motor) cã vµnh ngoµi quay cïng víi rotor, nguån cung cÊp trªn thÞ tr−êng lu«n lu«n cã s½n. So víi ph−¬ng ¸n dïng 2 ®éng c¬ 1 chiÒu th«ng th−êng víi c¸c bé truyÒn xÝch vµ b¸nh r¨ng kÌm theo th× ®èi víi ph−¬ng ¸n nµy lµ rÎ h¬n vµ bªn v÷ng h¬n. - Theo ph−¬ng ¸n XLT§-02 lµ XGT§-02 th× l¸i trùc tiÕp b¸nh xe chñ ®éng, tøc lµ b¸nh xe bäc trùc tiÕp ®éng c¬ X§§. V× vËy ®iÒu khiÓn viÖc di chuyÓn rÊt tin cËy kh«ng phô thuéc nhiÒu vµo chÊt l−îng mÆt ®−êng nh− trong tr−êng hîp dïng 2 ®éng c¬ 1 chiÒu th«ng th−êng t¸c ®éng vµo 2 b¸nh. Ngoµi ra ®Ó ®¶m b¶o ®ång tèc thùc tÕ cho 2 ®éng c¬ nµy võa rÊt khã kh¨n võa ®ßi hái thiÕt bÞ phøc t¹p vµ ®¾t tiÒn h¬n. - Ph−¬ng ¸n dïng ®éng c¬ X§§ sÏ tiÕt kiÖm n¨ng l−îng h¬n nhiÒu nªn rÊt phï hîp cho tr−êng hîp ch¹y b»ng ¾cquy. Theo sè liÖu cña Nhµ s¶n xuÊt ®éng c¬ X§§ th× c«ng suÊt ®Þnh møc: 200w, tèc ®é quay ®Þnh møc: 170v/ph, ®iÖn ¸p: 36v – 12Ah, bé n¹p ®iÖn dïng ®iÖn nguån AC 220v, qu·ng ®−êng di chuyÓn ®−îc cho 1 lÇn n¹p ®iÖn lµ 20km. - Ph−¬ng ¸n XLT§-02 lµ XGT§-02 cã kÕt cÊu ®¬n gi¶n h¬n nhiÒu, mµ l¹i bÒn v÷ng h¬n. HÖ ®iÒu khiÓn cã nhiÒu h×nh thøc: tõ ®iÒu khiÓn b»ng tay ®Õn ®iÒu khiÓn tù ®éng víi c¸c møc ®é kh¸c nhau tïy thuéc vµo yªu cÇu vµ lo¹i sensor ®−îc trang bÞ. HÖ ®iÒu khiÓn ®· ®−îc m«®un hãa khi nghiªn cøu chóng trªn Robocar TN vµ cã thÓ dïng ®Ó l¾p thªm vµo XLT§-02 hoÆc XGT§-02 theo yªu cÇu cña kh¸ch hµng. §©y lµ nh÷ng s¶n phÈm gi¸ thµnh thÊp, ch−a thÓ so s¸nh víi c¸c lo¹i xe ghÕ (Wheel Chair) chµo b¸n cña n−íc ngoµi (xem th«ng tin trªn ¶nh) nh−ng l¹i phï hîp víi ®¹i ®a sè ®èi t−îng th−¬ng binh vµ th−¬ng tËt. Tuy vËy ®Ó thµnh s¶n phÈm phôc vô ®−îc nhiÒu ng−êi ph¶i cã sù ®Çu t− nh− mét xÝ nghiÖp. ë phßng thÝ nghiÖm cña §Ò tµi nghiªn cøu míi chØ cã ®iÒu kiÖn “cung cÊp” cho nh÷ng ng−êi quen biÕt th«i. 126 - M« t¶ s¶n phÈm + Xe l¨n tù ®éng: Xe lăn điện chạy tự động có thể xếp vào loại robocar đơn giản. Nó có thể được điều khiển hoàn toàn tự động hoặc chạy theo chương trình được “học” trước. Và nếu được trang bị các môđun cảm biến thích hợp nó hoàn toàn có thể biết báo hiệu và tự xử lý khi gặp chướng ngại hoặc đi men theo tường v.v. như một robocar. Tuy nhiên, với mục đích tạo ra phương tiện di chuyển với tốc độ châm 4,5km/h, tương đối rẻ tiền phù hợp với đại đa số thương binh, người tàng tật hoặc già yếu, chúng tôi đã cải tiến xe lăn tay thành xe lăn điện chạy tự động hoặc theo chế độ điều khiển bằng tay nhờ các nút bấm gắn trên tay ghế hoặc “tay lái” kiểu “joystick”. Nhưng trên xe lăn này cũng có thể lắp các môđun cảm biến và cài đặt những chương trình phần mềm tương ứng thì sẽ biến thành xe lăn chạy tự động hoàn toàn, như trình diễn trên băng hình C¸c th«ng sè kü thuËt: - Träng t¶i: - C«ng suÊt ®Þnh møc cña ®éng c¬: 200w - Tèc ®é trung b×nh: 4,5km/h - §iÖn ¸p: 36v – 12Ah - Bé n¹p sö dông ¸p nguån AC 220v. - Thêi gian n¹p 4 ®Õn 7 h (tù ng¾t khi ®Çy) - Qu·ng ®−êng ®i sau 1 lÇn n¹p ®Çy: 20km 127 Price $ 9,900.00 Price $ 18,900 $10,725 $ 14.695 H×nh 1.2.34. Mét sè Weel chair (xe ghÕ ch¹y ®iÖn) kÌm gi¸ chµo hµng cña n−íc ngßai 128 + Xe ghÕ tù ®éng Xe ghế (Wheelchair) chạy tự động cũng là một dạng đơn giản của robocar phục vụ người già ốm yếu, tàng tật. Xe chạy với tốc độ tối đa là 4,5km/h. Tuỳ theo yêu cầu, mức độ điều khiển có thể cao thấp khác nhau. Đơn giản nhất là chỉ dùng tay lái để thay đổi hướng đi và tốc độ di chuyển. Cao hơn có thể lắp thêm vào xe các thiết bị tự động khác, như tự báo hiệu và xử lý khi gặp chướng ngại, tự đi men theo và giữ khoảng cách với tường ngăn, tự quan sát và hiển thị hình ảnh từ khoảng cách xa nhất định C¸c th«ng sè kü thuËt: - Träng t¶i: - C«ng suÊt ®Þnh møc cña ®éng c¬: 200w - Tèc ®é trung b×nh: 4,5km/h - §iÖn ¸p: 36v - 12Ah - Bé n¹p sö dông ¸p nguån AC 220v. - Thêi gian n¹p 4 ®Õn 7 h (tù ng¾t khi ®Çy) - Qu·ng ®−êng ®i sau 1 lÇn n¹p ®Çy: 20km - C¸c ¶nh vµ b¶n vÏ kü thuËt PhÇn tiÕp theo tr×nh bµy c¸c ¶nh chôp c¸c s¶n phÈm vµ c¸c b¶n vÏ, hå s¬ kü thuËt liªn quan ®Õn s¶n phÈm. ë mçi ¶nh hoÆc b¶n vÏ, hå s¬ ®Òu ®· cã phÇn ghi chó 129 H×nh 1.2.35. ¶nh chôp XLT§ H×nh 1.2.36. B¶n vÏ l¾p XLT§ 130 H×nh 1.2.37. ¶nh chôp XGT§ 131 V. KÕt luËn NhiÖm vô 1 cña §Ò tµi KC.03.08 ®−îc ®¨ng ký lµ nghiªn cøu t¹o ra nhãm s¶n phÈm Robot RP ®−îc n©ng cÊp vµ th«ng minh hãa. §Ó hÖ thèng chÊp hµnh cã thÓ ®¸p øng linh ho¹t c¸c yªu cÇu vÒ th«ng minh hãa Robot RP ®· ®−îc t¹o thªm kh¶ n¨ng di ®éng b»ng xe vµ gäi tªn lµ Robocar RP. Nh− vËy, Robocar RP gåm c¬ cÊu robot RP vµ c¬ cÊu xe di chuyÓn ®−îc ®iÒu khiÓn thèng nhÊt. Trong hÖ thèng ®ã ®−îc trang bÞ thªm c¸c bé phËn c¶m biÕn, thiÕt bÞ xö lý tÝn hiÖu vµ ch−¬ng tr×nh phÇn mÒm ®iÒu khiÓn. §Ò tµi ®· hoµn thµnh nghiªn cøu thiÕt kÕ, chÕ t¹o vµ vËn hµnh ®iÒu khiÓn Robocar RP víi mét vµi nhiÖm vô øng dông kh¸c nhau ®· ®Æt ra. Tho¹t ®Çu lµ ®Þnh h−íng øng dông trong ph©n x−ëng c«ng nghiÖp. Sau ®ã còng theo xu thÕ cña chuyªn ngµnh robot trªn thÕ giíi chuyÓn tõ “robot c«ng nghiÖp” sang “robot dÞch vô” (service robots). Robocar RP-01 ®−îc c¶i tiÕn tõ nhiÒu mÆt vµ hßan thµnh phiªn b¶n Robocar RP – 02 nh»m phôc vô mét vµi c«ng viÖc dÞch vô nh− phßng chèng bÖnh dÞch vµ hç trî ng−êi giµ yÕu, tµng tËt. Theo ®Þnh h−íng øng dông trong c¸c lÜnh vùc nµy ®ßi hái vÒ møc ®é “th«ng minh hãa” cao h¬n. Theo ®Þnh h−íng øng dông ®ã §Ò tµi ®· ph¸t triÓn nhãm s¶n phÈm. Ngoµi Robocar RP-01, Robocar RP-02 ®· hoµn thµnh Robocar “Ch÷ thËp ®á”, Xe l¨n tù ®éng, Xe ghÕ tù ®éng. Mét vµi s¶n phÈm nãi trªn ®· ®−îc øng dông thö nghiÖm cßn sè kh¸c còng ®−îc nhiÒu c¬ së quan t©m ®Õn, nh−ng ®Ó thµnh s¶n phÈm th−¬ng m¹i th× cßn cÇn cã nhiÒu ®Çu t− thÝch ®¸ng. Tuy nhiªn nÕu cã ®−îc nh÷ng phiªn b¶n ®Çu tiªn ë phßng thÝ nghiÖm th× míi thu hót ®−îc sù quan t©m cña c¬ së tiÕp nhËn kÕt qu¶ nghiªn cøu. §ã lµ ý nghÜa thùc tiÔn cña §Ò tµi. 132 Víi c¸ch tiÕp cËn ®ã §Ò tµi ®· nhËn ®−îc c¸c kÕt qu¶ rÊt c¬ b¶n vµ më ra nhiÒu triÓn väng øng dông. C¸c kÕt qu¶ c¬ b¶n lµ ®· nghiªn cøu chuÈn hãa ®−îc c¸c m«®un hîp thµnh robocar th«ng minh. §ã lµ m«®un di chuyÓn, m«®un robot ®Æt trªn xe, m«®un nhËn biÕt, xö lý vµ ®iÒu khiÓn víi c¸c m«®un ch−¬ng tr×nh phÇn mÒm cho m¸y tÝnh. §ã lµ ý nghÜa khoa häc cña §Ò tµi. VËn dông c¸c m«®un nµy khi ghÐp nèi l¹i ®Ó ®¸p øng mét yªu cÇu cô thÓ lµ hßan toµn kh¶ thi trong thêi gian ng¾n. Tõ thùc tÕ triÓn khai §Ò tµi còng nhËn thÊy r»ng sau khi ®· ®Þnh h×nh ®−îc c¸c m«®un hîp thµnh robot th«ng minh §¬n vÞ nghiªn cøu ®· nhanh chãng t¹o ra c¸c phiªn b¶n ®Çu tiªn vÒ Robocar ®Þa h×nh, Robocar C¶nh vÖ, Robocar h−íng dÉn viªn vµ ®ang ph¸c th¶o c¸c kiÓu robocar an ninh vµ robocar qu©n sù. 133 Tµi liÖu tham kh¶o 1. Fu. K. S., Gonzaler R.C., Lee C.S.G. Robotics: Control, Sensing, Vision and Intelligence. Mc Graw - Hill, 1987. 2. Mair G. Industrial Robotics. Prentice Hall, 1988. 3. Murray R., Li Z., Sastry S., A Mathematical Introduction to Robotic Manipulation CRC Press, 1989. 4. Paul R.P., Modeling, Trajectory Caculation and Servoing of a Computer Controlled Arm. Palo Alto Calif, 1972. 5. Paul R.P., Robot Manipulators: Mathematics, Programming and Control The MIT Press – Cambridge, Massachusetts and London, England, 1981. 6. Everett. H. R. Sensor for Mobile Robots. Canada, 1995 7. Agin G.L. “Vision Systems” - Handbook of Industrial Robotics. Ed. S. Y. Nof. NewYork, John Wiley & Sons, Inc 1999 8. Ronald C. “Intelligent Control of Robot Mobility” Handbook of Industrial Robotics. Ed. S.Y.Nof. NewYork, John Willey & Sons Inc, 1999. 9. Russell H. Taylor. “Medical Robotics and Computer Integrated Surgery”. Handbook of Industrial Robotics. Ed. S.Y.Nof. NewYork, John Wiley & Sons. Inc, 1999. 10. Hagen Sehempf. “Mobile Robots and Walking Machines” Handbook of Industrial Robotics. Ed. S.Y.Nof. NewYork, John Wiley & Sons. Inc, 1999. 11. Refael C. Gonzaler & Richard E. Woods. Digital Image Processing. Addison – Wesley, 1992. 12. . Pugh, A. (editor). Robot Sensors. Vol. 1 and Vol 2, Bedford UK, IFS Publications, 1986. 134 13. Pham and Heginbotham – Robot Grippers. Bedford, UK, IFS Publications, 1986. 14. Owen, T. Assembly with Robot. London: Kogan Page, 1985 15. Shimon Y. Nof, Handbook of Industrial Robotics, 2nded. John Wiley & Sons. Inc. 1999. 16. Snyder W.E., Industrial Robots: Computer Interfacing and Control. Prentice Hall Inc. New Jersey, 1985. 17. Stadler W., Analytical Robotics and Mechatronics McGraw – Hill, 1995. 18. NguyÔn ThiÖn Phóc, §iÒu khiÓn chuyÓn ®éng robot hµn theo quü ®¹o ®Þnh tr−íc. TuyÓn tËp c«ng tr×nh Héi nghÞ C¬ häc toµn quèc lÇn thø VI. Hµ Néi, 12/1997.

Các file đính kèm theo tài liệu này:

  • pdf62461.pdf