📄 td_tt.asm

📁 Robot control assembly program.
💻 ASM
📖 第 1 页 / 共 5 页
字号:

	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,#5
	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	PHA_DIEM

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

;==========CHUONG TRINH  3 =====
CHUONG_TRINH_TT_CP3:	
;--PHA O TT PHIA 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_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 10 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,#7
	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 PHAI
	CALL	CUA_PHAI

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

;==========CHUONG TRINH  4 =====
CHUONG_TRINH_TT_CP4:
;--GHI O TT PHIA THAP 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_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 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 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

	CALL	PHA_DIEM

	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START
;==========CHUONG TRINH  5 =====
CHUONG_TRINH_TRAI_CP1:	
;--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 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#2
	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 6 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#3
	CALL	VAN_TOC_MAX
	CALL	CHAY_THANG

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

;==========CHUONG TRINH  6 =====
CHUONG_TRINH_TRAI_CP2:
;--PHA O 2 DIEM 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 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#2
	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_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 PHAI
	CALL	CUA_PHAI
;--CHAY THANG 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	ENCODER_THAP,#LOW(ENCODER_1_VACH*3)
	MOV	ENCODER_CAO,#HIGH(ENCODER_1_VACH*3)
	CALL	CHAY_THANG_NUA_PHAI
;--CUA PHAI
	CALL	CUA_PHAI
;--CHAY THANG 1 VACH
	CALL	PHA_DIEM

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

;=========CHUONH TRINH =========
CHUONG_TRINH_TRAI_CP3:
;--PHA O 2 DIEM GAN PHIA 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 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#2
	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 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 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

	CALL	PHA_DIEM

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

;=========CHUONH TRINH 1=========
CHUONG_TRINH_TRAI_CP4:	
;--GHI O 2 DIEM GAN PHIA TTAM
;--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 4 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#2
	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 3 VACH
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG_TIM_VACH_NGANG

	MOV	DEM_VACH,#2
	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

	CALL	PHA_DIEM

	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START
;=========CHUONH TRINH 1=========
CHUONG_TRINH_PHAI_CP1:	
;--PHA O 2 DIEM PHIA DOI DIEN DOI PHUONG
	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_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,#2
	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,#5
	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	PHA_DIEM

	JB	NUT_TT1,$
	MOV	BYTE_LED_THAP,#88
	CALL	DELAY1S
	JMP	START
;=========CHUONH TRINH 1=========
CHUONG_TRINH_PHAI_CP2:	
;--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_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,#2
	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,#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_MAX
	CALL	CHAY_THANG

	MOV	DEM_VACH,#1
	CALL	VAN_TOC_CHAM
	CALL	CHAY_THANG

	CALL	CUA_PHAI
	CALL	PHA_DIEM

	CALL	DUNG

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

;=========CHUONH TRINH 1=========
💿 文件大小 187 K
👤 上传用户 peterzhang1982
📂 所属分类汇编语言
🏷️ 相关标签

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

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