Facebook
From Morose Hornbill, 2 Months ago, written in Plain Text.
Embed
Download Paste or View Raw
Hits: 30
  1. .equ Digits_P = PORTB
  2. .equ Segments_P = PORTD
  3.  
  4. .def Digit_0 = R5
  5. .def Digit_1 = R4
  6. .def Digit_2 = R3
  7. .def Digit_3 = R2
  8.  
  9. .def PulseEdgeCtrL = R0
  10. .def PulseEdgeCtrH = R1
  11.  
  12. ; INPUTS
  13. .def XL=R16 ; divident
  14. .def XH=R17
  15.  
  16. .def YL=R18 ; divisor
  17. .def YH=R19
  18.  
  19. ; OUTPUTS
  20. .def RL=R16 ; remainder
  21. .def RH=R17
  22.  
  23. .def QL=R18 ; quotient
  24. .def QH=R19
  25.  
  26. ; INTERNAL
  27. .def QCtrL=R24
  28. .def QCtrH=R25
  29.  
  30.  
  31.  
  32. .macro LOAD_CONST
  33.         ldi @0, low(@2)
  34.         ldi @1, high(@2)
  35. .endmacro
  36.  
  37. .macro SET_DIGIT
  38.         mov R16, Digit_@0
  39.         rcall DigitTo7segCode
  40.         ldi R24, 2<<@0
  41.         out Digits_P, R24
  42.         out Segments_P, R16
  43.         rcall DelayInMs
  44. .endmacro
  45.  
  46.  
  47.  
  48. .cseg           ; segment pami─Öci kodu programu  
  49.  
  50. .org 0     ; ustawia pami─Ö─ç kodu na 0.
  51. rjmp main_loop  ; skok po resecie (do programu g┼é├│wnego)
  52. .org OC1Aaddr  
  53. rjmp _timer_isr ; skok do obsługi przerwania timera
  54.  
  55. _timer_isr:      ; procedura obs┼éugi przerwania timera
  56.     inc R0   ; jaki┼Ť kod
  57.     reti     ; powr├│t z procedury obs┼éugi przerwania (reti zamiast ret)  
  58.  
  59.  
  60.  
  61.         Divide:
  62. ; X/Y = Q * Y + R
  63.  
  64.         push R24
  65.         push R25
  66.  
  67.         LOAD_CONST QCtrL, QCtrH, 0
  68.  
  69.         Divide_2:
  70.                 cp XH, YH    ;cp por├│wnuje rejestry odejmuj─ůc je.
  71.                 brcs Divide_2_End ; XH < YH
  72.                 brne Divide_2_Sub ; XH > YH
  73.  
  74.                 cp XL, YL ; XH = YH
  75.                 brcs Divide_2_End ; XL < YL
  76.  
  77.                 Divide_2_Sub:
  78.                         sub XL, YL
  79.                         sbc XH, YH
  80.                         adiw QCtrL:QCtrH, 1
  81.                         rjmp Divide_2
  82.  
  83.                 Divide_2_End:
  84.                         mov QH, QCtrH
  85.                         mov QL, QCtrL
  86.                         mov RH, XH
  87.                         mov RL, XL
  88.  
  89.         pop R25
  90.         pop R24
  91.  
  92.         ret
  93.  
  94.  
  95.  
  96. DelayInMs:
  97.         push R24
  98.         push R25
  99.         LOAD_CONST R24, R25, 30
  100.         Loop_1:
  101.                 rcall DelayOneMs
  102.                 sbiw R24, 1
  103.         brne Loop_1
  104.         pop R25
  105.         pop R24
  106.         ret
  107.  
  108. DelayOneMs:
  109.         push R24
  110.         push R25
  111.  
  112.         LOAD_CONST R24, R25, 1750
  113.         Loop_2:
  114.                 sbiw R24, 1
  115.                 brne Loop_2
  116.  
  117.         pop R25
  118.         pop R24
  119.         ret
  120.  
  121.  
  122.  
  123.         DigitTo7segCode:
  124.  
  125.         push R30
  126.         push R31
  127.  
  128.         ldi R30, low(Table<<1)
  129.         ldi R31, high(Table<<1)
  130.  
  131.         add R30,R16
  132.         clr R16
  133.         adc R31,R16
  134.         lpm R16, Z
  135.  
  136.         pop R31
  137.         pop R30
  138.  
  139.         ret
  140.  
  141. Table: .db 0x3F, 0x06, 0x5B, 0x4F, 0x66, 0x6D, 0x7D, 0x07, 0xFF, 0x6F
  142.  
  143.  
  144.  
  145. NumberToDigits:
  146.         mov XL, PulseEdgeCtrL
  147.         mov XH, PulseEdgeCtrH
  148.         LOAD_CONST YL, YH, 1000
  149.         rcall Divide
  150.         mov Digit_0, QL
  151.  
  152.         LOAD_CONST YL, YH, 100
  153.         mov XH, RH
  154.         mov XL, RL
  155.         rcall Divide
  156.         mov Digit_1, QL
  157.  
  158.         LOAD_CONST YL, YH, 10
  159.         mov XH, RH
  160.         mov XL, RL
  161.         rcall Divide
  162.         mov Digit_2, QL
  163.  
  164.         mov Digit_3, RL
  165.         ret
  166.  
  167.  
  168.  
  169. Timer1_Init:   ; linijka 248 w manualu.
  170.         .equ Timer_Period = 32150
  171.  
  172.         ldi R16, TCCR1B|(1<<CS12)|(1<<WGM12)
  173.         out TCCR1B, R16
  174.         ldi R16, high(Timer_Period)
  175.         out OCR1AH, R16
  176.         ldi R16, low(Timer_Period)
  177.         out OCR1AL, R16
  178.         ldi R16, 1<<OCIE1A
  179.         out TIMSK, R16
  180.  
  181. push R27
  182. push R28
  183. LOAD_CONST R27, R28, 1234 ; TUTAJ WPISUJ─ś LICZB─ś
  184. mov PulseEdgeCtrH, R28
  185. mov PulseEdgeCtrL, R27
  186. pop R28
  187. pop R27
  188.  
  189. //clr PulseEdgeCtrL
  190. //clr PulseEdgeCtrH
  191.  
  192. rcall NumberToDigits
  193.  
  194.  
  195. Main_Loop:
  196.  
  197.         push R20
  198.         push R21
  199.         push R22
  200.  
  201.         ldi R20, 1
  202.         add PulseEdgeCtrL, R20
  203.         clr R20
  204.         adc PulseEdgeCtrH, R20
  205.  
  206.         LOAD_CONST R21, R22, 10000
  207.  
  208.         cp PulseEdgeCtrL, R21
  209.         brne Counter_End
  210.         cp PulseEdgeCtrH, R22
  211.         brne Counter_End
  212.  
  213.         clr PulseEdgeCtrL
  214.         clr PulseEdgeCtrH
  215.  
  216.         Counter_End:
  217.         rcall NumberToDigits
  218.  
  219.  
  220.  
  221.         SET_DIGIT 0
  222.         SET_DIGIT 1
  223.         SET_DIGIT 2
  224.         SET_DIGIT 3
  225.  
  226.         pop R22
  227.         pop R21
  228.         pop R20
  229.  
  230. rjmp Main_Loop