Robot Bumpers có thể hướng dẫn: 5 bước

2024 Tác giả: John Day | [email protected]. Sửa đổi lần cuối: 2024-01-30 13:33

Tôi đã quyết định tạo một tài liệu hướng dẫn trình bày cách tạo Bộ đệm rô-bốt và cách đặt chúng trên rô-bốt điều khiển bằng pin. Trước tiên, bạn muốn đảm bảo rằng bạn đã kết nối dây điện ở đúng vị trí. Mạch sẽ không hoạt động nếu không. Thứ hai, bạn muốn đảm bảo rằng bạn có một trong các dây kết nối với VDD (dương) và các dây khác được kết nối với VSS (âm). Cuối cùng, bạn muốn đảm bảo rằng bạn kết nối cả hai dây này với lá thiếc. Bước cuối cùng mà bạn phải làm là đảm bảo rằng lá thiếc được kết nối với các tấm cản.

Quân nhu

Các nguồn cung cấp được sử dụng để tạo ra Sách hướng dẫn này là những thứ sau:

• Hai cây gậy
• Giấy thiếc
• 3 dây

Bước 1: Đặt giấy bạc lên thanh

Đặt hai que vào mặt sau của ốp lưng, đảm bảo rằng cả hai que đều được bọc bằng giấy thiếc. Lựa chọn tốt nhất để đảm bảo rằng cả hai chiếc gậy đều ở trên mặt sau của robot là dán một miếng băng dính nhỏ.

Bước 2: Kết nối dây

Để mạch của bạn hoạt động, bạn cần có khả năng kết nối ba dây dẫn từ VDD và VSS với que bọc giấy thiếc.

Bước 3: Kết nối tất cả các dây thành một

Cuối cùng, để tất cả các dây vào cản bắt đầu hoạt động, hãy bọc chúng bằng giấy thiếc và ấn chúng vào các que đã được bọc giấy bạc. Khi được nhấn, dòng điện từ các dây dẫn khiến robot di chuyển.

Bước 4: Xem It Go

Khi bạn ấn cả ba sợi dây vào các thanh cản, xe sẽ bắt đầu chuyển động. Bước tiếp theo hiển thị mã cần thiết để điều này hoạt động. Chương trình được sử dụng cho quá trình này được gọi là "Trình chỉnh sửa tem cơ bản".

Bước 5: Mã lập trình Robot

Để robot này di chuyển, nó cần có mã sau:

'{$ STAMP BS2}' {$ PBASIC 2.5}

LBump PIN 11

Mã PIN RBump 10

Mã PIN LMOTOR 15

Mã PIN RMOTOR 14

RFast CON 650

LFast CON 850

RSlow CON 700

LSLOW CON 800

MStop CON 750

RFastRev CON 850

LFastRev CON 650

RSlowRev CON 800

LSlowRev CON 700

MLoopC VAR Word 'For.. Next Variable lên đến khoảng 65000

LÀM

GOSUB Forwardfast 'đi về phía trước

IF IN10 = 0 THEN 'nếu hai dây ở đầu vào 10 được nhấn thì rẽ trái

GOSUB TurnLeft90

ELSEIF IN11 = 0 THEN 'Nếu hai dây ở đầu vào 11 được nhấn, thì rẽ phải

GOSUB TurnRight90

ENDIF

VÒNG

TurnRight90:

'Thủ tục phụ để Rẽ phải 90deg

'**********************************************************

CAO 1

THẤP 0

ĐỐI VỚI MLoopC = 1 ĐẾN 22

PULSOUT LMOTOR, LfastRev 'di chuyển về phía trước một xung

PULSOUT RMOTOR, Rfast 'bằng cách sử dụng chân và hằng số

TẠM DỪNG 20

'20mS cho phép robot di chuyển' trước xung TIẾP THEO

KẾ TIẾP

TRỞ LẠI

'*********************************************************

TurnLeft90:

'Thủ tục phụ để Rẽ phải 90deg

'********************************************************

CAO 0

THẤP 1

ĐỐI VỚI MLoopC = 1 ĐẾN 22

PULSOUT LMOTOR, Lfast 'di chuyển về phía trước một xung

PULSOUT RMOTOR, RfastRev 'sử dụng chân và hằng số

TẠM DỪNG 20 '20mS cho phép robot di chuyển' trước xung TIẾP THEO

KẾ TIẾP

TRỞ LẠI

'***********************************************************

Chuyển tiếp nhanh:

'Quy trình phụ để di chuyển robot về phía trước một cách nhanh chóng

'**********************************************************

ĐỐI VỚI MLoopC = 1 ĐẾN 70

PULSOUT LMOTOR, LFast 'PULSOUT

RMOTOR = RFast

TẠM DỪNG 20

KẾ TIẾP

TRỞ LẠI