mobile robot OpenCV.pdf

ĐẠI HỌC QUỐC GIA HÀ NỘI TRƯỜNG ĐẠI HỌC CÔNG NGHỆ

Nguyễn Xuân Đức

ĐIỀU KHIỂN ROBOT DI ĐỘNG SỬ DỤNG THƯ VIỆN OPENCV

ĐỒ ÁN TỐT NGHI ỆP ĐẠI HỌC HỆ CHÍNH QUY Ngành: Cơ học Kỹ thuật

HÀ NỘI-2010

ĐẠI HỌC QUỐC GIA HÀ NỘI TRƯỜNG ĐẠI HỌC CÔNG NGHỆ

Nguyễn Xuân Đức

ĐIỀU KHIỂN ROBOT DI ĐỘNG SỬ DỤNG THƯ VIỆN OPENCV

ĐỒ ÁN TỐT NGHIỆP ĐẠI HỌC HỆ CHÍNH QUY Ngành: Cơ học Kỹ thuật Cán bộ hướng dẫn: ThS. ThS. Phùng Văn Hiệp

HÀ NỘI – 2010

L ỜI CẢM ƠN

K hi bắt đầu nhận đồ án tốt nghiệp này em đã rất lo lắng bởi xử lý ảnh là l ĩnh ĩnh vực còn mới mẻ ở Việt Nam và bản thân cũng lần đầu tiên tiếp xúc với lĩnh vực này. Em rất vui v ì cuối cùng đã hoàn hoàn thành tốt đồ án được giao. Trước hết em xin gửi lời cảm ơn sâu sắc đến ThS. Phùng Văn Hiệp tuy không có điều kiện trực tiếp được l àm việc cùng thầy nhiều, nhưng qua những lần tiếp xúc ngắn ngủi đó chính thầy đã cho emnhững lời động viên, những lờ i khuyên quý báu, em học được ở thầy rất nhiều từ phong cách làm việc đến phong cách sống, em rất khâm phục thầy. Đồng thời em xin gửi lời cảm ơn đến ThS. Võ Đức Mỹ, cán bộ nghi ên cứu tại Viện Công nghệ Vũ trụ - Viện Khoa học và Công nghệ Việt Nam. Mặc dù chỉ được trực tiếp làm việc với thầy trong thời gian ngắn do thầy phải đi công tác xa và rất bận hư ớng dẫn, chỉ bảo tận ình rộn nhưng thầy vẫn luôn d ành thời gian quý báu hướng tình, giúp iúp em bước từ những bước đi đầu tiên đến lúc em hoàn thành được đồ án n ày.

Em xin gửi lời cảm ơn chân thành đến KS. Nguyễn Thanh Tuấn cán bộ nghiên cứu phòng Động lực học vũ trụ và Cơ điện tử chính xác - Viện Công nghệ Vũ trụ Viện Khoa học và Công nghệ Việt Nam. KS. Nguyễn Thanh Tuấn không những giúp ình ình thực hiện đồ án này mà còn chỉ bảo, giúp đỡ em ngay ngay đỡ em rất nhiều trong quá tr từ khi em bắt đầu được đến học tập tại Viện. Qua đây em cũng xin gửi lời cảm ơn đến thầy, cô giáo công tác tại trường Đại n ghiên cứu tại Viện Công Học Công Nghệ - Đại Học Quốc Gia Hà Nội và các cán bộ ng Ngh Nghệ Vũ trụ Viện Khoa học và Công nghệ Việt Nam đã giúp đỡ em về chuyên môn, tạo điều kiện thuận lợi để em hoàn thành đồ án n ày.

Thực sự con cũng không biết làm thế n ào để nói hết công ơn bố mẹ đ ã dành cho con! Một lần nữa xin cảm ơn tất cả mọi người, cầu chúc cho tất cả mọi người mạnh khỏe, vui vẻ, hạnh phúc và thành công! Sinh viên Nguyễn xuân Đức

TÓM T ẮT NỘI DUNG ĐỒ ÁN

L ĩnh vực rô bốt đang ngày càng chiếm được sự quan tâm của các nh à nghiên cứu và xã hội. Từ ình tình hình ình thực tế đó, việc xây dựng các chương tr ình ình hoạt động cho rô bốt là điều thiết yếu, đặc biệt đối với rô bốt di động. Bài toán rô bốt di động bám đối tượng là một bài toán thường gặp trong lĩnh vực rô bốt. Đồ án này trình bày xây dựng một giải pháp điều khiển rô bố t di động bám đối tượng dựa vào thuật toán CamShift trong thư viện OpenCV. Để theo d õi đối tượng trong OpenCV cần phải có quá tr ình ình dò tìm, ìm, phân tích ích và nhận dạng đối tượng.

Bố cục của đồ án này được tr ình ình bày như sau: trước hết đồ án tr ình ình bày những khái niệm về thư viện OpenCV, sau đó tr ình ình bà bày các cơ sở lý thuyết của thư viện OpenCV. Trên cơ sở ìm tìm hiểu ìm tìm hiểu thư viện OpenCV đồ án xây dựng thuật toán theo dõi đối tượng dựa vào một thuật toán rất phổ biến tr ong ong OpenCV là thuật toán CamShift. M ột Webcam được sử dụng để thu thập h ình ình ảnh đóng vai tr ò như là con mắt của rô bốt và một laptop được sử dụng làm bộ xử lý trung tâm cho rô bốt. Mô ết quả đồ án là hình rô bốt được chế tạo nhằm kiểm nghiệm thuật toán đ ã xây dựng. K ết căn cứ để phát triển và xây dựng các thuật toán điều khiển rô bốt sử dụng OpenCV sau này.

M ỤC LỤC

MỞ ĐẦU .......................................................................................................................... 1 CHƯƠNG 1. GI ỚI THIỆU CHUNG ................................................................................ 2 1.1. Giới thiệu chung về rô bốt...................................................................................... 2 1.2. Giới thiệu rô bốt bám đối tượng ............................................................................. 3 1.3. Mục tiêu của đồ án ................................................................................................. 6 1.4. Giới hạn của đồ án ................................................................................................. 6 CHƯƠNG 2. TỔNG QUAN VỀ THƯ VIỆN OPENCV VÀ MỘT SỐ LINH KIỆN SỬ DỤNG TRONG KHỐI PHẦN CỨNG.............................................................................. 7 2.1. Thế nào là thị giác máy? ........................................................................................ 7 2.2. Thư viện OpenCV.................................................................................................. 7 2.2.1. OpenCV là gì?................................................................................................7 2.2.2. Vì sao l ựa chọn OpenCV? ..............................................................................8 2.2.3. Cấu trúc và nội dung OpenCV như thế nào?...................................................9 2.2.4. Các hàm I/O trong OpenCV .......................................................................... 10 2.2.5. Các hàm thực hiện xử lý ảnh .........................................................................12 2.2.6. Các hàm Histograms and Matching .............................................................. 13 2.2.7. Hàm Contours...............................................................................................13 2.2.8. Cơ sở toán học của thuật toán CamShift .......................................................14 2.3. Cơ bản về PIC16F877A ....................................................................................... 15 2.3.1. PIC là gì?...................................................................................................... 15 2.3.2. Đặc điểm nổi bật của PIC16F877A ............................................................... 15 2.3.3. Sơ đồ các chân của PIC16F877A ..................................................................16 2.4. Giao ti ếp RS232................................................................................................... 18 2.5. Giới thiệu về chíp mạch cầu L298N .....................................................................20 CHƯƠNG 3. XÂY DỰNG PHẦN MỀM ĐIỀU KHIỂN ................................................ 22 3.1. Thị giác máy điều khiển rô bốt di động bám đối tượng ........................................ 22 3.2. Thuật toán tính hướng và kích cỡ của đối tượng cần theo dõi...............................23 3.2.1. Thuật toán chung .......................................................................................... 23 3.2.2. Nhận dạng và bám mục tiêu di động ............................................................. 24 3.2.3. Chuyển đổi không gian m àu từ RGB đến HSV ............................................. 25 3.2.4. Histogram..................................................................................................... 26 3.2.5. L ọc nhiễu Filter ............................................................................................ 27 3.2.6. Thuật toán CamShift ..................................................................................... 28 3.2.7. Thiết kế ho àn chỉnh phần mềm điều khiển .................................................... 30 CHƯƠNG 4. XÂY DỰNG MẠCH PHẦN CỨNG .........................................................34 4.1. Sơ đồ mạch dùng trong đồ án ............................................................................... 34

4.1.1. Khối điều khiển trung tâm ............................................................................34 4.1.2. Khối nguồn ................................................................................................... 35 4.1.3. Khối truyền thông RS232 ............................................................................. 35 4.1.4. Khối điều khiển động cơ ............................................................................... 36 4.2. Tập lệnh điều khiển rô bốt ................................................................................... 37 CHƯƠNG 5. K ẾT QUẢ THỰC HIỆN ...........................................................................38 5.1. K ết quả thử nghiệm với môi trường tĩnh .............................................................. 40 5.2. K ết quả thử nghiệm với môi môi trường động......................................................42 K ẾT LUẬN .................................................................................................................... 46 PHỤ LỤC A. CHƯƠNG TR ÌNH XỬ LÝ ẢNH ............................................................. 48 PHỤ LỤC B. CHƯƠNG TR ÌNH ĐIỀU KHIỂN ROBOT............................................... 62 PHỤ LỤC C. CHƯƠNG TR ÌNH TRUY ỀN THÔNG RS232 ......................................... 66 TÀI LI ỆU THAM KHẢO............................................................................................... 72

