1.4 Tính tốn chọn lựa cơ cấu truyền động cho robot
1.4.4 Tính động cơ chuyển động
Tải m = 3kg.
Vận tốc v = 214 mm/s = 0,214 m/s. Thời gian tăng tốc trong Ttt = 0,1s
Gia tốc a = max 0,214 0,1 tt V T = =2,14 m/s2. Chọn gia tốc trọng trường g = 10m/s2.
Khi chuyển động đều:
Fx = mg.0,05 = 3.10.0,05 =1,5 (N) Khi tăng tốc: Fa = ma= 3.2,14= 6,42 (N) P= . max.2.3,14 37,959.63.2.3,14 60 60 A M n = = 250,3 (W) Trong đó MA = Mtải +Mtt +Mkđ = 7,16 + 30,668 +0,131= 37,959 (N.m) Mtải = . 1,5.30 2.3,14 2.3,14x F P = = 7,16 (N.m) Moment tăng tốc Mtt = . 6,42.30 2.3,14a 2.3,14 F P = =30,668 (N.m)
Moment khởi động Mkđ = max max
2.3,14. . .2 2.3,14.63.2,14.2
.60 214.60
n a
V = =0,131 N.m
Công thức quy đổi chọn động cơ
M= max 9,55. .100 9,55.250,3.100 63 P n = =379,4 (N.cm) = 37,94 (kg.cm). Chọn động cơ LX44WG 1:92 Nguồn DC 12v.
Tốc độ khơng tải 90prm, có tải 70prm.
Dịng khơng tải 1A, có tải 4,4A.
Lực kéo 50 kg.cm 1.4.5 Chọn lò xo (24) (27) (28) (29) (30) (31) (32) (33) (34) (35) (25) (26)
17
Ứng suất làm lò xo σb = 1500 ~1700 Mpa => chọn σb = 1600 Mpa.
Lực tác dụng lên 2 đầu lò xo F = 2kg = 20N
Chọn lị xo có đường kính ngồi D=16,5 (mm) Chọn lị xo có đường kính trong d=10,5 (mm) Đường kính danh nghĩa ddn=13 (mm)
Tiết diện dây s = 3(mm)
Chiều dài dây L = 60 (mm)
Chiều dài ngắn nhất khi bị nén l = 15 (mm)
Lực nén F.L = 6.39=912 (N)
Dưới tác dụng của lực F, dây lò xo bị xoắn bởi moment xoắn: T= . 13.10 .203
2 2
D F −
= =0,13 (N.mm)
Moment chóng xoắn tiết diện dây lò xo Wo
3 .3.10 3 16 2 o d W =π =π − = 5,3.10-9 (N.m) Tính độ cứng lị xo theo cơng thức: F = K . ΔL K= 39 3 (60 15).10 F L= − ∆ − = 866
Ứng suất xoắn lên dây lò xo
. . .16 866.20.13.103 3 33 2 . 2 .(3.10 ) x k F d s τ π π − − = = =538 (Mpa)
Ứng suất cho phép :[ ]=(0,4 ~0,5).τx σb =0,4.1600 = 640 Mpa. 538Mpa x 640Mpa
τ = <τ =
=> thỏa điều kiện Số vòng dây làm việc : n = max min 3 3 max min) ( ). . (45 0).9,807.3 8. ( 8.0,75 (20 0) G S c F F λ −λ = − − − = 19,6 => chọn 20
với λmax: chuyển vị lớn nhất
min λ : chuyện vị nhỏ nhất Fmax: lực lớn nhất tác dụng lên lò xo Fmin: lực nhỏ nhất tác dụng lên lò xo (37) (38) (39) 40) (41) 42) (43)
18
1.5 Chọn lựa giải pháp điều khiển cho robot
1.5.1 Sơ đồ khối tổng quan của giải pháp điều khiển Robot
Sơ đồ quan hệ thống điều khiển robot thể hiện qua sơ đồ khối sau:
Hình 14: Sơ đồ khối tổng quan của hệ thống điều khiển robot
19
1.5.2 Đặc tính kỹ thuật của các thiết bị sử dụng trong hệ thống điều khiển robot
1. Raspberry Pi 3b+ Số lượng: 1
Raspberry Pi 3b+ đóng vai trị như một máy tính thứ hai, được lắp ráp trên robot để xử lý tín hiệu, đưa video về máy tính chủ qua wifi.
Tên thơng số Thơng số kỹ thuật
Nguồn hoạt động - 5V/2.5A DC cổng microUSB - 5V DC trên chân GPIO - Power over Ethernet (PoE)
Mở rộng 40-pin GPIO
Vi xử lý Broadcom BCM2837B0, quad-core A53 (ARMv8) 64-bit SoC @1.4GHz
RAM 1GB LPDDR2 SDRAM
Kết nối - 2.4GHz and 5GHz IEEE 802.11 b/g/n/ac wireless LAN - Bluetooth 4.2
- BLE
- Gigabit Ethernet over USB 2.0 (Tối đa 300Mbps).
Cổng USB 4 x 2.0
Video và âm thanh - 1 cổng full-sized HDMI - Cổng MIPI DSI Display - cổng MIPI CSI Camera - cổng stereo output - composite video 4 chân
Lưu trữ MicroSD
20
2. Node MCU ESP8266 Số lượng: 2
NodeMCU là module thu phát wifi. Đề tài sử dụng hai module Node MCU. Một module được lắp trên robot để đọc và gửi giá trị cảm biến về máy tính chủ, một module còn lại được lắp trên tủ điều khiển, lấy lệnh điều khiển từ máy chủ để gửi cho Arduino qua wifi.
Tên thông số Thông số kỹ thuật
Nguồn hoạt động 5VDC MicroUSB hoặc Vin GIPO giao tiếp mức 3.3VDC
WiFi 2.4 GHz hỗ trợ chuẩn 802.11 b/g/n
IC chính ESP8266 Wifi SoC Bộ nhớ Flash 4MB
Phiên bản firmware NodeMCU Lua Chip nạp CP2102
Giao tiếp Cable Micro USB Tích hợp giao thức TCP/IP
GPIO tương thích hồn tồn với firmware Node MCU
Bảng 3: Thơng số kỹ thuật Node MCU ESP8266
3. Cảm biến AM2315 Số lượng: 1
AM2315 là cảm biến được lắp trên robot để đọc nhiệt độ, độ ẩm.
Tên thông số Thông số
Điện áp hoạt động 3.5 ~ 5.5V
Dòng điện tối đa khi sử dụng 10mA
Nhiệt độ -20 ~ 80 độC sai số 0.1độC
Địa chỉ I2C 05C
4 dây tín hiệu dài 20 inch Đọc độ ẩm từ 0-100% sai số 2%
21
4. Mạch cầu H – L298 Số lượng: 1
L298 là mạch điều khiển động cơ DC tích hợp diod bảo vệ.
Tên thông số Thông số kỹ thuật
Điện áp hoạt động 5~30VDC
Mức điện áp logic Low -0.3V~1.5V, High: 2.3V~Vss Dòng tối đa cho mỗi cầu H 2A
Công suất tối đa 25W 1 cầu
IC chính L298 - Dual Full Bridge Driver Nhiệt độ bảo quản -25°C ~ +130
Số cổng điều khiển 2 cổng
Bảng 5: Thông số kỹ thuật Mạch cầu H – L298
5. Router Tplink 841n Số lượng: 1
Router dùng để phát wifi chính, giúp kết nối các thiết bị với nhau, có khả năng bảo mật.
Tên thông số Thông số kỹ thuật
Nguồn hoạt động 9VDC / 0.6A
Ports - 4 x cổng LAN 10/100Mbps - 1 x cổng WAN 10/100Mbps
Ăng ten 2 x ăng ten đẳng hướng cố định
Chuẩn Wi-Fi IEEE 802.11n, IEEE 802.11g, IEEE 802.11b Băng tần 2.412~2.472GHz Tốc độ tín hiệu - 11n: Lên đến 300Mbps(động) - 11g: Lên đến 54Mbps(động) - 11b: Lên đến 11Mbps(động) Độ nhạy - 270M: -70dBm@10% PER - 130M: -74dBm@10% PER - 108M: -74dBm@10% PER - 54M: -77dBm@10% PER - 11M: -87dBm@8% PER - 6M: -90dBm@10% PER
22 - 1M: -98dBm@8% PER
Tính năng Wi-Fi Mở/Tắt sóng Wi-Fi, WMM, thống kê Wi-Fi
Bảo mật Wi-Fi WEP, WPA/WPA2, WPA-PSK/WPA2-PSK Dạng WAN IP động/IP tĩnh/PPPoE/ PPTP/L2TP/BigPond Quản lý - Kiểm soát truy cập
- Quản lý nội bộ - Quản lý từ xa
DHCP Máy chủ, Danh sách máy khách DHCP, Dành riêng địa chỉ Dynamic DNS DynDns, Comexe, NO-IP
Mạng khách 1 x mạng khách 2.4GHz
Môi trường - Nhiệt độ hoạt động: 0℃~40℃ - Nhiệt độ lưu trữ: -40℃~70℃
- Độ ẩm hoạt động: 10%~90% không ngưng tụ - Độ ẩm lưu trữ: 5%~90% không ngưng tụ
Bảng 6: Thông số kỹ thuật Router Tplink 841n
6. Arduino UNO R3 Số lượng: 1
Arduino UNO R3 được lắp trên tủ điều khiển, nhận tín hiệu điều khiển từ máy tính chủ thơng qua Node MCU, từ đó điều khiển động cơ robot.
Tên thông số Thông số kỹ thuật
Điện áp đầu vào khuyên dùng 7VDC - 12VDC Điện áp vào giới hạn 6-20V DC
Dòng ra trên chân digital Max 40 mA Dòng ra trên chân 5V 500 mA Dòng ra trên chân 3.3V 50 mA
Số chân Analog 6
Số chân Digital 14 ( 6 chân PWM)
Chip điều khiển chính ATmega328P
Dung lượng bộ nhớ Flash 32 KB (ATmega328P)
SRAM 2 KB (ATmega328P)
EEPROM 1 KB (ATmega328P)
Tốc độ 16 MHz
Chân PWM (~) 3, 5, 6, 9, 10, và 11 Chip nạp và giao tiếp UART ATmega16U2
23
7. Mạch điều khiển động cơ TB6600 Số lượng: 1
Mạch Điều Khiển Động Cơ Bước TB6600 sử dụng IC TB6600HQ/HG.
Tên thông số Thông số kỹ thuật
Nguồn đầu vào: 9V – 42V
Dòng cấp tối đa: 4A
Độ phân giải: 1/1, ẵ, ẳ, 1/8, 1/16, 1/32 step
Có thể điều khiển đảo chiều quay Tích hợp chân Reset và Enable Tích hợp tính năng Standby Tích hợp bảo vệ quá nhiệt TSD Ngõ vào có cách ly quang, tốc độ cao Có tích hợp đo q dịng q áp
Bảng 8: Thông số kỹ thuật Mạch điều khiển động cơ TB6600
8. Mạch Điều Khiển Động Cơ Bước DRV8825 Số lượng: 1
Driver động cơ bước DRV8825 với đầy đủ các tính năng của mơt driver chun nghiệp : điều chỉnh dòng giới hạn, vi bước ( 1/32 bước) ,bảo vệ q dịng, q nhiệt,v.v...
Tên thơng số Thông số kỹ thuật
Điện áp cung cấp 8.2~45VDC Dịng trung bình 1.5A
Độ phân giải full, half step, ¼ step, 1/8 step, 1/16 step, 1/32 step Điện áp điều khiển 3.3V và 5V
Dòng đỉnh ( Peak) lên đến 2.5A
Tự động shutdown khi quá nhiệt, quá dòng
Bảo vệ ngắn mạch và bảo vệ quá tải
Mạch 4 lớp,2 lớp phủ đồng giúp cải thiện khả năng tản nhiệt
Có thể thay thế tốt cho Driver A4988 trong máy in 3D
24
9. Bộ nguồn xung ổn áp S8VM-30024C Số lượng: 1
Cung cấp nguồn xung ổn áp cho thiết bị.
Tên thông số Thông số kỹ thuật
Hiệu suất làm việc 81% tối thiểu
Dòng rò - 0.4 mA max. (vào 100VAC)
- 0.75 mA max. (vào 200VAC) ở ngõ ra định mức
Khoảng điều chỉnh điện áp ra −20% to 20% (V. ADJ)
Chức năng bảo vệ quá tải 105% ~ 160% dòng tải định mức Nhiệt độ làm việc −25 to 65°C
Nguồn cấp 100~240VAC (85~264VAC) 50/60Hz
Điện áp ngỏ ra loại 5,12, 15, 24VDC ±10%, chỉ thị dòng áp ngỏ ra Nhiều cấp công suất dể lựa chọn 15, 30, 50, 100, 150, 300, 600, 1.500W Bảo vệ quá dòng, ngắn mạch, quá áp, thấp áp, tự động khởi động lại Đèn báo chỉ thị trạng thái ngỏ ra màu xanh
Chức năng báo động sai điện áp ra
Bảng 10: Thông số kỹ thuật Bộ nguồn xung ổn áp S8VM-30024C
10. Động cơ bước và trục vitme: NEMA 17 42 Số lượng: 1
Động cơ bước và trục vitme NEMA 17 42 dùng trong cơ cấu rải dây trong q trình robot di chuyển
Tên thơng số Thông số kỹ thuật
Cường độ định mức 1.5A
Mô men giữ 0.55 Nm
Góc quay mỗi bước 1.8° Khối lượng 400g
Tương thích với đầu ra động cơ bước trên mạch RAMPS 1.5 hoặc CNC shield V3 Ít tỏa nhiệt, chuyển động êm
25
11. Động cơ bước giảm tốc: 667oz-in NEMA-17 Bipolar Số lượng: 1
Động cơ bước giảm tốc 667oz- in NEMA-17 Bipolar dùng trong cơ cấu quấn dây trong q trình robot di chuyển
Tên thơng số Thơng số`
Dịng chịu tải 1.7A
Góc bước 1.8˚ Moment xoắn giữ 73N.cm
Moment xoắn hãm 3N.cm
Khối lượng 480g
Bảng 12: Thông số kỹ thuật Động cơ bước giảm tốc: 667oz-in NEMA-17 Bipolar
12. Động cơ dc giảm tốc: 5840-31ZY Số lượng: 6
Động cơ dc giảm tốc 5840-31ZY dùng để điều khiển robot di chuyển trong đường ống
Tên thông số Thông số kỹ thuật
Điện áp hoạt động 24VDC
Tốc độ 16rpm (không tải)
Sai số ±5%
Bảng 13: Thông số kỹ thuật Động cơ dc giảm tốc: 5840-31ZY
13. Camera USB 2.0 Số lượng: 1
Camera được gắn trên thân robot làm nhiệm vụ thu thập hình ảnh bên trong đường ống gửi về giao diện máy tính.
Tên thông số Thông số
Cổng giao tiếp USB 2.0 tương thích USB 1.1
Cảm biến thu nhận ảnh CMOS sensor -200w with 110 dB high dynamic range Công nghệ hỗ trợ cảm biến - Back-focus-adjustment
- Automatic gain control (AGC)
- Automatic exposure control (AEC) Độ phân giải 5 Mpixels
Kích thước (w x h x l): 38.8 x 38.8 x 35 mm Chuẩn bảo vệ class IP40