จงเขียนโปรแกรมควบคุมหุ่นยนต์แบบ 3 ล้อ (ขับ 2 ล้อซ้ายขวา 1 ล้อหลังเป็นล้อตาม) โดยใช้มอเตอร์ขับ 2 ล้อซ้ายขวา และเซนเซอร์ 2 ตัวเป็นการตรวจสอบการชนของหุ่นยนต์ โดยมีเงื่อนไขดังนี้
- ถ้าไม่ได้รับสัญญาณเซนเซอร์ (สวิตช์ไม่ถูกกด) ให้มอเตอร์ทั้ง 2 หมุนไปหน้า
- ถ้าได้รับสัญญาณเซนเซอร์จากตัวที่ 1 ให้มอเตอร์ตัวที่ 1 หยุดหมุนและให้มอเตอร์ตัวที่ 2 หมุนถอยหลังเป็นเวลา 2 วินาที
- ถ้าได้รับสัญญาณเซนเซอร์จากตัวที่ 2 ให้มอเตอร์ตัวที่ 2 หยุดหมุนและให้มอเตอร์ตัวที่ 1 หมุนถอยหลังเป็นเวลา 2 วินาที
- ถ้าได้รับสัญญาณเซนเซอร์จากตัวที่ 1 และตัวที่ 2 ให้มอเตอร์ทั้งตัวที่ 1 และ 2 หมุนถอยหลังเป็นเวลา 2 วินาที ต่อจากนั้นมอเตอร์ตัวที่ 2 หมุนถอยหลังต่อไปอีกเป็นเวลา 2 วินาที (ตัวที่ 1 หยุดหมุน)
สวิตช์ s1,s2 ใช้วงจรสวิตช์ของใบงานที่ 2