DANH SÁCH HÌNH V Ẽ Hình 1: PANrobot (nguồn: mobilerobot.org ................................................................ 4 Hình 2: Rô bốt MIDbo (nguồn: telepresenceoptions.com) ........................................... 4 Hình 3: Rô bốt Pops (nguồn: slashgear.com)............................................................... 5 Hình 4: Rô bốt thám hiểm sao hoả (nguồn: robot ics.youngester.com) ......................... 5 Hình 5: Quá trình phát tri ển của OpenCV ................................................................... 8 Hình 6: Cấu trúc cơ sở của OpenCV ............................................................................ 9 Hình 7: PIC16F877A................................................................................................. 16 Hình 8: Sơ đồ khối của PIC16F877A ......................................................................... 17 Hình 9: Cổng giao tiếp RS232 ................................................................................... 19 Hình 10: Chíp mạch cầu L298N ................................................................................ 21 Hình 11: Sơ đồ khối tổng quát của rô bốt ..................................................................22 Hình 12: Sơ đồ thuật toán chung ............................................................................... 23 Hình 13: Mặt phẳng ảnh ............................................................................................ 24 Hình 14: Biểu diễn đối tượng di chuyển tr ên mặt phẳng ảnh ..................................... 25 Hình 15: Chuyển đối không gian màu RGB đến HSV .................................................26 Hình 16: Histogram................................................................................................... 26 Hình 17: kết quả trước và sau khi lọc nhiễu ............................................................... 27 Hình 18: Sơ đồ thuật toán CamShift .......................................................................... 28 Hình 19: K ết quả tính toạ độ tâm bằng thuật toán CamShift ...................................... 29 Hình 20: K ết quả bước đầu theo d õi đối tượng bằng thuật toán CamShift ................. 29 Hình 21: Giao diện phần mềm thiết kế hoàn chỉnh..................................................... 31 Hình 22: K ết quả thử nghiệm với phần mềm .............................................................. 32 Hình 23: K ết quả thử nghiệm với phần mềm .............................................................. 33 Hình 24: Sơ đồ khối điều khiển trung tâm ..................................................................34 Hình 25: Sơ đồ khối nguồn ........................................................................................ 35

Yahoo: t hoi _chao_em_12325

Emai l : xuanducdhcn@gmai l . com

Hình 26: Sơ đồ khối truyền thông RS232 .............................................. ................................................................ ..................... ...35 Hìn Hì nh 27 27: Sơ đồ nguyên lý mạch cầu điều khiển động cơ ......................................... ............................................ ... 36 36 Hình 28: Sơ đồ phần cứng hoàn chỉnh. ................................................. ...................................................................... ..................... 36 Hìn Hì nh 29: 29: Hình Hình ảnh robot hoàn chỉnh ....................................... ................................................................ .................................. ......... 39

Yahoo: Yahoo: t hoi _ c hao_em ao_ em_ 1232 12325 5

Emai l : xuand xuanducdh ucdhcn@ cn@gmai l . c om

DANH SÁCH SÁCH BI ỂU ĐỒ Biểu đồ 1: Giá trị toạ độ tâm đối tượng môi trường tĩnh (160x120). .......................... 40 Biểu đồ 2: Giá trị toạ độ tâm đối tượng môi trường tĩnh (176x144). .......................... 40 Biểu đồ 3: Giá trị toạ độ tâm đối tượng môi trường tĩnh (320x240) ........................... 41 Biểu đồ 4: Giá trị toạ độ tâm đối tượng môi trường tĩnh (640x480). .......................... 42 Biểu đồ 5: Giá trị toạ độ tâm đối tượng môi trường động (160x120). ........................ 42 Biểu đồ 6: Giá trị toạ độ tâm đối tượng môi trường động (176x144). ........................ 43 Biểu đồ 7: Giá trị toạ độ tâm đối tượng môi trường động (320x240). ........................ 43 Biểu đồ 8: Giá trị toạ độ tâm đối tượng môi trường động (640x480). ........................ 44 Biểu đồ 9: Giá trị toạ độ tâm đối tượng môi trường động tốc độ không đổi ............... 44



DANH DANH SÁCH BẢNG Bảng 1: Chức năng các chân của L298N .............................................. ................................................................ ..................... ...20 Bảng 2: Tómtắt nguyên tắc điều khiển động cơ sử dụng L298N ................................ ................................21 21 Bảng 3: Tập lệnh điều khiển rô bốt ................................................ ................................................................... ............................ ......... 37



M Ở ĐẦU

Xử lý ảnh bao gồm lý thuyết và các kỹ thuật liên quan nhằm mục đích tạo ra một hệ thống nhân tạo có thể tiếp nhận thông tin từ các h ình ình ảnh thu được hoặc các tập dữ liệu đa chiều. Đối với mỗi người chúng ta, quá tr ình ình nhận thức thế giới bên ngoài là một điều dễ dàng. Quá trình nhận thức đó được “học” thông qua quá tr ình ình sống của mỗi người. Tuy nhiên với các vật vô tri vô giác như như các máy tính, rô bốt v..v. thì điều đó quả thực là một bước tiến rất gian nan. Các thiết bị ngày nay không chỉ nhận thông tin ở dạng tín hiệu đơn lẻ mà còn có thể có cái “nh ìn” ìn” th thật với thế giới bên ngoài. Cái “nhìn” này qua quá trình phân tích, kết hợp với các mô h ình ình như máy học, mạng nơron v..v. sẽ giúp cho thiết bị tiến dần tới một hệ thống nhân tạo có khả năng ra quyết định linh hoạt và đúng đắn hơn rất nhiều. OpenCV là thư viện mã nguồn mở về xử lý ảnh của Intel nó đáp ứng đầy đủ các yêu cầu đó của lĩnh vực xử lý ảnh. Trê Trên thế giới lĩnh vực rô bốt di động sử dụng xử lý ảnh phát triển vô cùng mạnh mẽ và có được những bước tiến đáng k inh inh ngạc. Ở Việt Nam lĩnh vực rô bốt di động đang rất phát triển, tuy nhiên l ĩnh ĩnh vực rô bốt b ốt di động sử dụng công cụ xử lý ảnh còn mới mẻ do thiếu các thiết bị hỗ trợ và tài li ệu. Vì vậy, đây sẽ là một hướng phát triển ĩnh vực v ực mới đầy hứa hẹn và cũng không ít thách thức. Với mong muốn tham gia v ào l ĩnh còn mới này và góp phần vào sự phát triển lĩnh vực rô bốt di động sử dụng xử lý ảnh ở Việt Nam, em thực hiện đề tài “Đ iều khiển rô bốt di động sử dụng thư viện OpenCV”.


Emai l : xuand xuanducdh ucdhcn@ cn@gmai l . c om 1

CHƯƠNG 1

GI ỚI THIỆU CHUNG 1.1. Giới thiệu chung về rô bốt

Rô bốt hay người máy là một loại máy có thể thực hiện những công việc một cách tự động bằng sự điều khiển của máy tính. Rô bốt là một tác nhân cơ khí, nhân tạo, thường là một hệ thống cơ khí-điện tử. Với sự xuất hiện và chuyển động của m ình, rô bốt gây cho người ta cảm giác rằng nó giác quan giống như con người. Từ "rô bốt" (người máy) thường được hiểu với hai ngh ĩa: rô bốt cơ khí và phần mềm tự hoạt động. Về lĩnh vực người máy, Nhật Bản là nước đi đầu thế giới về lĩnh vực này. Ngày nay rô bốt đang là tâm điểm của một cuộc cách mạng lớn sau Internet. Rô bốt ngày càng được sử dụng rộng r ãi trong l ĩnh vực công nghiệp, y tế, giáo dục đào tạo, giải trí, an ninh quốc phòng, thámhiểm không gian. Rô bốt là sản phẩm công nghệ có độ phức tạp cao, chứa hàm lượng tri thức vô cùng phong phú về tất cả các lĩnh vực của khoa học và công nghệ. Ngày nay, người ta vấn còn đang tranh cãi về vấn đề “Một loại máy như thế nào thì đủ tiêu chuẩn để được gọi là một rô bốt ?” M ột cách gần chính xác, rô bốt phải có một vài (không nhất thiết phải đầy đủ) các đặc điểm sau đây: 

Không phải là tự nhiên, tức là do con người sáng tạo ra.



Có khả năng nhận biết môi trường xung quanh.



Có thể tương tác với những vật thể trong môi trườ ng.





Có sự thông minh, có khả năng đưa ra các lựa chọn dựa trên môi trường và được điều khiển một cách tự động theo những tr ình tự đã được lập tr ình trước. Có khả năng điều khiển được bằng các lệnh để có thể thay đổi t ùy theo yêu cầu của người sử dụng.



Có thể di chuyển quay hoặc tịnh tiến theo một hay nhiều chiều.



Có sự khéo léo trong vận động.


Emai l : xuanducdhcn@gmai l . com 2

1.2. Giới thiệu rô bốt bám đối tượng

Hệ thống điều khiển rô bốt có thị giác được sử dụng để theo dõi mục tiêu di động trong các ứng dụng công nghiệp, quốc phòng và xã hội. Hệ thống thị giác có thể được phân thành 2 l ớp, theo như cấu trúc của hệ, đó là hệ có camera gắn cố định và hệ có camera gắn tr ên tay máy (eye-in-hand). Trong hệ camera cố định, camera được gắn cố định so với hệ toạ độ thực, thu thập ảnh của cả mục tiêu và cả môi trường. Mục tiêu của hệ này là cung cấp tín hiệu điều khiển sao cho tay máy đạt được vị trí mong muốn. Mục đích của cấu truc eye-in-hand là điều khiển tay máy sao cho ảnh của mục ti êu cố ì ở vị trí mong muốn trên mặt phẳng ảnh thu được. định hay di động luôn được duy tr Trên cơ sở ảnh thu được từ camera, được số hoá v à tích hợp trong vòng điều khiển phản hồi, hệ thống điều khiển các khớp của tay máy. Các nghiên cứu của môi trường động bị bỏ khá xa so với của môi trường tĩnh do bị ảnh hưởng khá lớn của tốc độ tính toán cũng như độ chính xác của việc phân tích ảnh. Do vậy có nhiều thuật toán để cải thiện tốc độ xử lý và xem xét đến các qu à trình nhiễu tác động lên quá trình thu thập h ình ảnh. Một thách thức của thị giác máy l à việc phân loại đối tượng. Một rô bốt có thể phải đối mặt với nhiều đối tượng khác nhau, trong khi đó chỉ có một mục tiêu quan tâm, còn các đối tượng khác th ì không. Để nhận biết được thông tin về vị trí của mục tiêu trong môi trường động, các đặc trưng của mục ti êu rất quan trọng. Các điểm lỗ, các góc cạnh, các đặc điểm h ình học của mục tiêu được phân tích qua quá tr ình nhận dạng. Đặc tính về trọng tâm của mục tiêu có thể tính dễ dàng qua moment bâc nhất trong môi trường tĩnh, nhưng trong môi trường động việc này rất khó v ì chi phí thời gian tính toán lớn.

Bài toán bám mục tiêu di động với quỹ đạo không biết trước yêu cầu phải giữ được đối tượng ở một vị trí nhất định trên mặt phẳng ảnh. Thuật toán CamShift được sử dụng để tính toán toạ độ trọng tâm của đối tượng.



Hình 1: PANrobot (nguồn: mobilerobot.org

Hình 2: Rô bốt MIDbo (nguồn: telepresenceoptions.com)



Hình 3: Rô bốt Pops (nguồn: slashgear.com)

Hình 4: Rô bốt thám hiểm sao hoả (nguồn: robot ics.youngester.com)



1.3. M ục tiêu của đồ án

Mục tiêu nghiên cứu của đồ án có thể chia thành hai phần như sau: Thứ nhất: Xây dựng phần mềm rô bốt di động bám đối tượng sử dụng OpenCV. Thuật toán được lựa chọn để sử dụng trong đồ án là thuật toán CamShift. Thứ hai: Xây dựng khối phần cứng để kiểm nghiệm giải thuật của thuật toán đ ã xây dựng sử dụng vi điều khiển PIC16F877A. Như vậy công việc chính của đồ án là: 

Tìm hiểu thư viện OpenCV.



Tìm hiểu về thuật toán CamShift.







L ập tr ình điều khiển rô bốt di động sử dụng thuật toán CamShift. Thiết kế mạch phần cứng và lập tr ình điều khiển động cơ sử dụng PIC16F877A. L ập tr ình truyền thông nối tiếp RS232.

1.4. Giới hạn của đồ án

- Đồ án tập trung chủ yếu vào xây dựng phần mềm điều khiển sử dụng thư viện OpenCV. - Rô bốt chỉ thực hiện việc bám đối tượng trong một số môi trường và đối tượng nhất định mà ít bị ảnh hưởng của nhiễu. - Mạch phần cứng và thuật toán điều khiển động cơ chỉ thực hiện việc điều khiển hướng của rô bốt, ngh ĩa là không điều khiển tốc độ của rô bốt. - Sử dụng lại phần cơ khí đồ án khoá trước đ ã xây dựng được.



CHƯƠNG 2

T ỔNG QUAN VỀ THƯ VIỆN OPENCV VÀ M ỘT SỐ LINH K I ỆN SỬ DỤNG TRONG KHỐI PHẦN CỨNG 2.1. Thế nào là thị giác máy

Thị giác máy là một lĩnh vực đa dạng và đang rất phát triển. Khái niệm thị giác máy (Computer vision) có liên quan tới nhiều ngành học và hướng nghiên cứu khác nhau. Từ những năm 1970 khi mà năng lực tính toán của máy tính ngày càng trở nên mạnh mẽ hơn, các máy tính lúc này có thể xử lý được những tập dữ liệu lớn như các hình ảnh, các đoạn phim th ì khái niệm và kỹ thuật về thị giác máy ngày càng được nhắc đến và nghiên cứu nhiều hơn cho tới ngày nay. Hiện tại, l ĩnh vực này được các chuyên gia đánh giá là vẫn còn mới mẻ và sẽ có rất nhiều thay đổi trong thời gian tới. L ĩnh vực nghiên cứu của thị giác máy rất rộng, và đặc điểm chung là các bài toán về thị giác máy tính đều không có một đề b ài chung và cách gi ải duy nhất. Mỗi giải pháp giải quyết vấn đều được một kết quả nhất định cho những trường hợp cụ thể. Ta có thể thấy sự tương quan giữa thị giác máy với các lĩnh khác. 2.2. Thư viện OpenCV 2.2.1. OpenCV là gì ?

OpenCV viết tắt của Open Source Computer Vision Library. Nó chứa hơn 500 hàm sử dụng trong thị giác máy. OpenCV là một thư viện mã nguồn mở (open source) http://sourceforge.net/. Thư viện được viết bằng ngôn ngữ C v à C++có thể chạy tr ên các hệ điều hành Linux, Window và Mac OS X. OpenCV được thiết kế để nâng cao hiệu suất tính toán v à nhấn mạnh đến hệ thống thời gian thực. Một điều tuyệt vời của OpenCV là nó đưa ra một hệ thống đơn giản, dễ sử dụng giúp mọi người nhanh chóng xây dựng các ứng dụng trong thị giác máy, kể cả các hệ thống kiểm tra trong nhà máy, bức ảnh trong lĩnh vực y học, bảo mật, rô bốt học v..v. Nó chứa các lập tr ình xử lý ảnh rất đơn giản, kể cả thực thi các hàmbậc cao như dò tìm khuôn mặt, theo dõi khuôn mặt, nhận dạng khuôn mặt, lọc Kalman. Yahoo: t hoi _chao_em_12325


K ể từ khi được giới thiệu vào tháng 1 năm 1999, OpenCV đã được sử dụng trong rất nhiều ứng dụng, các sản phẩm và các nghiên cứu. Ví dụ trong lĩnh vực hàng không vũ trụ, bản đồ web, sử dụng giảm nhiễu trong y học, phân tích đối tượng, an ninh, hệ thống dò tìm, theo dõi tự động và hệ thống bảo mật, quản lý hệ thống sản xuất, xử lý camera, ứng dụng trong quân sự, hệ thống h àng không không người lái, tr ên mặt đất, các tàu ngầm. Ngoài ra, nó còn được sử dụng trong nhận dạng âm thanh. OpenCV còn là một ch ìa khóa quan trọng trong các rô bốt sử dụng thị giác máy như Stanford, Asimo.

Hình 5: Quá trình phát triển của OpenCV

2.2.2. Vì sao lựa chọn OpenCV?

Thị trường thị giác máy đang ngày càng mở rộng và liên tục phát triển. Thư viện tiêu chuẩn sẽ tạo ra các ứng dụng mới và các giải pháp xử lý dễ dàng hơn. Đặc biết tối ưu khi sử dụng cấu trúc của Intel.

Tạo ra các mẫu ứng dụng bằng các thư viện được cập nhật thường xuyên và thực hiện được các thuật toán rất nặng như dò tìm khuôn mặt. Có rất nhiều công nghệ hiện đại và các công ty l ớn sử dụng thư viện OpenCV trong ứng dụng của m ình (điển hình như Intel, Microsoft, IBM, Siemens, Google v..v.) và các trung tâm nghiên cứu như (Stanford, MIT, CMU, Cambridge, INRIA…). Yahoo: t hoi _chao_em_12325


Hơn 14000 thành viên trên forum OpenCVyahoogroups.com với trung b ình 10 đến 20 bức thông điệp được trao đổi hàng ngày. Điều đó có thể khẳng định OpenCV thực sự đã góp phần vô cùng lớn trong lĩnh vực thị giác máy. 2.2.3. Cấu trúc và nội dung OpenCV như thế nào?

Để hiểu OpenCV làm việc như thế n ào chúng ta bắt đầu từ sự phân chia cấu trúc và nội dung của OpenCV ở 5 phần. Cấu trúc của OpenCV được chia thành 5 phần chính, 4 trong số đó được chỉ ra trong h ình 6.

CV (computer vision) là thành phần chứa những xử lý ảnh cơ sở và thuật toán thị giác máy ở mức cao. MLL (machine learning library) là thư viện machine learning, cái n ày bao gồm rất nhiều lớp thống k ê và gộp các công cụ xử lý.

HighGUI chứa các thủ tục vào ra và các hàm dùng cho vi ệc lưu trữ và tải ảnh video. CXCore chứa cấu trúc và nội dung dữ liệu cơ sở.

Hình 6: Cấu trúc cơ sở của OpenCV



2.2.4. Các hàmI/O trong OpenCV

OpenCV cung cấp các hàm mà cho phép chúng ta tương tác trực tiếp với hệ điều hành, các file hệ thống, các phần cứng như Webcam. Các hàm này nằm trong thư viện HighGUI, HighGUI cho phép mở một window, hiển thị bức ảnh, đọc các file liên quan đến đồ hoạ (ảnh, video) các file ảnh như jpg, bmp v..v. các fil e video như avi, wma, mp4, dat v..v. Ngoài ra nó còn xử lý các sự kiện chuột, b àn phím, OpenCV còn cho phép chúng ta lựa chọn thuật toán linh động hơn bằng cách cung cấp các h àm tạo thanh trượt slider, switch v..v. Để làm việc với OpenCV trước hết phải học các h àm trong thư viện này. Thư viện HighGUI có thể chia th ành 3 phần: phần cứng, phần file hệ thống v à phần GUI (Graphical User Interface) chúng ta có thể xem xét các phần trong thư viện HighGUI như sau.

Phần cứng: là phần thiết yếu nhất, liên quan đến hoạt động của Camera, trong phần lớn hệ điều hành việc tương tác với phần cứng rất khó khăn v à thực sự rất khó nhưng OpenCV cung cấp hàm đơn giản để thực hiện việc tương tác này ví dụ: cvCaptureFromCAM(). Phần file hệ thống: là khái niệm liên quan đến việc tải và lưu ảnh, một đặc điểm rất tuyệt vời trong thư viện HighGUI là cho phép chúng ta làm vi ệc với ảnh tương tự khi làm vi ệc với video. V ì vậy chúng ta có thể nhanh chóng tiếp cận với việc xử lý ảnh mà không mất nhiều thời gian cho việc tải, lưu ảnh, video. Phần GUI: là hệ thống cửa sổ (Window), thư viện cung cấp mộ t số hàm đơn giản mà cho phép chúng ta mở một window hiển thị ảnh tr ên window này. Ngoài ra nó còn cho phép chúng ta thực thi các sự kiện nhận được từ chuột và bàn phím. Một số hàm đơn giản thường xuyên sử dụng trong thư viện HighGUI như sau: 





Đầu tiên chúng ta cần học cách làm thế nào để đọc và viết các files ảnh, chụp video chuyển đổi giữa các định dạng m àu, và truy cập dữ liệu điểm ảnh tất cả qua giao diện OpenCV. Đọc và viết một bức ảnh.

Bức ảnh vào/ra thì rất dễ dàng trong OpenCV , để đọc một file ảnh, đơn giản gọi h àm cvLoadImage(tên file). OpenCV hỗ trợ hầu hết các định dạng phổ b iến



kể cả JPEG, PNG và BMP. Bạn không cần cung cấp thông tin định dạng. cvLoadImage() tự động quyết định dạng file thông qua file header này. 











Để viết một bức ảnh đến một f ile, ta dùng hàm cvSaveImage(). Hàm này cũng tự quyết định file định dạng, để sử dụng từ tên file mở rộng.

Cả cvLoadImage và cvSaveImage đều nằm trong module HighGUI . Khi bạn sử dụng xong bức ảnh đầu vào nhận được từ cvLoadImage(), loại bỏ nó bằng hàm cvReleaseImage(). Hàm này đưa ra một địa chỉ của con trỏ giống đầu vào của nó bởi việc nó làm là loại bỏ an to àn (Safe Release). Nó chỉ loại bức ảnh này khi bức ảnh là non-null. Sau khi loại bỏ xong nó đặt giá trị con trỏ về 0. Làm việc với Video tương tự như là việc với ảnh. Nhận các frame từ một webcam, hay các thiết bị video số khác thì dễ dàng như tải nó lên từ một file có sẵn. Để nhận một khung từ camera ta chỉ việc thay cvCreateFileCapture() bằng hàm cvCreateCameraCapture(). Chúng ta có thể tạo cvCapture*Object với cvCreateFileCapture(). Chúng ta sử dụng cvQueryFrame () để nhận từng frame và cvWaitkey(33) để chờ 33ms giữa từng frame. Chúng ta sử dụng cvReleaseCapture() để loại bỏ capture khi ngừ ng sử dụng.



Copy một bức ảnh.



Lưu trữ bức ảnh trong OpenCV.



OpenCV lưu bức ảnh giống cấu trúc C, IplImage, Ipl viết tắt của image processing library.

Kiểu dữ liệu IplImage được định nghĩa trong CXCORE. Thêm vào dữ liệu ảnh thực, nó chứa một số đặc điểm để mô tả như sau: 

Width - độ rộng bức ảnh tính theo pixel.



Height - độ cao bức ảnh tính theo pixel.



Depth - một kiểu tiền định nghĩa chỉ r õ lượng bits/pixel/channel.

Ví dụ : Depth=IPL_DEPTH_8U, dữ liệu cho mỗi pixel k ênh ảnh được lưu giữ như 8-bits không dấu. Yahoo: t hoi _chao_em_12325




nChannel – số lượng của dữ liệu channel ảnh (từ 1 - 4). M ỗi một channel chứa một kiểu của pixel dữ liệu. ví dụ: bức ảnh RGB có 3 kênh R (đỏ), G (xanh lá cây), B (xanh da trời).







Grayscale là bức ảnh chỉ chứa một kênh điểm ảnh sáng nhất. Truy cập giá trị điểm ảnh. Chúng ta có thể tạo ra rất nhiều hàm truy cập điểm ảnh mà không cần tác động trực tiếp đến dữ liệu ảnh thô. Cách dễ nhất để đọc từng điểm ảnh riêng lẻ là sử dụng hàm cvGet2D.





cvScalar cvGet2D(const *CvArr, int row, int col). Hàm này có 3 thuộc tính: một pointer trỏ đến dữ liệu chứa trong CvArr*, một mảng chỉ r õ vị trí hàng và cột. Hàng topmost của điểm ảnh là row=0, và bottommost là row=height-1. 2.2.5. Các hàmthực hiện xử lý ảnh

Thư viện HighGUI chỉ cung cấp các h àm thực hiện v ào ra bức ảnh tuy nhiên vấn đề xử lý ảnh mớ i thực sự là quan trọng và khó khăn. OpenCV cung cấp các hàm thực hiện xử lý ảnh nằm trong thư viện cv . Một bức ảnh không chỉ đơn giản là một mảng giá trị màu sắc. khi chúng ta đề cập đến xử lý ảnh th ì nó đã bao gồm các hàm xử lý liên quan đến cấu trúc của bức ảnh .

Một số hàm xử lý ảnh thường xuyên sử dụng như sau: 

Smoothing (làm mịn).

Smoothing hay còn gọi là blurring nó là một thuật toán xử lý ảnh đơn giản và thường xuyên sử dụng. Có rất nhiều nguyên nhân chúng ta dùng đến smoothing nhưng nó thường dùng để loại bỏ nhiễu do máy ảnh sinh ra. Smoothing quan trọng khi bạn muốn giảm độ phân giải của một bức ảnh theo rất nhiều cách khác nhau. Bằng việc thay thế kiểu smooth và các thông số sẽ có các bức ảnh tương đối khác nhau tuy theo mục đích sử dụng nhưng thường dùng nhất vẫn là CV_GAUSSIAN. 

Image morphology (hình thái học bức ảnh).

OpenCV cung cấp h àm chuyển đổi morphology nhanh chóng và tiện lợi khi làm việc với bức ảnh. Cơ bản của mor phology là dilation (giãn) và erosion (co) chúng ngày Yahoo: t hoi _chao_em_12325


càng được sử dụng rộng rãi trong việc loại bỏ nhiễu, cô lập những thành phần riêng rẽ, và liên kết các thành phần với nhau. 

Theshold (ngưỡng).

Chúng ta thường làm rất nhiều bước xử lý ảnh khác nhau và đưa ra những quyết định cuối cùng về điểm ảnh trên một bức ảnh hay nói cách khác là loại bỏ giá trị phía trên hoặc dưới một ngưỡng nào đó giữ lại nhưng điểm ảnh nằm trong khoảng giá trị mong muốn lúc đó ta dùng hàmthreshold. 2.2.6. Các hàmHistograms and Matching 

Histogram.

Trong việc phân tích h ình ảnh thông tin về đối tượng và video, chúng ta thường muốn biểu diễn chúng giống như là một histogram. Histogram có thể sử dụng để biểu diễn rất nhiều dạng khác nhau như phân bố màu của đối tượng, độ dốc mẫu cạnh của một đối tượng, hay xác suất phân bố vị trí của đối tượng. Tìm histogram được sử dụng rất nhiều trong các chươ ng trình ứng dụng thị giác máy tính. Histogram được sử dụng để d ò tìm sự thay đổi giữa các cảnh trong video bằng cách đánh dấu khi cạnh và màu sắc thay đổi từ khung này đến khung khác. Chúng sử dụng để nhận dạng nhưng điểm quan tâm tr ên một bức ảnh bằng cách gán mỗi điểm ảnh một “tag” chứa những Histogram của những đặc điểm gần nhất. Histogram của cạnh, màu, góc và rất nhiều đặc điểm khác. Một chuỗi các màu sắc, cạnh có thể dùng để xác nhận dù có hay không một video đ ã được copy tr ên web. 

Ghép mẫu template matching.

Hàm ghép cvMatchTemplate() không dựa tr ên histogram, hơn nữa, h àm này ghép một bức ảnh thực đến một bức ảnh đầu vào bằng cách “Sliding” đường dẫn qua bức ảnh đầu vào này sử dụng thao tác ghép mô tả trong phần n ày. 2.2.7. HàmContours

Mặc d ù thuật toán như dò tìm cạnh candy có thể sử dụng để tìm ra cạnh pixel để phân bức ảnh th ành các phần khác nhau. Bước tiếp theo là xây dựng các cạnh này thành contours.



2.2.8. Cơ sở toán học của thuật toán CamShift

Camshift viết gọn của “Continuously Adaptive Mean Shift” là cơ sở của thuật toán theo dõi khuôn mặt trong OpenCV. Nó bao gồm thuật toán cơ sở Mean Shift với thích ứng các bước thay đổi kích cỡ của vùng. Nhân là một hàm step đơn giản nằm trong một bản đồ vỏ xác suất (skin -probability). Vỏ xác suất của mỗi một điểm ảnh được tính toán dựa tr ên màu sắc bằng cách sử dụng một phương pháp gọi là Histogram backprojection. Màu sắc được đưa ra như Hue từ mô h ình màu HSV. K ể từ nhân là một hàm step, Mean Shift ở mỗi một lần lặp th ì chỉ đơn giản là giá trị trung b ình x và y của vỏ xác suất đóng góp trong vùng hiện tại. Điều này được xác định bằng cách chia moment thứ nhất của vùng này cho moment thứ không ở mỗi lần lặp và dịch chuyển vùng đến trọng tâm xác suất. Sau khi Mean Shift hội tụ đến một vị trí (x,y), phạm vi của vùng được cập nhật dựa tr ên giá trị hiện tại của moment thứ 0. Giá trị của bản cập nhật này có thể thay đổi, phạm vi tuyến tính của nó được giả định là tỉ lệ thuận với căn bậc 2 của tổng của các khoản đóng góp xác suất của khu vực hiện tại (ví dụ. Moment thứ không). Chiều rộng và chiều dài tại thời điểm thứ i sẽ được tính thông qua giá trị tại thời điểm thứ i -1, ngh ĩa là giá trị trước đó. Trong thuật toán CamShift, một bức ảnh về xác suất phân bố màu sắc của bức ảnh trong chuỗi video được tạo ra. Đầu tiên nó tạo ra một mẫu mô tả hue sử dụng một biểu đồ màu sắc (color Histogram) và sử dụng không gian màu Hue Saturation Value (HSV) được tham chiếu từ không gian màu tiêu chuẩn RGB. V ì phân bố màu sắc của các bức ảnh trong video thay đổi theo thời gian, n ên thuật toán CamShift đã được sửa đổi để dễ dàng thích ứng với sự thay đổi phân bố xác suất màu sắc của mục tiêu nó theo dõi. Trong OpenCV thuật toán CamShift được điều chỉnh từ thuật toán Mean Shift. Và nó đươc tính toán như sau: 1) Chọn vị trí ban đầu của Search Window. 2) Dùng thuật toán Mean Shift (lặp lại một hoặc nhiều lần), lưu moment thứ 0 này. 3) Đặt kích cỡ của cửa sổ tìm kiếm bằng một hàm của moment thứ 0 tìm được trong bước 2. 4) L ặp lại bước 2 và 3 cho đến khi hội tụ (vị trí dịch chuyển chính ít hơn giá trị threshold hiện tại). Yahoo: t hoi _chao_em_12325


