Facebook
From Beefy Crow, 2 Months ago, written in Plain Text.
Embed
Download Paste or View Raw
Hits: 38
  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.  
  57.         ; COUNTER:
  58.                 push R20
  59.                 push R21
  60.                 push R22
  61.  
  62.                 ldi R20, 1
  63.                 add PulseEdgeCtrL, R20
  64.                 clr R20
  65.                 adc PulseEdgeCtrH, R20
  66.  
  67.                 LOAD_CONST R21, R22, 10000
  68.  
  69.                 cp PulseEdgeCtrL, R21
  70.                 brne Counter_End
  71.                 cp PulseEdgeCtrH, R22
  72.                 brne Counter_End
  73.  
  74.                 clr PulseEdgeCtrL
  75.                 clr PulseEdgeCtrH
  76.  
  77.                 Counter_End:
  78.  
  79.                 rcall NumberToDigits
  80.  
  81.                 pop R22
  82.                 pop R21
  83.                 pop R20
  84.  
  85. reti     ; powr├│t z procedury obs┼éugi przerwania (reti zamiast ret)  
  86.  
  87.  
  88.  
  89.         Divide:
  90. ; X/Y = Q * Y + R
  91.  
  92.         push R24
  93.         push R25
  94.  
  95.         LOAD_CONST QCtrL, QCtrH, 0
  96.  
  97.         Divide_2:
  98.                 cp XH, YH    ;cp por├│wnuje rejestry odejmuj─ůc je.
  99.                 brcs Divide_2_End ; XH < YH
  100.                 brne Divide_2_Sub ; XH > YH
  101.  
  102.                 cp XL, YL ; XH = YH
  103.                 brcs Divide_2_End ; XL < YL
  104.  
  105.                 Divide_2_Sub:
  106.                         sub XL, YL
  107.                         sbc XH, YH
  108.                         adiw QCtrL:QCtrH, 1
  109.                         rjmp Divide_2
  110.  
  111.                 Divide_2_End:
  112.                         mov QH, QCtrH
  113.                         mov QL, QCtrL
  114.                         mov RH, XH
  115.                         mov RL, XL
  116.  
  117.         pop R25
  118.         pop R24
  119.  
  120.         ret
  121.  
  122.  
  123.  
  124. DelayInMs:
  125.         push R24
  126.         push R25
  127.         LOAD_CONST R24, R25, 30
  128.         Loop_1:
  129.                 rcall DelayOneMs
  130.                 sbiw R24, 1
  131.         brne Loop_1
  132.         pop R25
  133.         pop R24
  134.         ret
  135.  
  136. DelayOneMs:
  137.         push R24
  138.         push R25
  139.  
  140.         LOAD_CONST R24, R25, 1750
  141.         Loop_2:
  142.                 sbiw R24, 1
  143.                 brne Loop_2
  144.  
  145.         pop R25
  146.         pop R24
  147.         ret
  148.  
  149.  
  150.  
  151.         DigitTo7segCode:
  152.  
  153.         push R30
  154.         push R31
  155.  
  156.         ldi R30, low(Table<<1)
  157.         ldi R31, high(Table<<1)
  158.  
  159.         add R30,R16
  160.         clr R16
  161.         adc R31,R16
  162.         lpm R16, Z
  163.  
  164.         pop R31
  165.         pop R30
  166.  
  167.         ret
  168.  
  169. Table: .db 0x3F, 0x06, 0x5B, 0x4F, 0x66, 0x6D, 0x7D, 0x07, 0xFF, 0x6F
  170.  
  171.  
  172.  
  173. NumberToDigits:
  174.         mov XL, PulseEdgeCtrL
  175.         mov XH, PulseEdgeCtrH
  176.         LOAD_CONST YL, YH, 1000
  177.         rcall Divide
  178.         mov Digit_0, QL
  179.  
  180.         LOAD_CONST YL, YH, 100
  181.         mov XH, RH
  182.         mov XL, RL
  183.         rcall Divide
  184.         mov Digit_1, QL
  185.  
  186.         LOAD_CONST YL, YH, 10
  187.         mov XH, RH
  188.         mov XL, RL
  189.         rcall Divide
  190.         mov Digit_2, QL
  191.  
  192.         mov Digit_3, RL
  193.         ret
  194.  
  195.  
  196.  
  197. Main_Loop:
  198.  
  199. Timer1_Init:   ; linijka 248 w manualu.
  200.  
  201.         .equ Timer_Period = 32150
  202.  
  203.         ldi R16, TCCR1B|(1<<CS12)|(1<<WGM12)
  204.         out TCCR1B, R16
  205.         ldi R16, high(Timer_Period)
  206.         out OCR1AH, R16
  207.         ldi R16, low(Timer_Period)
  208.         out OCR1AL, R16
  209.         ldi R16, 1<<OCIE1A
  210.         out TIMSK, R16
  211.  
  212.  
  213.  
  214.         push R27
  215.         push R28
  216.         LOAD_CONST R27, R28, 1234 ; TUTAJ WPISUJ─ś LICZB─ś
  217.         mov PulseEdgeCtrH, R28
  218.         mov PulseEdgeCtrL, R27
  219.         pop R28
  220.         pop R27
  221.  
  222.         //clr PulseEdgeCtrL
  223.         //clr PulseEdgeCtrH
  224.  
  225.         rcall NumberToDigits
  226.  
  227.         sei
  228.  
  229.         SET_DIGIT 0
  230.         SET_DIGIT 1
  231.         SET_DIGIT 2
  232.         SET_DIGIT 3
  233.  
  234. rjmp Main_Loop