📄 td_tt.asm

📁 Robot control assembly program.
💻 ASM
📖 第 1 页 / 共 5 页
字号:
	
	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START

;=========CHUONH TRINH =========
CHUONG_TRINH_TRAI3:
;--GHI O 2 DIEM GAN PHIA DOI PHUONG
;--RA VUNG XUAT PHAT
	CALL	XUAT_PHAT_PHAI
;--CHAY THANG 11 VACH
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#9
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 3 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA TRAI
	CALL	CUA_TRAI
;--CHAY THANG 1 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 6 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#3
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 2 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 1 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	CALL	DUNG
	CALL	GHI_DIEM
	CALL	DELAY30S
	CALL	GIU_DIEM

	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START

;=========CHUONH TRINH 1=========
CHUONG_TRINH_TRAI4:	
;--GHI O 2 DIEM GAN PHIA TTAM
;--RA VUNG XUAT PHAT
	CALL	XUAT_PHAT_PHAI
;--CHAY THANG 11 VACH
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#9
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 2 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_TRAI
;--CHAY THANG 3 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA TRAI
	CALL	CUA_TRAI
;--CHAY THANG 1 VACH
	CALL	VAN_TOC_CHAM	;<-----
	CALL	CHAY_THANG_TIM_VACH_NGANG

	CALL	DUNG
	CALL	GHI_DIEM
	CALL	DELAY30S
	CALL	GIU_DIEM

	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START

;=========CHUONH TRINH 1=========
CHUONG_TRINH_PHAI1:	
;--GHI O 2 DIEM PHIA DOI DIEN DOI PHUONG
;--RA VUNG XUAT PHAT
	CALL	XUAT_PHAT_PHAI
;--CHAY THANG 10 VACH
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#8
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 7 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#4
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA TRAI
	CALL	CUA_TRAI
;--CHAY THANG 2 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG
	
	CALL	DUNG
	CALL	GHI_DIEM
	CALL	DELAY30S
	CALL	GIU_DIEM

	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START
;=========CHUONH TRINH 1=========
CHUONG_TRINH_PHAI2:	
;--PHIA THAP 
;--RA VUNG XUAT PHAT
	CALL	XUAT_PHAT_PHAI
;--CHAY THANG 10 VACH
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#8
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 5 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#2
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA TRAI
	CALL	CUA_TRAI
;--CHAY THANG 3 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

	CALL	CUA_PHAI
;--CHAY THANG 1 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	CALL	DUNG
	CALL	GHI_DIEM
	CALL	DELAY30S
	CALL	GIU_DIEM

	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START

;=========CHUONH TRINH 1=========
CHUONG_TRINH_PHAI3:	
;--GHI O 2 DIEM DOI PHUONG PHIA DOI PHUONG,CHONG RETRY
;--RA VUNG XUAT PHAT
	CALL	XUAT_PHAT_PHAI
;--CHAY THANG 10 VACH
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#8
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 9 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#6
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA TRAI
	CALL	CUA_TRAI
;--CHAY THANG 5 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#2
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG
	
;--CUA TRAI
	CALL	CUA_TRAI
;--CHAY THANG 2 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA TRAI
	CALL	CUA_TRAI
;--CHAY THANG 1 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	CALL	DUNG
	CALL	GHI_DIEM
	CALL	DELAY30S
	CALL	GIU_DIEM

	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START
;=========CHUONH TRINH 12=========
CHUONG_TRINH_PHAI4:	
;--GHI O 2 DIEM DOI PHUONG PHIA THAP DOI PHUONG
;--RA VUNG XUAT PHAT
	CALL	XUAT_PHAT_PHAI
;--CHAY THANG 11 VACH
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#8
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 9 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#6
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA TRAI
	CALL	CUA_TRAI
;--CHAY THANG 3 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG
	
;--CUA TRAI
	CALL	CUA_TRAI
;--CHAY THANG 1 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	CALL	DUNG
	CALL	GHI_DIEM
	CALL	DELAY30S
	CALL	GIU_DIEM

	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START
;=========CHUONH TRINH TRANG 1=========
CHUONG_TRINH_TRANG2:	
;--GHI O 1 DIEM
;--RA VUNG XUAT PHAT
	CALL	XUAT_PHAT_PHAI
;--CHAY THANG 7 VACH	
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#5
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI_O_1_DIEM
	CALL	GHI_O_1_DIEM
	CALL	HIEU_CHINH_DIEM
	MOV	ENCODER_CAO,#HIGH(ENCODER_1_VACH/10)
	MOV	ENCODER_THAP,#LOW(ENCODER_1_VACH/10)	
	CALL	CHAY_LUI_ENCODER
	
	CALL	DUNG_MOTOR
	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START
;=========CHUONG TRINH 1A ========
CHUONG_TRINH_TRANG1:	
;--GHI O 1 DIEM
;--RA VUNG XUAT PHAT
	CALL	XUAT_PHAT_PHAI
;--CHAY THANG 7 VACH	
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#5
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI_O_1_DIEM
	MOV	BANH_TRAI,#0
	MOV	BANH_PHAI,#0
	CALL	DELAY2MIN
	CALL	GHI_O_1_DIEM
	CALL	HIEU_CHINH_DIEM
	MOV	ENCODER_CAO,#HIGH(ENCODER_1_VACH/10)
	MOV	ENCODER_THAP,#LOW(ENCODER_1_VACH/10)	
	CALL	CHAY_LUI_ENCODER

	CALL	DUNG_MOTOR
	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START
;=========CHUONH TRINH 1=========
CHUONG_TRINH_TT_CP1:
;--PHA O TT PHIA DOI DIEN DOI PHUONG
;--RA VUNG XUAT PHAT
	CALL	XUAT_PHAT_PHAI
;--CHAY THANG 7 VACH
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#5
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI_O_1_DIEM
	CALL	GHI_O_1_DIEM
	CALL	CUA_TRAI_90
;--CHAY THANG 3 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 3 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_TB
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA TRAI
	CALL	CUA_TRAI
;--CHAY THANG 2 VACH
	CALL	PHA_DIEM

	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START
;==========CHUONG TRINH  2 =====
CHUONG_TRINH_TT_CP2:	
;--PHA O TT PHIA THAP
;--RA VUNG XUAT PHAT
	CALL	XUAT_PHAT_PHAI
;--CHAY THANG 7 VACH
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG_TIM_VACH_NGANG
	
	MOV	DEM_VACH,#5
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI_O_1_DIEM
	CALL	GHI_O_1_DIEM
	CALL	CUA_TRAI_90
;--CHAY THANG 3 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG
💿 文件大小 187 K
👤 上传用户 peterzhang1982
📂 所属分类汇编语言
🏷️ 相关标签

#assembly #control #program #Robot
⌨️ 快捷键说明

复制代码 Ctrl + C
搜索代码 Ctrl + F
全屏模式 F11
切换主题 Ctrl + Shift + D
显示快捷键 ?
增大字号 Ctrl + =
减小字号 Ctrl + -