2.3. Cơ bản về PIC16F877A 2.3.1. PIC là gì ?

PIC là vi ết tắt của “Programable Intelligent Computer”, tạm dịch là “ Máy tính thông minh khả tr ình” do hãng Microchip Technology đặt tên cho vi điều khiển đầu tiên của họ và phát triển thành dòng họ vi điều khiển PIC sau này. 2.3.2. Đặc điểm nổi bật của PIC16F877A 













Sử dụng công nghệ tích hợp RISC CPU. Người sử dụng có thể lập tr ình với 35 câu lệnh cơ bản. Tất cả câu lệnh thực hiện trong một chu kỳ lệnh , ngoại trừ một số câu lệnh rẽ nhánh thực hiện trong 2 chu kỳ lệnh. Tốc độ hoạt động xung đồng hồ l à DC-20MHZ. Bộ nhớ hoạt động là flash 8kx14 words. Bộ nhớ RAM 368x8 bytes. Bộ nhớ EFPROM 256x8 bytes.

- Khả năng của bộ vi xử lý này. 



























Khả năng ngắt lên đến 14 ngắt trong và ngắt ngoài. Ngăn nhớ Stack được phân chia l àm 8 mức. Truy cập bộ nhớ bằng địa chỉ trực tiếp hoặc gián tiếp. Nguồn khởi động (POR). Bộ tạo xung (PWRT) và bộ tạo dao động (OST). Bộ đếm thời gian (WDT) với nguồn dao động tr ên chíp (nguồn dao động RC) hoạt động đáng tin cậy. Có mã chương tr ình bảo vệ. Phương thức cất giữ SLEEP. Có bảng lựa chọn dao động. Công nghệ CMOS FLASH/EFPRO nguồn mức thấp tốc độ cao. Thiết kế hoàn toàn t ĩnh. Mạch chương tr ình nối tiếp có 2 chân. Mạch xử lý đọc ghi tới bộ nhớ chương tr ình. Dải điện thế hoạt động 2.0 đến 5.5V.









