Lưu đồ giải thuật điều khiển

Một phần của tài liệu ĐỒ án kỹ THUẬT ROBOT THIẾT kế mô HÌNH và bộ điều KHIỂN PID CHO máy BAY 4 CÁNH 2 (Trang 30 - 33)

20 TIEU LUAN MOI download : skknchat@gmail.com

Chương 4. Thiết Kế Phần Mềm.

Giải thích lưu đồ giải thuật:

- Thiết lập thông số ban đầu: Khai báo các biến đầu vào ra, trạng thái ban đầu, cấp xung khởi động cho esc động cơ.

- Kiểm tra cảm biến: Kiểm tra tín hiệu kết nối giao tiếp I2C với cảm biến. - Đọc tín hiệu cảm biến: Truy cập vào địa chỉ các tín hiệu tiến hành đọc tín hiệu thô từ cảm biến.

- Xử lí tín hiệu cảm biến: Xử dụng thuật toán tính toán giá trị góc từ các tín hiệu thô.

- Tính toán giá trị góc nghiêng, xung điều khiển: Tính toán giá trị góc lệch so với góc đặt, từ đó tính ra giá trị xung điều khiển cần cung cấp cho từng động cơ.

- Xuất tín hiệu điều khiển: Xuất tín hiệu điều khiển qua các chân PWM nối với ESC điều khiển 4 động cơ.

4.2.2 Đọc tín hiệu cảm biếnGiao tiếp I2C Giao tiếp I2C

- I2C là tên viết tắt của cụm từ tiếng anh “Inter-Integrated Circuit”. Nó là một giao thức giao tiếp được phát triển bởi Philips Semiconductors để truyền dữ liệu giữa một bộ xử lý trung tâm với nhiều IC trên cùng một board mạch chỉ sử dụng hai đường truyền tín hiệu.

- Do tính đơn giản của nó nên loại giao thức này được sử dụng rộng rãi cho giao tiếp giữa vi điều khiển và mảng cảm biến, các thiết bị hiển thị, thiết bị IoT, EEPROMs, v.v …

- Đây là một loại giao thức giao tiếp nối tiếp đồng bộ. Nó có nghĩa là các bit dữ liệu được truyền từng bit một theo các khoảng thời gian đều đặn được thiết lập bởi một tín hiệu đồng hồ tham chiếu.

Một số đặc điểm quan trọng của giao thức giao tiếp I2C:

Chỉ cần có hai đường bus (dây) chung để điều khiển bất kỳ thiết bị / IC nào trên mạng I2C

Không cần thỏa thuận trước về tốc độ truyền dữ liệu như trong giao tiếp UART. Vì vậy, tốc độ truyền dữ liệu có thể được điều chỉnh bất cứ khi nào cần thiết

Cơ chế đơn giản để xác thực dữ liệu được truyền

Sử dụng hệ thống địa chỉ 7 bit để xác định một thiết bị / IC cụ thể trên bus I2C

Chương 4. Thiết Kế Phần Mềm.

Các mạng I2C dễ dàng mở rộng. Các thiết bị mới có thể được kết nối đơn giản với hai đường bus chung I2C

Đọc dữ liệu MPU qua I2C:

Một phần của tài liệu ĐỒ án kỹ THUẬT ROBOT THIẾT kế mô HÌNH và bộ điều KHIỂN PID CHO máy BAY 4 CÁNH 2 (Trang 30 - 33)

Tải bản đầy đủ (DOCX)

(50 trang)
w