;********************โปรแกรมย่อยหยุดการทำงานมอเตอร์
.RESMOTOR
BRES PADR,#6 ; หยุดการทำงานของมอเตอร์ M2
BRES PADR,#7 ; หยุดการทำงานของมอเตอร์ M2
BRES PBDR,#3 ; หยุดการทำงานของมอเตอร์ M1
BRES PBDR,#4 ; หยุดการทำงานของมอเตอร์ M1
RET ;กลับสู่โปรแกรมหลัก
;************โปรแกรมย่อยสั่งงานให้มอเตอร์ทั้ง 2 ตัวเดินหน้า
.MOTORFOR
BSET PADR,#6 ;สั่งให้มอเตอร์ M2ทำงานเดินหน้า
BRES PADR,#7 ;สั่งให้มอเตอร์ M2ทำงานเดินหน้า
BSET PBDR,#3 ;สั่งให้มอเตอร์ M1ทำงานเดินหน้า
BRES PBDR,#4 ;สั่งให้มอเตอร์ M1ทำงานเดินหน้า
RET ;กลับสู่โปรแกรมหลัก
;***********โปรแกรมย่อยให้มอเตอร์ทำงานถอยหลังทั้ง 2 ตัว
.MOTORBACK
BRES PADR,#6 ;สั่งให้มอเตอร์ M2ทำงานถอยหลัง
BSET PADR,#7 ;สั่งให้มอเตอร์ M2ทำงานถอยหลัง
BRES PBDR,#3 ;สั่งให้มอเตอร์ M1ทำงานถอยหลัง
BSET PBDR,#4 ;สั่งให้มอเตอร์ M1ทำงานถอยหลัง
RET ;กลับสู่โปรแกรมหลัก
;************ โปรแกรมย่อยหมุนตัวหุ่น360องศาไปทางซ้าย
.LMOTOR
BRES PADR,#6 ;สั่งให้มอเตอร์ M2ทำงานถอยหลัง
BSET PADR,#7 ;สั่งให้มอเตอร์ M2ทำงานถอยหลัง
BSET PBDR,#3 ;สั่งให้มอเตอร์ M1ทำงานเดินหน้า
BRES PBDR,#4 ;สั่งให้มอเตอร์ M1ทำงานเดินหน้า
RET ;กลับสู่โปรแกรมหลัก
;************โปรแกรมย่อยหมุนตัวหุ่น360องศาไปทางขวา
.RMOTOR
BSET PADR,#6 ;สั่งให้มอเตอร์ M2ทำงานเดินหน้า
BRES PADR,#7 ;สั่งให้มอเตอร์ M2ทำงานเดินหน้า
BRES PBDR,#3 ;สั่งให้มอเตอร์ M1ทำงานถอยหลัง
BSET PBDR,#4 ;สั่งให้มอเตอร์ M1ทำงานถอยหลัง
RET ;กลับสู่โปรแกรมหลัก
;**********มอเตอร์1หยุด มอเตอร์2ทำงาน (เลี้ยวขวา)
.SM1RM2
BSET PADR,#6 ;สั่งให้มอเตอร์ M2ทำงานเดินหน้า
BRES PADR,#7 ;สั่งให้มอเตอร์ M2ทำงานเดินหน้า
BRES PBDR,#3 ; หยุดการทำงานของมอเตอร์ M1
BRES PBDR,#4 ; หยุดการทำงานของมอเตอร์ M1
RET ;กลับสู่โปรแกรมหลัก
;**********มอเตอร์1 ทำงาน มอเตอร์2หยุด (เลี้ยวซ้าย)
.RM1SM2
BRES PADR,#6 ; หยุดการทำงานของมอเตอร์ M2
BRES PADR,#7 ; หยุดการทำงานของมอเตอร์ M2
BSET PBDR,#3 ;สั่งให้มอเตอร์ M1ทำงานเดินหน้า
BRES PBDR,#4 ;สั่งให้มอเตอร์ M1ทำงานเดินหน้า
RET ;กลับสู่โปรแกรมหลัก

     
    มีต่อ...    

             ออกแบบและจัดทำโดย :: BASICLITE.COM
  Email: basic@basiclite.com   
   สายตรง