Nguồn điện sử dụng 25mA. Dãy nhiệt độ công nghiệp và thuận lợi. Công suất tiêu thụ thấp.

- Các đặc tính nổi bật của thiết bị ngoại vi tr ên Chip. 





TIMER0: 8 bits của bộ định thời, bộ đếm với hệ số tỉ lệ trước. TIMER1: 16 bits của bộ định thời, bộ đếm với hệ số tỉ lệ trước, có khả năng tăng trong khi ở chế độ sleep qua xung đồng hồ được cung cấp b ên ngoài. TIMER2: 8 bits của bộ định thời, bộ đếm với 8 bits của hệ số tỉ lệ trước, hệ số tỉ lệ sau.

2.3.3. Sơ đồ các chân của PIC16F877A

Hình 7: PIC16F877A



- Sơ đồ khối vi điều khiển PIC16F877A.

Hình 8: Sơ đồ khối của PIC16F877A



Đặc điểm: 























Chân 13, 14 là các chân kết nối với thạch anh tạo dao động cho chip (Nó được ví như là quả tim của chíp). Ta mắc thêm vào 2 tụ điện có điện dung =33pF để tăng độ ổn định cho dao động thạch anh. PORTB vì PORTB l úc này đóng vai trò là ngõ xuất nên các thanh ghi TRISB trong chíp phải được đặt giá trị logic 1 (Nếu ta đặt ngõ B là ngõ nhập th ì ta phải đặt giá trị logic 0). Các thông số cần thiết khi làm việc với PIC ta dùng bảng datasheet của họ PIC16F877A. VDD: Là điện áp cấp nguồn cho vi điều khiển, nguồn điện cấp l à 5V. GND: Là chân nối mass khi sử dụng cần thiết kế một mạch ổn áp để bảo vệ cho vi điều khiển , thường sử dụng IC ổn áp 7805. PORTA: Có 6 pin từ chân 2 đến chân 7. PORTB: Có 8 chân từ 34 đến 40, ngoài chức năng làm cổng xuất nhập còn có thêm một số chức năng phụ khác. PORTC, PORTE: Tương tự như PORTB. Chân Reset (MCLR): Ngõ vào ở chân 1 dùng để thiết lập điều kiện đầu cho vi điều khiển. OSC1, OSC2: Hai chân này được sử dụng để nhận nguồn xung clock từ bên ngoài cụ thể là từ thạch anh dao động. Các chân RC3, RC4 dùng để kết I2C. Các chân RC6, RC7 là chân kết nối RS232.

2.4. Giao tiếp RS232

Chuẩn giao tiếp RS232. Vấn đề giao tiếp giữa PC và vi điều khiển rất quan trọng trong các ứng dụng điều khiển, đo lường v..v. ghép nối qua cổng nối tiếp RS232 là một trong những kỹ thuật được sử dụng rộng r ãi để ghép nối các thiết bị ngoại vi với máy tính. Nó là một chuẩn giao tiếp nối tiếp dùng định dạng không đồng bộ, kết nối nhiều nhất là 2 thiết bị, chiều dài kết nối lớn nhất cho phép để đảm bảo truyền, nhận dữ liệu là 12.5m đến 25.4m, tốc độ 20kbit/s, đôi khi là tốc độ 115kbit/s với một số thiết bị đặc biệt. Yahoo: t hoi _chao_em_12325


Ở đây tôi chọn chuẩn giao tiếp RS232 và điều khiển Active X Microsoft

Communication 6.0 (MSComm). 



Thiết lập giao diện cho chương tr ình. Viết mã cho chương tr ình.

Giao diện của RS232-9-pin và chức năng các chân như sau: - Chân 1: Data Carrier Detect (DCD): phát tín hiệu mang dữ liệu. - Chân 2: Receive Data (RXD): Nhận dữ liệu. - Chân 3: Transmit Data (TxD): Truyền dữ liệu. - Chân 4: Data Terminal Ready (DTR): Đầu cuối dữ liệu sẵn sàng kích hoạt bởi bộ phận khi muốn truyền dữ liệu. - Chân 5: Signal Ground (SG): mass của tín hiệu. - Chân 6: Data Set Ready (DSR): Dữ liệu sẵn sàng, được kích hoạt bởi bộ nhận khi nó muốn truyền dữ liệu. - Chân 7: Request to Send: Y êu cầu gửi bộ truyền đặt đường này lên mức hoạt động khi sẵn sàng truyền dữ liệu. - Chân 8: Clear to Send (CTS): Xoá để gửi bộ nhận đặt đường này lên mức hoạt động để thông báo bộ truyền là nó đ ã sẵn sàng nhận tín hiệu. - Chân 9: Ring Indicate (RI): Báo chuông cho bi ết l à bộ nhận đang nhận tín hiệu chuông.

Hình 9: Cổng giao tiếp RS232



2.5. Giới thiệu về chíp mạch cầu L298N

IC L298N là mạch tích hợp đơn chíp có vỏ công suất 15 chân (multi watt 15). L à IC mạch cầu đôi có khả năng hoạt động ở điện áp cao, dòng cao. Nó có 2 chân enable có chức năng cho phép hoặc không cho phép chíp hoạt động, độc lập với chân tín hiệu vào. Cực p hát (emitter) của transitor dưới của mỗi mạch cầu được nối với nhau và nối ra chân ngoài để nối với mạch điện trở cảm ứng dòng khi cần. Nó có thêm một chân cấp nguồn giúp mạch logic có thể cấp nguồn ở điện thế thấp hơn. Bảng 1: Chức năng các chân của L298N

MW. 15

Tên

1; 15

Sensor A; Sensor B

2; 3

Out 1; Out 2

4

VS

5; 7

Input 1; Input 2

Chức năng Nối chân này qua điện trở cảm ứng dòng xuống GND để điều khiển dòng tải Ngõ ra của cầu A. Dòng của tải mắc giữa 2 chân n ày được quy định bởi chân 1. Chân cấp nguồn cho tầng công suất, cần có một tụ điện cảm kháng 100nF nối giữa chân này và chân GND Chân ngõ vào của cầu A, tương thích chân TTL

6; 11

Enable A; Enable B

8

GND

Chân mass

9

VSS

Chân cấp nguồn cho khối logic. Cần có tụ điện 100nF giữa chân này với chân GND

10; 12

Input 3; Input 4

Chân ngõ vào Enable tương thích chuẩn TTL. M ức thấp của chân này sẽ cấm ngõ ra cầu A, đối với enable A; hoặc ngõ ra cầu B đối với enable B;

Các chân logic ngõ vào của B



13; 14

Output 3;

Ngõ ra của cầu B, dòng của tải mắc giữa 2 chân n ày được quy định bởi chân 15.

Output 4

Sơ đồ chân

Hình 10: Chíp mạch cầu L298N

- Bảng điều khiển động cơ sử dụng L298N Ta có thể thay đổi trạng thái động cơ dựa vào bảng sự thật sau (Input 1; Input 2), ở đây tôi luôn để mức ra ở chân cho phép (enable) là mức cao. Bảng 2: Tómtắt nguyên tắc điều khiển động cơ sử dụng L298N

Chiều điều khiển

Input 1

Input 2

Dừng lại

0

0

Quay thuận

0

1

Quay ngược

1

0

Dừng lại

1

1

Vì vậy, để điều khiển động cơ chỉ cần điều khiển giá trị xuất ra từ cổng của PIC16f877A ở hai chân nối với Input 1 v à Input 2. Yahoo: t hoi _chao_em_12325


CHƯƠNG 3

XÂY DỰNG PH ẦN MỀM ĐIỀU KHIỂN Sơ đồ tổng quát của rô bốt di động

Hình 11: Sơ đồ khối tổng quát của rô bốt

3.1. Thị giác máy điều khiển rô bốt di động bám đối tượng

