คำสั่งกันชนหุ่นยนต์: 5 ขั้นตอน

2024 ผู้เขียน: John Day | [email protected]. แก้ไขล่าสุด: 2024-01-30 13:05

ฉันได้ตัดสินใจสร้างคำสั่งสอนที่สาธิตวิธีสร้าง Robot Bumpers และวิธีวางบน Robot ที่ควบคุมด้วยแบตเตอรี่ ประการแรก คุณต้องแน่ใจว่าคุณมีสายไฟที่ต่ออยู่ในตำแหน่งที่ถูกต้อง วงจรจะไม่ทำงานเป็นอย่างอื่น ประการที่สอง คุณต้องแน่ใจว่าคุณมีสายใดสายหนึ่งที่เชื่อมต่อกับ VDD (บวก) และสายอื่น ๆ ที่เชื่อมต่อกับ VSS (เชิงลบ) สุดท้าย คุณต้องแน่ใจว่าคุณเชื่อมต่อสายทั้งสองนี้เข้ากับฟอยล์ดีบุกแล้ว ขั้นตอนสุดท้ายที่คุณต้องทำคือตรวจสอบให้แน่ใจว่าฟอยล์ดีบุกเชื่อมต่อกับกันชนแล้ว

เสบียง

อุปกรณ์ที่ใช้ในการสร้างคำแนะนำนี้มีดังต่อไปนี้:

• สองแท่ง
• ฟอยล์ดีบุก
• 3 สาย

ขั้นตอนที่ 1: วางฟอยล์บน Sticks

วางแท่งไม้สองอันที่ด้านหลังของกันชน ตรวจสอบให้แน่ใจว่าไม้ทั้งสองหุ้มด้วยฟอยล์ดีบุก ตัวเลือกที่ดีที่สุดเพื่อให้แน่ใจว่าแท่งทั้งสองติดอยู่ที่ด้านหลังของหุ่นยนต์คือการใช้เทปกาวชิ้นเล็กๆ

ขั้นตอนที่ 2: เชื่อมต่อสายไฟ

เพื่อให้วงจรของคุณทำงานได้ คุณจะต้องสามารถเชื่อมต่อสายไฟสามเส้นจาก VDD และ VSS เข้ากับแท่งที่หุ้มด้วยฟอยล์

ขั้นตอนที่ 3: เชื่อมต่อสายไฟทั้งหมดเข้าด้วยกัน

สุดท้าย ในการที่จะนำสายไฟทั้งหมดไปไว้บนกันชนเพื่อเริ่มทำงาน ให้ห่อด้วยกระดาษฟอยล์ดีบุกแล้วกดลงบนแท่งที่หุ้มด้วยกระดาษฟอยล์ เมื่อกด กระแสจากสายไฟทำให้หุ่นยนต์เคลื่อนที่

ขั้นตอนที่ 4: ดูมันไป

เมื่อคุณกดสายไฟทั้งสามเข้ากับกันชน รถควรเริ่มเคลื่อนที่ ขั้นตอนต่อไปจะแสดงรหัสที่จำเป็นสำหรับการทำงาน โปรแกรมที่ใช้สำหรับกระบวนการนี้เรียกว่า "Basic Stamp Editor"

ขั้นตอนที่ 5: รหัสสำหรับการเขียนโปรแกรมหุ่นยนต์

เพื่อให้หุ่นยนต์เคลื่อนที่ได้ จำเป็นต้องมีรหัสต่อไปนี้:

' {$แสตมป์ BS2}' {$PBASIC 2.5}

LBump PIN 11

RBump PIN 10

LMOTOR PIN 15

RMOTOR PIN 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 up toประมาณ 65000

ทำ

GOSUB ไปข้างหน้าอย่างรวดเร็ว 'ไปข้างหน้า

IF IN10 = 0 แล้ว ' หากกดสองสายในอินพุต 10 ให้เลี้ยวซ้าย

GOSUB เลี้ยวซ้าย90

ELSEIF IN11 = 0 แล้ว 'ถ้ากดสองสายในอินพุต 11 แล้วเลี้ยวขวา

GOSUB เลี้ยวขวา90

ENDIF

LOOP

เลี้ยวขวา90:

' ขั้นตอนย่อยเพื่อเลี้ยวขวา 90 องศา

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

สูง 1

ต่ำ 0

สำหรับ MLoopC = 1 ถึง 22

PULSOUT LMOTOR, LfastRev 'ก้าวไปข้างหน้าหนึ่งพัลส์

PULSOUT RMOTOR, Rfast ' โดยใช้พินและค่าคงที่

หยุดชั่วคราว 20

' 20mS ช่วยให้หุ่นยนต์เคลื่อนที่ ' ก่อน NEXT pulse

ต่อไป

กลับ

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

เลี้ยวซ้าย90:

' ขั้นตอนย่อยเพื่อเลี้ยวขวา 90 องศา

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

สูง 0

ต่ำ 1

สำหรับ MLoopC = 1 ถึง 22

PULSOUT LMOTOR, Lfast 'ก้าวไปข้างหน้าหนึ่งพัลส์

PULSOUT RMOTOR, RfastRev ' โดยใช้พินและค่าคงที่

PAUSE 20 ' 20mS ช่วยให้หุ่นยนต์เคลื่อนที่ ' ก่อนถึง NEXT pulse

ต่อไป

กลับ

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

ไปข้างหน้าอย่างรวดเร็ว:

' Subprocedure เพื่อย้ายหุ่นยนต์ไปข้างหน้าอย่างรวดเร็วหนึ่งตาราง

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

สำหรับ MLoopC = 1 ถึง 70

พัลส์เอาท์ LMOTOR, LFast 'PULSOUT

RMOTOR = RFast

หยุดชั่วคราว 20

ต่อไป

กลับ