.include "8535def.inc"
 .org $0000
 rjmp reset
tab:.db $3f,$06,$5b,$4f,$66,$6d,$7d,$07,$7f,$6f
reset: ldi r16,low(ramend) ;棧指針置初值
       out spl,r16
       ldi r16,high(ramend)
       out sph,r16
       ldi r16,$ff         ;定義PB、PD為輸出口
       out ddrb,r16
       out ddrd,r16
       ldi r16,$ff         ;設待顯示數為$ffff
       ldi r17,$ff
       rcall b16td5        ;調二轉十子程
       mov r22,r20         ;將BCD碼送r18～r22
       mov r21,r19
       mov r20,r18
       mov r19,r17
       mov r18,r16 
aa:    rcall smiao         ;調動態掃描子程
       rjmp aa

smiao: ldi r16,$fe         ;送個位位線
       out portd, r16      
       mov r23,r18         ;將個位的BCD碼送R23
       rcall cqb           ;查七段碼，送B口輸出
       rcall t1ms          ;延時1ms
       ldi r16,$fd         ;送十位位線
       out portd, r16       
       mov r23,r19         ;將十位的BCD碼送R23
       rcall cqb           ;查七段碼，送B口輸出
       rcall t1ms          ;延時1ms
       ldi r16,$fb         ;送百位位線
       out portd,r16
       mov r23,r20         ;將百位的BCD碼送R23
       rcall cqb           ;查七段碼，送B口輸出
       rcall t1ms          ;延時1ms  
       ldi r16,$f7         ;送千位位線
       out portd,r16
       mov r23,r21         ;將千位的BCD碼送R23
       rcall cqb           ;查七段碼，送B口輸出
       rcall t1ms          ;延時1ms
       ldi r16,$ef         ;送萬位位線
       out portd,r16
       mov r23,r22         ;將萬位的BCD碼送R23
       rcall cqb           ;查七段碼，送B口輸出
       rcall t1ms          ;延時1ms
       ret 

cqb:   ldi zh,high(tab*2)  ;七段碼的首地址給Z
       ldi zl,low(tab*2)
       add zl,r23          ;首地址+偏移量
       lpm                 ;查表送B口輸出
       out portb,r0               
       ret

t1ms:  ldi r24,71         ;延時1毫秒子程
       push r24
del2:  push r24
del3:  dec r24
       brne del3
       pop r24
       dec r24
       brne del2
       pop r24
       ret 
b16td5:
	ser r20                    ;r20先送－1
b16td5_1:  
	inc r20                    ;r20增1
subi r16,low(10000)                ;（r17：r16）－10000
	sbci r17,high(10000)
	brcc 	b16td5_1           ;夠減則返回b16td5_1
	subi r16,low(-10000)       ;不夠減+10000，恢復余數
	sbci r17,high(-10000)
	ser r19                    ;r19先送－1
b16td5_2:
        inc r19                    ;r19增1   
        subi r16,low(1000)         ;（r17：r16）－10000
	sbci r17,high(1000)            
	brcc 	b16td5_2           ;夠減則返回b16td5_2
	subi r16,low(-1000)        ;不夠減+1000，恢復余數
	sbci r17,high(-1000)
	ser r18                    ;r18先送－1
b16td5_3:
	inc r18                    ;r18增1    
subi r16,low(100)                  ;（r17：r16）－100
	sbci r17,high(100)             
	brcc 	b16td5_3           ;夠減則返回b16td5_3
	subi r16,low(-100)         ;不夠減+100，恢復余數
	sbci r17,high(-100)
	ser r17                    ;r17先送－1
b16td5_4:
        inc r17                    ;r17增1
        subi r16,10                ;（r17：r16）－10          
	brcc 	b16td5_4           ;夠減則返回b16td5_4               
	subi r16,-10               ;不夠減+10，恢復余數
        ret