Mục tiêu của đồ án là điều khiển rô bốt bám theo một đối tượng sử dụng OpenCV. Nó phải duy tr ì được khoảng cách nhất định giữa rô bốt và đối tương, khi đối tượng di chuyển rô bốt phải di chuyển theo dựa v ào hình ảnh thu được từ webcam để xác định đối tượng đi thẳng, rẽ phải, rẽ trái, đi tiến, đi lùi v..v. Ngh ĩa là chúng ta phải điều khiển cả tốc độ và hướng của rô bốt tuy nhiên trong đồ án này tôi chỉ điều khiển hướng, tốc độ của đối tượng có thể xem là không đổi. Để làm được việc này, chúng ta phải nhận dạng được đối tượng và xác định được hướn g di chuyển của nó. Thứ hai phải xây dựng thuật toán bám đối tượng. Thứ ba là phải xây dựng được phần cứng để kiểm định thuật toán CamShift. Có rất nhiều cách để d ò tìm đối tượng ví dụ dựa tr ên hình dáng, âm thanh v..v. những thuật toán này thực sự rất phức tạp. Để giảm độ khó của thuật toán theo dõi chúng ta đặt phía sau đối tượng một vật có những thuộc tính về màu sắc đặc biệt ví dụ Yahoo: t hoi _chao_em_12325


bóng đèn led phát sáng màu đỏ, màu vàng, màu xanh v..v. Như vậy, lúc tiến h ành theo dõi sẽ giảm được rất nhiều về việc xử lý nhiễu do nền và các đối tượng không mong muốn gây ra, giảm đáng kể sự nhầm lẫn đối tượng theo dõi. Chương tr ình xử lý ảnh sử dụng thuật toán CamShift trong OpenCV để tiến h ành theo dõi căn cứ vào màu sắc đối tượng. Khoảng cách giữa rô bốt và đối tượng chúng ta đặt là cố định, dựa vào tâm của đối tượng tìm được qua thuật toán CamShift chúng ta biết được vị trí của đối tượng tham chiếu tr ên mặt phẳng ảnh. Các thuộc tính nhận được sẽ truyền qua cổng giao tiếp RS232 xuống vi điều khiển PIC16f877A để điều khiển hướng động cơ một chiều (DC) thông qua mạch cầu điều khiển động cơ L298N.

3.2. Thuật toán tính hướng và kích cỡ của đối tượng cần theo dõi 3.2.1. Thuật toán chung

Hình 12: Sơ đồ thuật toán chung



3.2.2. Nhận dạng và bámmục tiêu di động

Cấu trúc của hệ bám mục tiêu di động gồm hai phần chính. Phần thứ nhất là phần xử lý ảnh dựa vào chuỗi h ình ảnh thu được từ webcam để nhận dạng và tính toán vị trí của đối tượng quan tâm. Phần thứ hai là phần điều khiển, dựa vào thông tin vị trí đối tượng nhận được trong mặt phẳng ảnh, tính toán tín hiệu điều khiển rô bốt sao cho đối tượng di chuyển được duy tr ì ở một vị trí nhất định tr ên mặt phẳng ảnh và ở một khoảng cách nhất định. Để giảm ảnh hưởng của nhiễu v à giảm khối lượng tính toán trong xử lý ảnh nên các bước xử lý ảnh nhận dạng, thích nghi cũng được sử dụng. Các bước n ày sẽ được trình bày lần lượt như dưới đây.

Nhận dạng mục tiêu là bước quan trọng đầu ti ên trong hệ thống bám mục tiêu di ình này là lưu giữ các giá trị thuộc tính của đối tượng đã động. Mục tiêu của quá tr được chọn như đã nói ở tr ên các thuộc tính đó như cạnh, góc, các thuộc tính về màu sắc v..v. Trên cơ sở đó để so sánh nhằm phân biệt mục ti êu với nền và các mục tiêu khác. Qua đó xác định được vị trí của mục tiêu trên mặt phẳng ảnh. Trong quá trình tìm kiếm ta chia bức ảnh thành tập hợp các pixel bao gồm hai th ành phần hoặc thuộc đối tượng hoặc thuộc nền. Qua đó ta tiến h ành xử lý các giá trị thuộc tính của đối tượng trong vị trí mới và tìm nhận dạng được đối tượng cần theo dõi. Mặt phẳng ảnh là mặt phẳng có gốc nằm phía tr ên bên trái, trục x là trục nằm ngang, trục y là trục thẳng đứng như h ình vẽ.

Hình 13: Mặt phẳng ảnh



Căn cứ vào vị trí dịch chuyển của đối tượng tr ên mặt phẳng ảnh so với gốc toạ độ mà ta tính toán các khả năng di chuyển của rô bốt sao cho đối tượng nằm ở một vị trí bất kỳ tr ên mặt phẳng ảnh.

Tính toán vị trí của mục tiêu di động trong môi trường có nhiễu sử dụng thuật toán CamShift. Căn cứ vào kết quả thu được về giá trị tâm của đối tượng qua thuật toán CamShift đề xuất thuật toán di chuyển như sau. Hình vẽ sau mô tả các vị trí tương ứng của đối tượng tr ên mặt phẳng ảnh với điều kiện di chuyển.

Hình 14: Biểu diễn đối tượng di chuyển tr ên mặt phẳng ảnh

3.2.3. Chuyển đổi không gian màu từ RGB đến HSV

Chúng ta sử dụng hàm cvCvtColor() để chuyển đổi giữa các không gian màu trong OpenCV không gian màu chính là số lượng các k ênh hay là chuyển đổi từ không gian màu này đến không gian m àu khác. H: (Hue) vùng màu. S: (Saturation) Độ bão hoà màu. V( hay B): Độ sáng.



K ết quả chuyển đổi trong không gian m àu.

Hình 15: Chuyển đối không gian màu RGB đến HSV 3.2.4. Histogram

Trong việc nhận dạng đối tượng, bức ảnh và thông tin video, chúng ta thường muốn mô tả đối tượng dưới dạng biểu đồ (Histogram) để dễ quan sát. Histogram có thể được sử dụng để chỉ ra sự khác nhau giữa các đối tượng về m àu sắc, góc, cạnh các mẫu G radient cạnh của đối tượng và chỉ ra xác suất phân bố màu sắc. Trong mỗi một khung vùng màu mà chúng ta quan tâm được tính toán ở khung h ình tiếp theo sau đó một chuỗi các khung hình liên tiếp sẽ được theo dõi với Histogram. Histogram của đối tượng là duy nhất nếu giá trị Histogram mới nhận được gần với giá trị histogram nhất thì đối tượng đó sẽ được chọn. Tạo một Histogram Camshift theo dõi đối tượng dựa căn cứ vào việc so sánh Histogram màu sắc của đối tượng nhận được với giá trị của thuộc tính ở vị trí mới nên việc tạo một Histogram là điều thiết yếu đầu tiên trong mục đích nhận dạng đối tượng.

Hình 16: Histogram



Quan sát hai Histogram của đối tượng trong h ình trên cho ta thấy thuộc tính màu sắc của hai đối tượng mà chúng ta cần theo dõi. Mỗi thanh m àu chỉ r õ có bao nhiêu pixel có giá trị “hue”. Hue là một trong ba thuộc tính mô tả màu của pixel trong không gian màu HSV (Hue, Saturation, Value). 3.2.5. Lọc nhiễu Filter

L ọc th ì được sử dụng để loại bỏ nhiễu, có nhiều nguyên nhân phát sinh nhi ễu trong quá trình xử lý ảnh. Ngoài ra lọc nhiễu còn quan trọng trong việc chúng ta giảm độ phân giải của bức ảnh. Có rất nhiều cách để chúng ta loại bỏ nhiễu, trong đồ án này, do đối tượ ng theo dõi là vật bất kỳ n ên tôi đặt các loại nhiễu thông thường qua đó sẽ tuỳ chỉnh tuỳ thuộc vào đối tượng nhận được. K ết quả lọc nhiễu sử dụng trong đồ án như sau.

Hình 17: kết quả trước và sau khi lọc nhiễu



3.2.6. Thuật toán CamShift

Trong phần này tôi sẽ tr ình bày việc d ùng thuật toán CamShift để theo dõi mục tiêu di động.

Hình 18: Sơ đồ thuật toán CamShift

1) Histogram. Đầu tiên một Histogram sẽ được tạo ra, Histogram này chứa các thuộc tính liên quan đến màu sắc như đã trình bày ở phần tr ên. Tiếp theo, tâm của và kích cỡ của mục tiêu được tính toán để theo dõi mục tiêu khi hình dạng và kích cỡ của nó thay đổi.

2) Tính toán xác suất phân bố của mục tiêu căn cứ vào Histogram nhận được Histogram được tạo ra duy nhất một lần, lúc bắt đầu theo dõi. Sau đó nó được sử dụng để gán cho “xác suất đối tượng” giá trị mỗi điểm ảnh trong khung video tiếp theo. 3) Dịch chuyển đến vị trí mới với mỗi khung h ình vừa nhận được từ video, CamShift sẽ “dịch chuyển” đến vị trí mà nó ước lượng trên đối tượng nó sẽ mà tập trung nhiều điểm sáng nhất trong bức ảnh xác suất. Nó tìm vị trí mới bắt đầu từ vị trí trước đó và tính toán giá trị trọng tâm của xác suất phân bố bên trong một h ình chữ nhật. Sau đó nó dịch chuyển vị trí của h ình chữ nhật về trọng tâm vừa tìm được. OpenCV sử dụng hàm cvCamShift() để thực hiện chuyển dịch này. Việc tính toán trọng tâm trong Camshift th ì dựa vào thuật toán Mean Shift như đã đề cập trước đó.



K ết quả tính toán tâm đối tượng khi dùng thuật toán CamShift.

Hình 19: K ết quả tính toạ độ tâm bằng thuật toán CamShift

Dựa vào giá trị x, y vừa tìm được n ày ta có thể điểu khiển rô bốt chạy bám đối tượng. K ết quả theo dõi đối tượng.

Hình 20: K ết quả bước đầu theo d õi đối tượng bằng thuật toán CamShift

Dựa vào kết quả nhận đươc như trên , ta sẽ gửi tín hiệu điều khiển n ày qua cổng kết nối RS232 để điều khiển rô bốt di động. Yahoo: t hoi _chao_em_12325


3.2.7. Thiết kế hoàn chỉnh phần mềm điều khiển

Chương tr ình được thiết kế tr ên visual C++2008 (MFC Aplication). Giao di ện chương tr ình điều khiển được chia th ành 3 khối chính như trên h ình sau.

- DIEU KHIEN ROBOT. Khối được xây dựng có chức năng điều khiển rô bốt quay phải, quay trái, đi tiến đi lui v..v. Đặc biệt nút lệnh “Tự động” được tính hợp chương tr ình xử lý ảnh OpenCV như đã nói ở tr ên. - MO CONG COM: Khối có chức năng thực hiện việc giao tiếp RS232 giữa PIC16F877A và laptop. - DIEU KHIEN DONG CO DC. Khối thực hiện việc điều khiển động cơ một chiều. - Vmin: giá trị nhỏ nhất độ sáng của bức ảnh. - Vmax: giá trị lớn nhất độ sáng của bức ảnh. - Smin: giá trị bão hòa của bức ảnh. - Dilate: giá trị giãn của các thành phần ảnh. - Erode: giá trị co lại của thành phần ảnh. - Filter: các hàm lọc khác nhau sử dụng trong chương tr ình. - Histogram: giá trị histogram của đối tượng. - Backproject: quan sát bức ảnh từ phía sau.



Hình 21: Giao di ện phần mềm thiết kế hoàn chỉnh



Hình 22: K ết quả thử nghiệm với phần mềm



Hình 23: K ết quả thử nghiệm với phần mềm



CHƯƠNG 4

XÂY DỰNG M ẠCH PHẦN CỨNG 4.1. Sơ đồ mạch dùng trong đồ án

Mạch phần cứng được chia thành 4 khối: - Khối điều khiển trung tâm sử dụng PIC16F877A. - Khối nguồn. - Khối điều khiển động cơ. - Khối truyền thông RS232. 4.1.1. Khối điều khiển trung tâm

Khối điều khiển trung tâm là khối có chức năng điều khiển chính trong khối phần cứng bao gồm điều khiển động cơ và giao tiếp RS232. PIC16F877A được lựa chọn sử dụng trong đồ án đảm nhận chức năng khối điều khiển n ày.

Hình 24: Sơ đồ khối điều khiển trung tâm



Trong khối phần cứng dùng PIC16F877A để điều khiển động cơ. Cờ ngắt d ùng trong việc truyền nhận dữ liệu giữa PC và PIC16F877A. 4.1.2. Khối nguồn

Hình 25: Sơ đồ khối nguồn

Khối nguồn có chức năng lấy điện áp 12V từ Acqui điện áp này được đưa qua IC7805 để chuyển đổi thành điện áp 5V cung cấp nguồn cho PIC16F877A. 4.1.3. Khối truyền thông RS232

Hình 26: Sơ đồ khối truyền thông RS232

Khối n ày có nhiệm vụ nhận tín hiệu điều khiển từ cổng RS232 của laptop truyền xuống cho PIC16F877A điều khiển hoạt động của rô bốt.



