برنامه روبات تعقیب خط

automata

عضو جدید
سلام مهندسین عزیز. برنامه زیر به زبان میکرو کنترلر 8051 میباشد. در برنامه زیر به روبات 3 سنسور در نظر گرفتم که البته هرچقدر سنسورها بیشتر باشه عملکردش خوبتره. در ضمن برنامه روبات زیر مانع INVERSE رو هم تشخیص میده. البته موناع دیگری هم هست مثل مانع خازنی که دیگه نتونستم برسم تا بنویسمش. اگه خطایی هم داشته باشه بهم بگین.
ORG 30H
MOV P1,#07H​
AGAIN: MOV A,P1​
CJNE A,#06H,K1​
CPL A​
ANL A,#00000111​
SJMP K3​
K1:CJNE A1,03H,K2​
CPL A​
ANL A,#00000111​
SJMP K3​
K2:CJNE A,#05H,K3​
CPL A​
ANL A,#00000111​
SJMP​
K3:CJNE A,#01H,L1​
CLR P2.0​
SETB P2.1​
SJMP AGAIN​
L1:CJNE A,#02H,L2​
SETB P2.0​
CLR P2.1​
SJMP AGAIN​
L2:SETB P2.0​
SETB P2.1​
SJMP AGAIN​
 
بالا