ช่วยเเนะนำการเขียนโค้ด การใช้งาน Arduino mega 2560 ร่วมกับ Proximity sensor

ลักษณะการทำงานนะครับ จะมี Prox. sensor อยู่ 2 ตัว เซนเซอร์เเต่ละตัวจะมีหลอด LED ประจำตำแหน่งอยู่ 2 สี คือเเดงเเละเขียว ในสภาวะปกติ led สีเขียวจะติด เเต่เมื่อเซนเซอร์ตัวใดมีการตรวจจับได้จะเปลี่ยนเป็นสีเเดง

- เมื่อเซนเซอร์ตัวที่1 ตรวจจับได้ LED ประจำตำแหน่งเซนเซอร์ตัวที่1 สีเเดงจะติด (ตัวที่ไม่มีการตรวจจับสีเขียวจะติด)  จนกว่าเซนเซอร์ตัวที่ 2จะตรวจจับได้ led ประจำตำแหน่งเซนเซอร์1 ถึงจะเปลี่ยนเป็นสีเขียว

- เงื่อนไขมีอยู่ว่า ถ้าเซนเซอร์ตัวที่ 1 มีการตรวจจับวัตถุได้กี่ครั้งต่อเนื่องกัน เซนเซอร์ตัวที่ 2 ต้องตรวจจับได้เท่ากับตัวที่1 led ประจำเซนเซอร์ตัวที่1 ถึงจะเปลี่ยนเป็นสีเขียว

ตัวย่าง

- sensor1  มีการตรวจจับวัตถุได้ 3 ครั้งต่อเนื่องกัน (led ประจำ sensor1 เปลี่ยนจากเขียวเป็นเเดง ledประจำ sensor2 เป๊นสีเเดง)

- sensor2 มีการตรวจจับวัตถุได้ครั้งที่ 1 (led ประจำ sensor2 เปลี่ยนจากเขียวเป็นแดง เเละ led ประจำ sensor1 ยังคงเป็นสีเเดง) 

- sensor2 มีการตรวจจับวัตถุได้ครั้งที่ 2 (led ประจำ sensor2 ยังคงเป็นสีแดง เเละ led ประจำ sensor1 ยังคงเป็นสีเเดง) 

- sensor2 มีการตรวจจับวัตถุได้ครั้งที่ 3 เท่ากับsensor1 (led ประจำ sensor2 ยังคงเป็นสีแดง เเต่ led ประจำ sensor1 เปลี่ยนเป็นสีเขียว) 

ลักษณะจะเป็นการทำงานเเบบนี้วนซ้ำๆ เนื่องจากผมจะนำไปใช้ในเเบบจำลองตรวจจับตำเเหน่งรถไฟด้วยการเเสดงผมด้วยหลอด led 

ผู้รู้ท่านใดทราบการเขียนโค้ดช่วยเเนะนำผมหน่อยนะครับ

ขอบคุณครับ