4.1.4. Khối điều khiển động cơ

Khối này có thành phần chính là một mạch cầu L298N có chức năng điều khiển hoạt động của các động cơ rô bốt. Nguyên tắc hoạt động của L298N như đ ã trình bày ở phần tr ên. J 5 +5V VIN2_motor2 EN_motor2 IN1_motor2 IN2_Motor1 EN_motor1 IN1_Motor1

8 7 6 5 4 3 2 1

J 3 2 1

C2 CAP NP

CON2 CON8 U1

D1

R3 Resistor 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1

15 14 13 12 11 10 9 8 7 6 5 4 3 2 1

DIODE

D2 DIODE

D3 DIODE

D4 DIODE

R1 RESISTOR J 1

IN2_motor2 EN_motor2 IN1_motor2 +5V

D9

V-

VIN2_Motor1 EN_motor1 IN1_Motor1

1 2

LED V+

V+

CON2

D10 DIODE V+

R2 D5 DIODE

D6 DIODE

D7 DIODE

D8 DIODE

Resistor L298 J 4 2 1

C3 CAP NP

CON2

Hình 27: Sơ đồ nguyên lý mạch cầu điều khiển động cơ

Sau khi hoàn thiện các khối điều khiển ta xây dựng được mạch điều khiển phần cứng hoàn thiện như sau. 4.1.5. Phần cứng hoàn chỉnh

Hình 28: Sơ đồ phần cứng hoàn chỉnh



4.2. T ập lệnh điều khiển rô bốt Bảng 3: Tập lệnh điều khiển rô bốt

L ệnh

Động cơ 1

1

Tiến

2

Lùi

3

Dừng lại

Động cơ 2

4

Tiến

5

Lùi

6

Dừng lại

Rô bốt

f

Tiến

Tiến

Đi thẳng

b

Lùi

Lùi

Đi lùi

s

Dừng

Dừng

Dừng lại

r

Tiến

Lùi

Rẽ phải

l

Lùi

Tiến

Rẽ trái



CHƯƠNG 5

K ẾT QUẢ TH ỰC HIỆN K ết quả được thử nghiệm trong môi trường sau:

-

Operating System: Window7 Ultimate. Processor: Intel® Core™2 CPU T5500 @ 1.66GHz 1.67 GHz. Installed memory (RAM): 2.00 GB. System type: 32-bit Operating System. Webcam: sony visual communication camera VGP-VCC4.

Môi trường tĩnh: rô bốt đứng yên đối tượng di chuyển phía trước rô bốt, môi trường tĩnh dùng để kiểm tra độ chính xác, tốc độ đáp ứng và độ tin cậy của thuật toán đã xây dựng. Môi trường động: rô bốt di chuyển bám theo đối tượng, qua đó sẽ kiểm tra được khả năng đáp ứng và độ tin cậy của to àn hệ thống để đưa ra các điều chỉnh phù hợp vớ i bài toán thực tế.

Thử nghiệm trong môi trường tĩnh và môi trường động được đặt dưới những điều kiện ánh sáng nhất định, Webcam được điều chỉnh ở những độ phân giải khác nhau qua đó ta sẽ có rút ra được đánh giá to àn diện hơn cho toàn hệ thống. Đối tượng thử nghiệm là theo dõi vật tr òn màu đỏ có tốc độ tăng dần và liên tục thay đổi em sử dụng tay để di chuyển vật n ày.

Biểu đồ giá trị X,Y là biểu đồ thay đổi giá trị của tâm đối tượng dò tìm được qua thuật toán đã xây dựng ở tr ên. Dùng một biến “đếm” trong thuật toán để kiểm tra có bao nhiêu lần bị mất đối tượng do đối tượng di chuyển quá nhanh, hoặc kích thước quá nhỏ. Số lần mất đối tượng này trên biểu đồ giá trị X,Y là các đoạn thẳng nằm song song với trục nằm ngang.



Hình 29: Hình ảnh robot hoàn chỉnh



5.1. K ết quả thử nghiệm với môi trườ ng t ĩnh

Cùng một điều kiện môi trường nhưng bức ảnh có độ phân giải khác nhau sẽ cho ta kết quả khác nhau. 

Môi trường tĩnh độ phân giải (160x120) kết quả cho thấy có tổng cộng 34 lần bị mất đối tượng do đối tượng di chuyển quá nhanh. 350 300 250 200 X

150

Y 100 50 0 1 3 5 7 9 1 3 5 7 9 1 3 5 7 9 1 3 5 7 9 1 3 5 7 9 1 3 3 6 9 2 6 9 2 5 8 2 5 8 1 4 8 1 4 7 0 4 7 0 3 6 0 3 1 2 3 5 6 7 9 0 1 3 4 5 7 8 9 1 2 3 5 6 7 9 0 1 3 4 1 1 1 1 1 1 1 1 2 2 2 2 2 2 2 3 3 3 3

Biểu đồ 1: Giá trị toạ độ tâm đối tượng môi trườ ng tĩnh (160x120). 

Môi trường tĩnh webcam độ phân giải (176x144) kết quả cho thấy có tổng cộng 20 lần bị mất đối tượng do đối tượng di chuyển quá nhanh. 350 300 250 200 X

150

Y

100 50 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 2 4 6 8 0 2 4 6 8 0 2 4 6 8 0 2 4 6 8 0 2 4 6 8 0 2 1 2 3 4 6 7 8 9 0 2 3 4 5 6 8 9 0 1 2 4 5 6 7 8 0 1 1 1 1 1 1 1 1 1 2 2 2 2 2 2 2 2 3 3

Biểu đồ 2: Giá trị toạ độ tâm đối tượng môi trườ ng tĩnh (176x144).

Yahoo: t hoi _ chao_ em_ 12325




Môi trường tĩnh webcam có độ phân giải (320x240) kết quả có 16 lần bị mất đối tượng do đối tượng di chuyển quá nhanh. 300 250 200 150

X

100

Y

50 0 1 8 5 2 9 6 3 0 7 4 1 8 5 2 9 6 3 0 7 4 1 8 5 2 9 6 2 5 8 0 3 6 9 1 4 7 9 2 5 7 0 3 6 8 1 4 6 9 2 4 7 1 2 3 5 6 7 8 0 1 2 3 5 6 7 9 0 1 2 4 5 6 7 9 0 1 1 1 1 1 1 1 1 1 2 2 2 2 2 2 2 2 3 3

Biểu đồ 3: Giá trị toạ độ tâm đối tượng môi trườ ng tĩnh (320x240)



Môi trường tĩnh webcam có độ phân giải (640x480) kết quả 17 lần bị mất đối tượng.



350 300 250 200 X

150

Y 100 50 0 1 8 5 2 9 6 3 0 7 4 1 8 5 2 9 6 3 0 7 4 1 8 5 2 9 6 3 0 1 2 2 3 4 5 5 6 7 7 8 9 9 0 1 2 2 3 4 4 5 6 6 7 8 1 2 3 4 5 6 7 8 9 0 1 2 3 4 6 7 8 9 0 1 2 3 4 5 6 7 1 1 1 1 1 1 1 1 1 2 2 2 2 2 2 2 2

Biểu đồ 4: Giá trị toạ độ tâm đối tượng môi trườ ng tĩnh (640x480).

5.2. K ết quả thử nghiệm với môi môi trường động 

Môi trường động webcam có độ phân giải (160x120) kết quả có 116 lần bị mất đối tượng. 350 300 250 200 X

150

Y

100 50 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 6 4 2 0 8 6 4 3 1 9 7 5 3 1 9 7 5 4 2 0 8 6 4 2 0 1 3 5 7 9 0 2 4 6 8 9 1 3 5 7 8 0 2 4 6 8 9 1 3 5 7 1 1 1 1 1 1 2 2 2 2 2 3 3 3 3 3 3 4 4 4 4

Biểu đồ 5: Giá trị toạ độ tâm đối tượng môi trường động (160x120).



Môi trường động webcam có độ phân giải (176x144) kết quả có 97 lần mất đối tượng.



350 300 250 200 X

150

Y

100 50 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 8 6 4 2 0 8 6 4 3 1 9 7 5 3 1 9 7 5 4 2 0 8 6 4 2 1 3 5 7 9 0 2 4 6 8 9 1 3 5 7 8 0 2 4 6 8 9 1 3 5 1 1 1 1 1 1 2 2 2 2 2 3 3 3 3 3 3 4 4 4

Biểu đồ 6: Giá trị toạ độ tâm đối tượ ng môi trường động (176x144).



Môi trường động webcam có độ phân giải (320x240) kết quả có 91 lần bị mất đối tượng. 350 300 250 200 X

150

Y

100 50 0 1 0 9 8 7 6 5 4 3 2 1 0 9 8 7 6 5 4 3 2 1 0 9 8 7 6 9 7 6 5 4 3 2 1 0 9 8 6 5 4 3 2 1 0 9 8 7 5 4 3 2 1 3 5 7 9 1 3 5 7 8 0 2 4 6 8 0 2 4 5 7 9 1 3 5 7 1 1 1 1 1 2 2 2 2 2 3 3 3 3 3 3 4 4 4 4




Môi trường động webcam có độ phân giải (640x480) kết quả 89 lần bị mất đối tượng.



350 300 250 200 X

150

Y 100 50 0 1 6 1 6 1 6 1 6 1 6 1 6 1 6 1 6 1 6 1 6 1 6 1 6 1 6 3 7 0 4 7 1 4 8 1 5 8 2 5 9 2 6 9 3 6 0 3 7 0 4 7 1 2 4 5 6 8 9 0 2 3 4 6 7 8 0 1 2 4 5 7 8 9 1 2 3 1 1 1 1 1 1 1 2 2 2 2 2 2 2 2 3 3 3




Môi trường động đối tượng di chuyển ở tốc độ vừa phải phù hợp với tốc độ động cơ số lần mất đối tượng là 10. 300

250

200

150

X Y

100

50

0 1 9 7 5 3 1 9 7 5 3 1 9 7 5 3 1 9 7 5 3 1 9 7 5 3 1 0 1 2 3 4 4 5 6 7 8 8 9 0 1 2 2 3 4 5 6 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 4 5 6 7 8 9 0 1 2 3 4 5 7 1 1 1 1 1 1 1 1 1 2 2 2 2 2 2 2

Biểu đồ 9: Giá trị toạ độ tâm đối tượng môi trường động tốc độ không đổ i

Nhận xét: Số lần mất đối tượng biểu hiện r õ nhất tr ên biểu đồ của của môi trường động, giống như nhận xét tổng quan lúc đầu các thuật toán trong môi trường tĩnh thực Yahoo: t hoi _ chao_ em_ 12325


sự đã bỏ khá xa trong môi trường động. Biểu hiện cụ thể tr ong các thử nghiệm tr ên (ví dụ: webcam có độ phân giải (640x480) trong môi trường tĩnh có 17 lần bị mất đối tượng, trong môi trường động là 89 lần). Có nhiều nguyên nhân, tuy nhiên trong trường hợp n ày phần lớn là do tốc độ động cơ 1 chiều được chọn quá chậm không đáp ứng kịp y êu cầu của phần mềm điều khiển. Cụ thể lúc theo dõi đối tượng ở tốc độ đối tượng ở mức độ ph ù hợp với tốc độ động cơ th ì hệ thống làm việc rất tốt, số lần mất đối tượng trong môi trương động lúc này chỉ là 9. Hệ thống đã được thử nghiệm ở nhiều trường hợp, trong hầu hết các tình huống khi điều kiện ánh sáng phù hợp, rô bốt có thể theo dõi đối tượng trên đường thẳng v à các ngã rẽ, nếu đối tượng dừng lại rô bốt luôn điều chỉnh được đối tượng nằm ở vị trí mong muốn tr ên mặt phẳng ảnh. Tuy nhiên nếu trường hợp đối tượng di chuyển quá nhanh thì hệ thống gặp một ít vấn đề do tốc độ hệ thống không đáp ứng kịp. Do tầm nh ìn và tốc độ của webcam còn hạn chế, tốc độ đáp ứng của hệ thống không cao, do đó nếu đối tượng chuyển động quá nhanh hoặc hướng di chuyển thay đổi quá nhanh th ì hệ thống sẽ bị mất đối tượng. Hệ thống làm việc tốt dưới điều kiện ánh sáng vừa phải, nếu môi trường có độ sáng quá cao như ánh sáng mặt trời thì hệ làmviệc rất kém do màu và độ sáng của đối tượng luôn thay đổi khi đối tượng thay đổi hướng



K ẾT LUẬN

Đánh giá kết quả đạt được

Báo cáo này mô tả hệ thống rô bốt di động bám đối tượng sử dụng thư viện xử lý ảnh OpenCV của Intel. Thuật to án sử dụng để nhận h ình ảnh từ webcam tiến hành khử nhiễu, histogram, sử dụng thuật toán CamShift, tính toán tọa độ tâm, kích cỡ, góc, thiết kế khối giao tiếp RS232 sử dụng Microsoft Communication Version 6.0. Thiết kế mạch điều khiển động cơ sử dụng PIC16F877A. Dưới những điều kiện ánh sáng nhất định đối tượng có thể được tìm ra nhanh chóng chính xác mà ít bị ảnh hưởng của nhiễu. Hoàn chỉnh được cả phần cứng v à phần mềm của rô bốt, tiến hành chạy thử tr ên nhiều dạng môi trường khác nhau, ban đ êm, ban ngày, ánh sáng mạnh, ánh sáng yếu, đường thẳng, đường vòng…kết quả, rô bốt luôn bám theo giữ đối tượng nằm ở tr ên một phần của mặt phẳng ảnh m à ta chọn. Tuy nhiên chương tr ình còn hạn chế trong thiết kế phần cứng (k hung xe), phần này còn yếu nên gây khó khăn trong việc di chuyển và động cơ của rô bốt di chuyển tốc độ chậm do đó không đáp ứng được tốc độ của webcam của rô bốt. Xử lý ảnh phụ thuộc rất nhiều vào chất lượng h ình ảnh và tốc độ chụp h ình của webcam. Tốc độ của rô bốt l à cố định do chưa xây dựng thuật toán điều khiển tốc độ rô bốt ph ù hợp tốc độ dịch chuyển của đối tượng đang theo dõi. Chương tr ình có thể được cải thiện bằng cách thêm một số hàm liên quan đến xử lý ảnh như đã trình bày ở tr ên. Tốc độ theo dõi đối tượng của thuật toán CamShift là tương đối thấp và dễ bị mất đối tượng ở một số điều kiện nhất định như đối tượng quá nhỏ hoặc di chuyển quá nhanh. Nhược điểm của thuật toán CamShift có thể được cải thiện bằng thuật toán lọc Kalman. Điều này chưa được nghi ên cứu do thời gian có hạn. Chương tr ình điều khiển mới được thử nghiệm tr ên một số môi trường nhất định kết quả đạt được là tương đối tốt. Tuy nhiên trong xử lý ảnh vấn đề nhiễu trong môi trường rất quan trọng do đó cần có th êm nhiều thử nghiệm nữa mới có thể đánh giá được độ tin cậy của kết quả đạt được. Webcam đang sử dụng có khả năng lọc nhiễu tương đối tốt. Tuy nhi ên thời gian tính toán của rô bốt sẽ tăng lên nếu độ tương phản của webcam tăng lên. Trong ứng dụng này em sử dụng webcam có độ phân giải có thể điều chỉnh được cụ thể như sau Yahoo: t hoi _chao_em_12325


(160x120, 176x144, 320x240, 640x480). K ết quả thực hiện cho thấy việc xử lý nhiễu khó khăn hơn với các webcam có độ phân giải tăng dần do nhiễu ảnh không cần thiết tăng lên, gần như không có thay đổi nhiều. Tuy nhiên với webcam có độ phân giải cao hơn th ì chưa được kiểm nghiệm. Các hàm lọc nhiễu có thể loại bỏ nhiễu gần như hoàn toàn, nhưng nó phải quét bức ảnh quá nhiều lần, do đó nó sẽ làm tăng thời gian tính toán của chương tr ình, các hàm này cần được cải thiện và tối ưu hơn. Rô bốt được xây dựng để di chuyển trong trường hợp webcam đặt ở vị trí cao hơn so với đối tượng. Hướng phát triển của đồ án.

Rô bốt chỉ được thử nghiệm tr ên hệ thống có tốc độ thay đổi chậm, cần phải được thử nghiệm với hệ thống có tốc độ nhanh hơn. Qua thử nghiệm cho thấy rô bốt hoạt động tốt. Thay v ì dò tìm một vùng đặc biệt trên đối tượng như đường tr òn màu đỏ, màu xanh v..v. Hệ thống cần được cải thiện để dò tìm đối tượng trực tiếp dựa vào các vùng đặc biệt trên đối tượng. Không chỉ m àu sắc của đối tượng được sử dụng mà cần quan tâm đến các đặc điểm của cạnh, góc, như vậy sẽ tăng được độ tin cậy cho việc dò tìm đối tượng. Phần xử lý ảnh nên bổ sung thêm bộ lọc Kalman để theo dõi những đối tượng chuyển động nhanh, kích thước bé sẽ khắc phục được nhược điểm của thuật toán CamShift. Phần cứng cần bổ sung th êm thuật toán tăng, giảm tốc độ theo sự thay đổi tốc độ của đối tượng. K ết quả thử nghiệm còn mang tính trực quan do đó cần xây dựng được khối phục vụ riêng cho việc thử nghiệm kết quả trong xử lý ảnh.



PH Ụ LỤC A CHƯƠNG TR ÌNH XỬ LÝ ẢNH

//--------------------------------------------------------------------------------------------------- ình xử lý ảnh sử dụng trong đồ án // Chương tr // Nguyễn Xuân Đức K51H-CDT // ngày 8.12.2010 // Ngôn ngữ C++ //----------------------------------------------------------------------------------------------------#include"stdafx.h" #include"afx.h" #include"cv.h" #include"highgui.h" #include"stdio.h" #include"cxcore.h" #include #include #include #include #include IplImage *image =0, *hsv = 0, *hue =0, *mask =0, *backproject =0, *histimg =0, *gray; CvHistogram *hist =0; int backproject_mode =0; int select_object =0; Yahoo: t hoi _chao_em_12325


int track_object =0; int show_hist = 1; CvPoint origin; CvRect selection; CvRect track_window; CvBox2D track_box; CvConnectedComp track_comp; int hdims =16; float hranges_arr[] ={0,180}; float* hranges = hranges_arr; int vmin =10, vmax = 256, smin =30, count; CvPoint boxcenter,h; int d2, d3,count1=0, dem=0; int high_switch_value =256; int highInt =0; int low_switch_value =0; int lowInt =0; int d0=0; CvPoint seed_point =cvPoint(305,195); CvScalar color = CV_RGB(250,255,255); int g_switch_value =0; int filterInt =0; int lastfilterInt =-1; //int position; void switch_callback( int position ){ if ( position ==0 ){



cvSmooth( backproject, backproject, CV_GAUSSIAN,3,3 ); }elseif (position==1){ cvSmooth( backproject, backproject, CV_GAUSSIAN,5,5 ); }elseif (position==2){ cvSmooth( backproject, backproject, CV_GAUSSIAN, 7, 7 ); }elseif (position==3){ cvSmooth(backproject,backproject,CV_BLUR,7,7); }elseif (position==4){ cvSmooth(backproject,backproject,CV_MEDIAN,7,7); } } IplConvKernel* element =0; int element_shape =CV_SHAPE_RECT; //the address of variable which receives trackbar position update int open_pos=0, close_pos=0, erode_pos=0, dilate_pos=0; CString data_send_RS232; COleVariant tmp(data_send_RS232); void Opening(int pos) { element = cvCreateStructuringElementEx( pos*2+1, pos*2+1, pos, pos, element_shape, 0 ); cvErode(backproject,backproject,element,1); cvDilate(backproject,backproject,element,1); cvReleaseStructuringElement(&element); } void Closing(int pos) { Yahoo: t hoi _chao_em_12325


element = cvCreateStructuringElementEx( pos*2+1, pos*2+1, pos, pos, element_shape, 0 ); cvDilate(backproject,backproject,element,1); cvErode(backproject,backproject,element,1); cvReleaseStructuringElement(&element); } void Erosion(int pos) { element = cvCreateStructuringElementEx( pos*2+1, pos*2+1, pos, pos, element_shape, 0 ); cvErode(backproject,backproject,element,1); cvReleaseStructuringElement(&element); } void Dilation(int pos) { element = cvCreateStructuringElementEx( pos*2+1, pos*2+1, pos, pos, element_shape, 0 ); cvDilate(backproject,backproject,element,1); cvReleaseStructuringElement(&element); } voidon_mouse( int event, int x, int y, int flags, void* param ) { if ( !image ) return; if ( image->origin ) y =image->height - y; if ( select_object ) Yahoo: t hoi _chao_em_12325


{ selection.x =MIN(x,origin.x); selection.y =MIN(y,origin.y); selection.width =selection.x +CV_IABS(x - origin.x); selection.height =selection.y +CV_IABS(y - origin.y); selection.x =MAX( selection.x, 0 ); selection.y = MAX( selection.y, 0 ); selection.width =MIN( selection.width, image->width ); selection.height =MIN( selection.height, image->height ); selection.width -=selection.x; selection.height -=selection.y; } switch( event) { caseCV_EVENT_LBUTTONDOWN: origin =cvPoint(x,y); selection =cvRect(x,y,0,0); select_object = 1; break; caseCV_EVENT_LBUTTONUP: select_object = 0; if ( selection.width >0 && selection.height >0 ) track_object =-1; break; }



} // Chuyen doi tu khoang gian mau HSV den RGB CvScalar hsv2rgb( float hue ) { int rgb[3], p, sector; static const int sector_data[][3]= {{0,2,1}, {1,2,0}, {1,0,2}, {2,0,1}, {2,1,0}, {0,1,2}}; hue *=0.033333333333333333333333333333333f; sector =cvFloor(hue); p =cvRound(255*(hue - sector)); p ^=sector & 1 ? 255 : 0; rgb[sector_data[sector][0]] =255; rgb[sector_data[sector][1]] =0; rgb[sector_data[sector][2]] =p; return cvScalar(rgb[2], rgb[1], rgb[0],0); } void CTUBODlg::OnBnClickedButtonAuto() { FILE * xFile; FILE * yFile; FILE * demFile; fopen_s (&demFile,"dem.txt","w"); fopen_s (&xFile,"X.txt","w"); fopen_s (&yFile,"Y.txt","w"); UpdateData(true); Setting();



CvCapture* capture =0; capture =cvCaptureFromCAM(0); if ( !capture ) { fprintf(stderr,"Could not initialize capturing...\n"); //

return -1; } printf( "Hot keys: \n" "\tESC - quit the program\n" "\tc - stop the tracking\n" "\tb - switch to/from backprojection view\n" "\th - show/hide object histogram\n" "To initialize tracking, select the object with mouse\n" );

// Tao track_bar. cvNamedWindow( "Histogram", 1 ); cvNamedWindow( "MobileRobot", 1 ); cvSetMouseCallback( "MobileRobot", on_mouse, 0 ); cvCreateTrackbar( "Vmin", "MobileRobot", &vmin, 256, 0 ); cvCreateTrackbar( "Vmax", "MobileRobot", &vmax, 256, 0 ); cvCreateTrackbar( "Smin", "MobileRobot", &smin, 256, 0 ); cvCreateTrackbar("Dilate","MobileRobot",&dilate_pos,10,Dilation); cvCreateTrackbar("Erode","MobileRobot",&erode_pos,10,Erosion); cvCreateTrackbar("Filter","MobileRobot", switch_callback );

&g_switch_value,

5,

//start: for(;;) { Yahoo: t hoi _chao_em_12325


IplImage* frame =0; int i, bin_w, c; frame =cvQueryFrame( capture ); if ( !frame ) break; if ( !image ) { /* allocate all the buffers */ image =cvCreateImage( cvGetSize(frame), 8, 3 ); image->origin =frame->origin; cvFloodFill( image, seed_point, color, cvScalarAll(5.0), cvScalarAll(5.0), NULL, 4, NULL ); hsv =cvCreateImage( cvGetSize(frame), 8, 3 ); hue=cvCreateImage( cvGetSize(frame), 8, 1 ); mask =cvCreateImage( cvGetSize(frame), 8, 1 ); gray =cvCreateImage( cvSize(320,240), 8, 1 ); backproject =cvCreateImage( cvGetSize(frame), 8, 1 ); //cvThreshHist(hist,0); hist =cvCreateHist( 1, &hdims, CV_HIST_ARRAY, &hranges, 1 ); histimg =cvCreateImage( cvSize(320,200), 8, 3 ); cvThreshold(histimg,histimg,low_switch_value,high_switch_value,CV_THRE SH_BINARY); cvZero( histimg ); } cvCopy( frame, image, 0 ); cvCvtColor( image, hsv, CV_BGR2HSV ); if ( track_object ) Yahoo: t hoi _chao_em_12325


{ int _vmin =vmin, _vmax =vmax; cvInRangeS( hsv, cvScalar(0,smin,MIN(_vmin,_vmax),0), cvScalar(180,256,MAX(_vmin,_vmax),0), mask ); cvSplit( hsv, hue, 0, 0, 0 ); if ( track_object <0 ) { float max_val =0.f; cvSetImageROI( hue, selection ); cvSetImageROI( mask, selection ); cvCalcHist( &hue, hist, 0, mask ); cvNormalizeHist(hist,20*255); cvGetMinMaxHistValue( hist, 0, &max_val, 0, 0 ); cvConvertScale( hist->bins, hist->bins, max_val ? 255. / max_val : 0., 0 ); cvResetImageROI( hue ); cvResetImageROI( mask ); track_window =selection; track_object =1; cvZero( histimg ); bin_w =histimg->width / hdims; for( i =0; i bins,i)*histimg->height/255 ); CvScalar color =hsv2rgb(i*180.f/hdims); cvRectangle( histimg, cvPoint(i*bin_w,histimg->height), Yahoo: t hoi _chao_em_12325


cvPoint((i+1)*bin_w,histimg->height - val), color, -1, 8, 0 ); } } cvCalcBackProject( &hue, backproject, hist ); cvFloodFill( backproject, seed_point, color, cvScalarAll(5.0), cvScalarAll(5.0), NULL, 4, NULL ); cvNormalizeHist(hist,20*255); cvEqualizeHist( backproject, backproject ); switch_callback(g_switch_value); Erosion(erode_pos); Dilation(dilate_pos); //Closing(close_pos); cvAnd( backproject, mask, backproject, 0 ); cvCamShift( backproject, track_window, cvTermCriteria( CV_TERMCRIT_EPS | CV_TERMCRIT_ITER, 10, 1 ), &track_comp, &track_box ); track_window =track_comp.rect; if ( backproject_mode ) cvCvtColor( backproject, image, CV_GRAY 2BGR ); if (!image->origin) track_box.angle =-track_box.angle; cvCircle( image, boxcenter, 50, CV_RGB(255,0,0), 1, 8,0);\ track_box.angle =-track_box.angle; Yahoo: t hoi _chao_em_12325


CvPoint2D32f dcenter=track_box.center; boxcenter=cvPointFrom32f(dcenter); m_IntX=boxcenter.x; m_IntY=boxcenter.y; fprintf (xFile, " %4d\n",m_IntX); fprintf (yFile, " %4d\n",m_IntY); float h=track_box.size.height; float w=track_box.size.width; float s=h*w; m_floatkichthuoc=s; m_floatGoc=track_box.angle; cvCircle( image, boxcenter, 3, CV_RGB(0,255,0), -1, 8,0); } int d=(boxcenter.x); int d1=(boxcenter.y); count1 +=1; if (count1==5){ if ((d!=d2)||(d1!=d3)){ d2=d; d3=d1; if ((115<=d)&& (d<=185)&&(150<=d1)&& (d1<=200)) { data_send_RS232="s"; m_mscomm1.put_Output(COleVariant(data_send_RS232));//strOutput)); } Yahoo: t hoi _chao_em_12325


elseif (d1>200) { data_send_RS232="b"; m_mscomm1.put_Output(COleVariant(data_send_RS232));//strOutput)); } elseif ((d1>0)&&(d1<150)&&(115<=d)&&(d<=185)) { data_send_RS232="f"; m_mscomm1.put_Output(COleVariant(data_send_RS232));//strOutput)); } elseif ((d>185)&&(d1>0)&&(d1<=200)) { data_send_RS232="r"; m_mscomm1.put_Output(COleVariant(data_send_RS232));//strOutput)); } elseif ((d>0)&&(d<115)&&(d1>0)&&(d1<=200)) { data_send_RS232="l"; m_mscomm1.put_Output(COleVariant(data_send_RS232));//strOutput)); } } else if (((d==d2)&&(d1==d3)&&(d!=0)&&(d1!=0))&&((d1<100)||(d1>200)||(d<115)||(d>18 5))){ dem=dem+1; data_send_RS232="s"; Yahoo: t hoi _chao_em_12325


m_mscomm1.put_Output(COleVariant(data_send_RS232));//strOutput)); } count1=0; } if ( select_object && selection.width >0 && selection.height >0 ) { cvSetImageROI( image,selection ); cvXorS( image, cvScalarAll(255), image, 0 ); cvResetImageROI( image ); } cvSaveImage("image.jpg",image); cvSaveImage("histimg.jpg",histimg); cvSaveImage("backproject.jpg",backproject); cvShowImage( "MobileRobot", image ); cvShowImage( "Histogram", histimg ); cvShowImage( "backproject",backproject); c =cvWaitKey(10); if ( (char) c ==27 ) break; switch( (char) c ) { case'b': backproject_mode ^=1; break; case'c': track_object =0;



cvZero( histimg ); break; case'h': show_hist ^=1; if ( !show_hist ) cvDestroyWindow( "Histogram" ); else cvNamedWindow( "Histogram", 1 ); break; default: ; } } cvDestroyWindow("backproject"); cvDestroyWindow("Histogram"); cvDestroyWindow("MobileRobot"); cvReleaseImage(&image); cvReleaseImage(&histimg); cvReleaseCapture( &capture ); cvReleaseImage( &backproject); fprintf(demFile," %4d\n",dem); fclose (xFile); fclose (yFile); fclose (demFile)



PHỤ LỤC B CHƯƠNG TR Ì NH ĐIỀU KHIỂN ROBOT

//---------------------------------------------------------------------------------------------------// Khối điều khiển Robot sử dụng PIC16F877A và L298N // Nguyễn Xuân Đức K51H-CDT // Ngày 8.12.2010 // Ngôn ngữ: CCS C complier //----------------------------------------------------------------------------------------------------#include<16F877A.h> #include #device *=16 adc=10 #fuses nowdt,hs,noput,noprotect,nodebug,nobrownout,nolvp, nocpd,nowrt #use delay(clock=20000000,RESTART_WDT) 20 megahertz

// Sets crystal oscillator at

#use rs232(baud=19200, xmit=PIN_C6, rcv=PIN_C7) //Sets up serial port output pin & baud rate char value; void forward(){ rb4=1; rb5=0; rb6=0; rb7=1; } voidbackward(){ rb4=0; rb5=1; rb6=1; Yahoo: t hoi _chao_em_12325


rb7=0; } void right(){ rb4=1; rb5=0; rb6=1; rb7=0; } void left(){ rb4=0; rb5=1; rb6=0; rb7=1; } void full_stop(){ rb4=0; rb5=0; rb6=0; rb7=0; } void M2_forward(){ rb4=1; rb5=0; } void M2_stop(){ rb4=0;



rb5=0; } void M2_backward(){ rb4=0; rb5=1; } void M1_forward(){ rb6=0; rb7=1; } void M1_stop(){ rb6=0; rb7=0; } void M1_backward(){ rb6=1; rb7=0; } #INT_RDA void RDA_interrupt(){ value =getc(); delay_ms(10); putc(value); switch(value) {



case'f': forward();

break; // neu ky tu nhan duoc la '0' di thang.

case'l':

left();

break;

case'r':

right();

break;

case'b': backward();

break;

case'1':

M1_forward();

break;

case'2':

M1_backward();

break;

case'3':

M1_stop();

break;

case'4':

M2_forward();

break;

case'5':

M2_backward();

break;

case'6':

M2_stop();

break;

default: full_stop();break; } } voidmain(){ ENABLE_INTERRUPTS(INT_RDA); enable_interrupts(global); SET_TRIS_B(0X00); RB3=1; RB2=1; RB0=1; while(true) { } } //-----------------------------------------------------------------------------------------



PH Ụ LỤC C CHƯƠNG TR ÌNH TRUY ỀN THÔNG RS232

//---------------------------------------------------------------------------------------------------// Khối truyền thông RS232 sử dụng công cụ Micro soft Communication version 6.0 // Nguyễn Xuân Đức K51H-CDT // Ngày: 8.12.2010 // Ngôn ngữ : C++ 2008 (MFC Aplication). //----------------------------------------------------------------------------------------------------void CTUBODlg::InitComboBox(void) { // ComboBox ComPort m_cboComPort.ResetContent(); m_cboComPort.AddString(L"COM1"); m_cboComPort.AddString(L"COM2"); m_cboComPort.AddString(L"COM3"); m_cboComPort.AddString(L"COM4"); m_cboComPort.AddString(L"COM5"); m_cboComPort.AddString(L"COM6"); m_cboComPort.AddString(L"COM7"); m_cboComPort.AddString(L"COM8"); m_cboComPort.AddString(L"COM9"); m_cboComPort.SetCurSel(2); // ComboBox BitRate m_cboBitRate.ResetContent(); m_cboBitRate.InsertString(0,L"600"); m_cboBitRate.InsertString(1,L"1200");



m_cboBitRate.InsertString(2,L"2400"); m_cboBitRate.InsertString(3,L"4800"); m_cboBitRate.InsertString(4,L"9600"); m_cboBitRate.InsertString(5,L"14400"); m_cboBitRate.InsertString(6,L"19200"); m_cboBitRate.InsertString(7,L"28800"); m_cboBitRate.InsertString(8,L"38400"); m_cboBitRate.InsertString(9,L"56000"); m_cboBitRate.InsertString(10,L"57600"); m_cboBitRate.InsertString(11,L"115200"); m_cboBitRate.InsertString(12,L"128000"); m_cboBitRate.InsertString(13,L"256000"); m_cboBitRate.SetCurSel(6); // ComboBox Data Bits m_cboDataBit.ResetContent(); m_cboDataBit.AddString(L"5"); m_cboDataBit.AddString(L"6"); m_cboDataBit.AddString(L"7"); m_cboDataBit.AddString(L"8"); m_cboDataBit.SetCurSel(3); // ComboBox Stop Bit m_cboStopBit.ResetContent(); m_cboStopBit.AddString(L "1"); m_cboStopBit.AddString(L "1.5"); m_cboStopBit.AddString(L "2"); m_cboStopBit.SetCurSel(0);



// ComboBox parity bit m_cboParityBit.ResetContent(); m_cboParityBit.InsertString(0,L"None"); m_cboParityBit.InsertString(1,L"Old"); m_cboParityBit.InsertString(2,L"Even"); m_cboParityBit.InsertString(3,L"Mark"); m_cboParityBit.InsertString(4,L"Space"); m_cboParityBit.SetCurSel(0); // ComboBox handshaking m_cboHandshaking.ResetContent(); m_cboHandshaking.AddString(L"None"); m_cboHandshaking.AddString(L"XON/XOFF"); m_cboHandshaking.AddString(L"RTS"); m_cboHandshaking.AddString(L"RTS/CTS+XON/XOFF"); m_cboHandshaking.SetCurSel(0); } void CTUBODlg::Setting(void) { if (m_mscomm1.get_PortOpen()) m_mscomm1.put_PortOpen(false); // Thiet lap ten cong m_mscomm1.put_CommPort(m_cboComPort.GetCurSel()+1); // Thiet lap bat tay m_mscomm1.put_Handshaking(m_cboHandshaking.GetCurSel()); // Thiet lap tan so bit du lieu bit stop CString

strBitRate=getCurStrInCombobox(m_cboBitRate);



CString

strParity=getCurStrInCombobox(m_cboParityBit);

CString

strDataBit=getCurStrInCombobox(m_cboDataBit);

CString

strStopBit=getCurStrInCombobox(m_cboStopBit);

CString

strSetting;

strSetting.Format(_T("%s,%c,%s,%s"),strBitRate,strParity[1],strDataBit,strSto pBit); m_mscomm1.put_Settings(strSetting); // Thiet lap khac m_mscomm1.put_RThreshold(1); m_mscomm1.put_InputLen(1);

// Moi lan doc mot ky tu

m_mscomm1.put_InBufferSize(1024); m_mscomm1.put_InputMode(0); // 0- text mode, 1- binary mode m_mscomm1.put_OutBufferSize(1024); m_mscomm1.put_PortOpen(true);// mo cong } void CTUBODlg::OnBnClickedButtonSend() { UpdateData(TRUE); Setting(); m_mscomm1.put_Output(COleVariant(m_strTransfer));//strOutput)); UpdateData(false); } void CTUBODlg::OnBnClickedButtonClear() { Yahoo: t hoi _chao_em_12325


UpdateData(); m_strReceive=""; UpdateData(false); } void CTUBODlg::OnCommMscomm1() { count+=1; VARIANT data; switch (m_mscomm1.get_CommEvent()){ case1: // comEvSend break; case2: // comEvReceive data =m_mscomm1.get_Input(); m_strReceive +=(CString)data.bstrVal; if (count==500){ m_strReceive=""; count=0; } //

UpdateData(FALSE);

break; case3:// comEvCTS break; case4:// ComEvDSR break; case5: // comEvCD break;



case6: // comEvRing break; case7: // comEvEOF break; default:

break;

}; UpdateData(false); }



mobile robot OpenCV.pdf

Recommend Documents