API tools faq
paste
Advertisement
Xisabla

Assembly project

Xisabla
Oct 11th, 2021
3,190
0
Never
Add comment
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
M68000 Assembler 32.59 KB | None | 0 0
raw download clone embed print report diff
  1. ;*******************************************************************************
  2. ;                                                                              *
  3. ;    Microchip licenses this software to you solely for use with Microchip     *
  4. ;    products. The software is owned by Microchip and/or its licensors, and is *
  5. ;    protected under applicable copyright laws.  All rights reserved.          *
  6. ;                                                                              *
  7. ;    This software and any accompanying information is for suggestion only.    *
  8. ;    It shall not be deemed to modify Microchip?s standard warranty for its    *
  9. ;    products.  It is your responsibility to ensure that this software meets   *
  10. ;    your requirements.                                                        *
  11. ;                                                                              *
  12. ;    SOFTWARE IS PROVIDED "AS IS".  MICROCHIP AND ITS LICENSORS EXPRESSLY      *
  13. ;    DISCLAIM ANY WARRANTY OF ANY KIND, WHETHER EXPRESS OR IMPLIED, INCLUDING  *
  14. ;    BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS    *
  15. ;    FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT. IN NO EVENT SHALL          *
  16. ;    MICROCHIP OR ITS LICENSORS BE LIABLE FOR ANY INCIDENTAL, SPECIAL,         *
  17. ;    INDIRECT OR CONSEQUENTIAL DAMAGES, LOST PROFITS OR LOST DATA, HARM TO     *
  18. ;    YOUR EQUIPMENT, COST OF PROCUREMENT OF SUBSTITUTE GOODS, TECHNOLOGY OR    *
  19. ;    SERVICES, ANY CLAIMS BY THIRD PARTIES (INCLUDING BUT NOT LIMITED TO ANY   *
  20. ;    DEFENSE THEREOF), ANY CLAIMS FOR INDEMNITY OR CONTRIBUTION, OR OTHER      *
  21. ;    SIMILAR COSTS.                                                            *
  22. ;                                                                              *
  23. ;    To the fullest extend allowed by law, Microchip and its licensors         *
  24. ;    liability shall not exceed the amount of fee, if any, that you have paid  *
  25. ;    directly to Microchip to use this software.                               *
  26. ;                                                                              *
  27. ;    MICROCHIP PROVIDES THIS SOFTWARE CONDITIONALLY UPON YOUR ACCEPTANCE OF    *
  28. ;    THESE TERMS.                                                              *
  29. ;                                                                              *
  30. ;*******************************************************************************
  31. ;                                                                              *
  32. ;    Filename: main.asm                                                        *
  33. ;    Date: 13/01/2020                                                          *
  34. ;    File Version: 1.0.0                                                       *
  35. ;    Author: MIQUET Gautier                                                    *
  36. ;    Company: PROJET ELEC ISEN - Equipe 1                                      *
  37. ;    Description: Main source file of the electronic projet (week 2)           *
  38. ;                                                                              *
  39. ;*******************************************************************************
  40. ;                                                                              *
  41. ;    Notes: In the MPLAB X Help, refer to the MPASM Assembler documentation    *
  42. ;    for information on assembly instructions.                                 *
  43. ;                                                                              *
  44. ;*******************************************************************************
  45. ;                                                                              *
  46. ;    Known Issues: This template is designed for relocatable code.  As such,   *
  47. ;    build errors such as "Directive only allowed when generating an object    *
  48. ;    file" will result when the 'Build in Absolute Mode' checkbox is selected  *
  49. ;    in the project properties.  Designing code in absolute mode is            *
  50. ;    antiquated - use relocatable mode.                                        *
  51. ;                                                                              *
  52. ;*******************************************************************************
  53. ;                                                                              *
  54. ;    Revision History:                                                         *
  55. ;                                                                              *
  56. ;*******************************************************************************
  57.  
  58.  
  59.  
  60. ;*******************************************************************************
  61. ; Processor Inclusion
  62. ;
  63. ; TODO Step #1 Open the task list under Window > Tasks.  Include your
  64. ; device .inc file - e.g. #include <device_name>.inc.  Available
  65. ; include files are in C:\Program Files\Microchip\MPLABX\mpasmx
  66. ; assuming the default installation path for MPLAB X.  You may manually find
  67. ; the appropriate include file for your device here and include it, or
  68. ; simply copy the include generated by the configuration bits
  69. ; generator (see Step #2).
  70. ;
  71. ;*******************************************************************************
  72.  
  73. #include "p18f25k40.inc"
  74.  
  75. ;*******************************************************************************
  76. ;
  77. ; TODO Step #2 - Configuration Word Setup
  78. ;
  79. ; The 'CONFIG' directive is used to embed the configuration word within the
  80. ; .asm file. MPLAB X requires users to embed their configuration words
  81. ; into source code.  See the device datasheet for additional information
  82. ; on configuration word settings.  Device configuration bits descriptions
  83. ; are in C:\Program Files\Microchip\MPLABX\mpasmx\P<device_name>.inc
  84. ; (may change depending on your MPLAB X installation directory).
  85. ;
  86. ; MPLAB X has a feature which generates configuration bits source code.  Go to
  87. ; Window > PIC Memory Views > Configuration Bits.  Configure each field as
  88. ; needed and select 'Generate Source Code to Output'.  The resulting code which
  89. ; appears in the 'Output Window' > 'Config Bits Source' tab may be copied
  90. ; below.
  91. ;
  92. ;*******************************************************************************
  93.  
  94. ; CONFIG1L
  95.   CONFIG  FEXTOSC = OFF         ; External Oscillator mode Selection bits (Oscillator not enabled)
  96.   CONFIG  RSTOSC = HFINTOSC_64MHZ; Power-up default value for COSC bits (HFINTOSC with HFFRQ = 64 MHz and CDIV = 1:1)
  97.  
  98. ; CONFIG1H
  99.   CONFIG  CLKOUTEN = OFF        ; Clock Out Enable bit (CLKOUT function is disabled)
  100.   CONFIG  CSWEN = ON            ; Clock Switch Enable bit (Writing to NOSC and NDIV is allowed)
  101.   CONFIG  FCMEN = ON            ; Fail-Safe Clock Monitor Enable bit (Fail-Safe Clock Monitor enabled)
  102.  
  103. ; CONFIG2L
  104.   CONFIG  MCLRE = EXTMCLR       ; Master Clear Enable bit (If LVP = 0, MCLR pin is MCLR; If LVP = 1, RE3 pin function is MCLR )
  105.   CONFIG  PWRTE = OFF           ; Power-up Timer Enable bit (Power up timer disabled)
  106.   CONFIG  LPBOREN = OFF         ; Low-power BOR enable bit (ULPBOR disabled)
  107.   CONFIG  BOREN = SBORDIS       ; Brown-out Reset Enable bits (Brown-out Reset enabled , SBOREN bit is ignored)
  108.  
  109. ; CONFIG2H
  110.   CONFIG  BORV = VBOR_2P45      ; Brown Out Reset Voltage selection bits (Brown-out Reset Voltage (VBOR) set to 2.45V)
  111.   CONFIG  ZCD = OFF             ; ZCD Disable bit (ZCD disabled. ZCD can be enabled by setting the ZCDSEN bit of ZCDCON)
  112.   CONFIG  PPS1WAY = ON          ; PPSLOCK bit One-Way Set Enable bit (PPSLOCK bit can be cleared and set only once; PPS registers remain locked after one clear/set cycle)
  113.   CONFIG  STVREN = ON           ; Stack Full/Underflow Reset Enable bit (Stack full/underflow will cause Reset)
  114.   CONFIG  DEBUG = OFF           ; Debugger Enable bit (Background debugger disabled)
  115.   CONFIG  XINST = OFF           ; Extended Instruction Set Enable bit (Extended Instruction Set and Indexed Addressing Mode disabled)
  116.  
  117. ; CONFIG3L
  118.   CONFIG  WDTCPS = WDTCPS_31    ; WDT Period Select bits (Divider ratio 1:65536; software control of WDTPS)
  119.   CONFIG  WDTE = OFF            ; WDT operating mode (WDT Disabled)
  120.  
  121. ; CONFIG3H
  122.   CONFIG  WDTCWS = WDTCWS_7     ; WDT Window Select bits (window always open (100%); software control; keyed access not required)
  123.   CONFIG  WDTCCS = SC           ; WDT input clock selector (Software Control)
  124.  
  125. ; CONFIG4L
  126.   CONFIG  WRT0 = OFF            ; Write Protection Block 0 (Block 0 (000800-001FFFh) not write-protected)
  127.   CONFIG  WRT1 = OFF            ; Write Protection Block 1 (Block 1 (002000-003FFFh) not write-protected)
  128.   CONFIG  WRT2 = OFF            ; Write Protection Block 2 (Block 2 (004000-005FFFh) not write-protected)
  129.   CONFIG  WRT3 = OFF            ; Write Protection Block 3 (Block 3 (006000-007FFFh) not write-protected)
  130.  
  131. ; CONFIG4H
  132.   CONFIG  WRTC = OFF            ; Configuration Register Write Protection bit (Configuration registers (300000-30000Bh) not write-protected)
  133.   CONFIG  WRTB = OFF            ; Boot Block Write Protection bit (Boot Block (000000-0007FFh) not write-protected)
  134.   CONFIG  WRTD = OFF            ; Data EEPROM Write Protection bit (Data EEPROM not write-protected)
  135.   CONFIG  SCANE = ON            ; Scanner Enable bit (Scanner module is available for use, SCANMD bit can control the module)
  136.   CONFIG  LVP = OFF             ; Low Voltage Programming Enable bit (HV on MCLR/VPP must be used for programming)
  137.  
  138. ; CONFIG5L
  139.   CONFIG  CP = OFF              ; UserNVM Program Memory Code Protection bit (UserNVM code protection disabled)
  140.   CONFIG  CPD = OFF             ; DataNVM Memory Code Protection bit (DataNVM code protection disabled)
  141.  
  142. ; CONFIG5H
  143.  
  144. ; CONFIG6L
  145.   CONFIG  EBTR0 = OFF           ; Table Read Protection Block 0 (Block 0 (000800-001FFFh) not protected from table reads executed in other blocks)
  146.   CONFIG  EBTR1 = OFF           ; Table Read Protection Block 1 (Block 1 (002000-003FFFh) not protected from table reads executed in other blocks)
  147.   CONFIG  EBTR2 = OFF           ; Table Read Protection Block 2 (Block 2 (004000-005FFFh) not protected from table reads executed in other blocks)
  148.   CONFIG  EBTR3 = OFF           ; Table Read Protection Block 3 (Block 3 (006000-007FFFh) not protected from table reads executed in other blocks)
  149.  
  150. ; CONFIG6H
  151.   CONFIG  EBTRB = OFF           ; Boot Block Table Read Protection bit (Boot Block (000000-0007FFh) not protected from table reads executed in other blocks)
  152.  
  153.  
  154. ;*******************************************************************************
  155. ;
  156. ; TODO Step #3 - Variable Definitions
  157. ;
  158. ; Refer to datasheet for available data memory (RAM) organization assuming
  159. ; relocatible code organization (which is an option in project
  160. ; properties > mpasm (Global Options)).  Absolute mode generally should
  161. ; be used sparingly.
  162. ;
  163. ; Example of using GPR Uninitialized Data
  164. ;
  165. ;   GPR_VAR        UDATA
  166. ;   MYVAR1         RES        1      ; User variable linker places
  167. ;   MYVAR2         RES        1      ; User variable linker places
  168. ;   MYVAR3         RES        1      ; User variable linker places
  169. ;
  170. ;   ; Example of using Access Uninitialized Data Section (when available)
  171. ;   ; The variables for the context saving in the device datasheet may need
  172. ;   ; memory reserved here.
  173. ;   INT_VAR        UDATA_ACS
  174. ;   W_TEMP         RES        1      ; w register for context saving (ACCESS)
  175. ;   STATUS_TEMP    RES        1      ; status used for context saving
  176. ;   BSR_TEMP       RES        1      ; bank select used for ISR context saving
  177. ;
  178. ;*******************************************************************************
  179.  
  180. INT_VAR UDATA_ACS
  181.  
  182. ; TEMPO ITERATORS
  183. i RES 1
  184. j RES 1
  185. k RES 1
  186.  
  187. ; MATRIX SIZE
  188. MATRIX_WIDTH RES 1
  189. MATRIX_HEIGHT RES 1
  190.  
  191. ; MATRIX ITERATOR
  192. MATRIX_ITR RES 1
  193.  
  194. ; VECOTR POINTER
  195. VEC_HIGH RES 1
  196. VEC_LOW RES 1
  197.  
  198. ; VECTOR SIZE
  199. VEC_SIZE RES 1
  200.  
  201. ; TILE LED STREAM ITERATOR
  202. TILE_ITR RES 1
  203.  
  204. ; FILL VECTOR ITERATOR
  205. FILL_ITR RES 1
  206.  
  207. ; COLUMN LEVEL TO STREAM
  208. COL_LEVEL RES 1
  209.  
  210. ; FREQUENCIES VALUES [0, 8]
  211. FREQ_LOW RES 1
  212. FREQ_MED_LOW RES 1
  213. FREQ_MED_HIGH RES 1
  214. FREC_HIGH RES 1
  215.  
  216. FREQ_LEVEL RES 1
  217.  
  218. TEMP RES 1
  219.  
  220. ;*******************************************************************************
  221. ; Reset Vector
  222. ;*******************************************************************************
  223.  
  224. RES_VECT  CODE    0x0000            ; processor reset vector
  225.     GOTO    RUN                   ; go to beginning of program
  226.  
  227. ;*******************************************************************************
  228. ; TODO Step #4 - Interrupt Service Routines
  229. ;
  230. ; There are a few different ways to structure interrupt routines in the 8
  231. ; bit device families.  On PIC18's the high priority and low priority
  232. ; interrupts are located at 0x0008 and 0x0018, respectively.  On PIC16's and
  233. ; lower the interrupt is at 0x0004.  Between device families there is subtle
  234. ; variation in the both the hardware supporting the ISR (for restoring
  235. ; interrupt context) as well as the software used to restore the context
  236. ; (without corrupting the STATUS bits).
  237. ;
  238. ; General formats are shown below in relocatible format.
  239. ;
  240. ;------------------------------PIC16's and below--------------------------------
  241. ;
  242. ; ISR       CODE    0x0004           ; interrupt vector location
  243. ;
  244. ;     <Search the device datasheet for 'context' and copy interrupt
  245. ;     context saving code here.  Older devices need context saving code,
  246. ;     but newer devices like the 16F#### don't need context saving code.>
  247. ;
  248. ;     RETFIE
  249. ;
  250. ;----------------------------------PIC18's--------------------------------------
  251. ;
  252. ; ISRHV     CODE    0x0008
  253. ;     GOTO    HIGH_ISR
  254. ; ISRLV     CODE    0x0018
  255. ;     GOTO    LOW_ISR
  256. ;
  257. ; ISRH      CODE                     ; let linker place high ISR routine
  258. ; HIGH_ISR
  259. ;     <Insert High Priority ISR Here - no SW context saving>
  260. ;     RETFIE  FAST
  261. ;
  262. ; ISRL      CODE                     ; let linker place low ISR routine
  263. ; LOW_ISR
  264. ;       <Search the device datasheet for 'context' and copy interrupt
  265. ;       context saving code here>
  266. ;     RETFIE
  267. ;
  268. ;*******************************************************************************
  269.  
  270. ; TODO INSERT ISR HERE
  271.  
  272. ;*******************************************************************************
  273. ; MAIN PROGRAM
  274. ;*******************************************************************************
  275.  
  276. MAIN_PROG CODE                      ; let linker place main program
  277.  
  278. ;*******************************************************************************
  279. ; MAIN VALUES INIT
  280. ;*******************************************************************************
  281.  
  282. INIT
  283.     ; INPUTS/OUTPUTS
  284.     MOVLW b'00011111'
  285.     MOVWF TRISA         ; Set A INPUT for ADC
  286.     MOVLW 0x00
  287.     MOVWF TRISB         ; Set B as OUTPUT
  288.     MOVLW 0x00
  289.     MOVWF TRISC         ; Set C as OUTPUT
  290.    
  291.     ; SET BSR BANK
  292.     MOVLB 0x0F
  293.    
  294.     ; ADC
  295.     MOVLW b'00000000'
  296.     MOVWF ADCON1, 1
  297.     MOVLW b'00000000'
  298.     MOVWF ADCON2, 1
  299.     MOVLW b'00000000'
  300.     MOVWF ADCON3, 1
  301.     MOVLW b'10000000'
  302.     MOVWF ADCON0        ; Enable ADC
  303.     MOVLW b'00001000'
  304.     ;MOVLW b'00111111'  ; A TESTER
  305.     MOVWF ADCLK, 1      ; Fosc
  306.     MOVLW b'00000000'
  307.     MOVWF ADREF, 1       ; Voltage reference (VREF-=AVss, VREF+=Vdd)
  308.     MOVLW b'00000000'    ; ANA0
  309.     MOVWF ADPCH, 1       ; ANA0 by default
  310.     MOVLW b'11111111'
  311.     MOVWF ADACQ, 1       ; Acquisition Time = Beaucoup
  312.     MOVLW b'00011111'
  313.     MOVWF ANSELA, 1     ; Analog inputs
  314.    
  315.    
  316.     ; STATUS LED ON
  317.     BSF LATB, 4
  318.    
  319.     ; LED MATRIX OFF
  320.     BCF LATB, 5
  321.    
  322.     ; SIDE LEDs OFF
  323.     MOVLW 0x00
  324.     MOVWF LATC
  325.    
  326.     ; MATRIX SIZE
  327.     MOVLW 0x08
  328.     MOVWF MATRIX_WIDTH
  329.     MOVLW 0x08
  330.     MOVWF MATRIX_HEIGHT
  331.    
  332.     ; VECTOR PTR
  333.     MOVLW 0x02
  334.     MOVWF VEC_HIGH
  335.     MOVLW 0x00
  336.     MOVWF VEC_LOW
  337.    
  338.     ; ITERATORS AND SIZES DEFAULT (=0)
  339.     MOVLW 0x00
  340.     MOVWF VEC_SIZE
  341.     MOVWF MATRIX_ITR
  342.     MOVWF TILE_ITR
  343.     MOVWF FILL_ITR
  344.    
  345.     ; RESET PTR0
  346.     CALL RESET_PTR0
  347.    
  348.     ; SET ALL LED AND VECTOR TO 0
  349.     CALL COL_LVL_0
  350.     CALL COL_LVL_0
  351.     CALL COL_LVL_0
  352.     CALL COL_LVL_0
  353.     CALL COL_LVL_0
  354.     CALL COL_LVL_0
  355.     CALL COL_LVL_0
  356.     CALL COL_LVL_0
  357.     CALL FILL_MAT
  358.    
  359.     RETURN
  360.  
  361. ;*******************************************************************************
  362. ; VECTOR BASIC FUNCTIONS
  363. ;*******************************************************************************
  364.    
  365. ; RESET PTR0
  366. RESET_PTR0
  367.     MOVF VEC_HIGH, 0
  368.     MOVWF FSR0H
  369.     MOVF VEC_LOW, 0
  370.     MOVWF FSR0L
  371.    
  372.     RETURN
  373.    
  374. ; PUSH VALUE IN VECTOR
  375. VEC_PUSH
  376.     MOVWF POSTINC0
  377.     INCF VEC_SIZE
  378.    
  379.     RETURN
  380.  
  381. ; RETURN NEXT VALUE OF VECTOR
  382. VEC_PULL
  383.     MOVF POSTINC0, 0
  384.    
  385.     RETURN
  386.  
  387. ;*******************************************************************************
  388. ; WRITING MATRIX LED STREAM
  389. ;*******************************************************************************
  390.  
  391. ; WRITE 0 INTO LED STREAM
  392. LEDW0 ; 3 10 OU 4 11
  393.     BSF LATB, 5
  394.     NOP
  395.     NOP
  396.     NOP
  397.     NOP
  398.     NOP
  399.     BCF LATB, 5
  400.     NOP
  401.     NOP
  402.     NOP
  403.     NOP
  404.     NOP
  405.     NOP
  406.     NOP
  407.    
  408.     RETURN
  409.  
  410. ; WRITE 1 INTO LED STREAM
  411. LEDW1 ; 11 2 OU 12 3
  412.     BSF LATB, 5
  413.     NOP
  414.     NOP
  415.     NOP
  416.     NOP
  417.     NOP
  418.     NOP
  419.     NOP
  420.     NOP
  421.     NOP
  422.     NOP
  423.     NOP
  424.     NOP
  425.     NOP;
  426.     NOP;
  427.     BCF LATB, 5
  428.  
  429.     RETURN
  430.  
  431. ; WRITE LED STREAM FOR A GIVEN VALUE ([0; 255] in WREG)
  432. LED    
  433.     BTFSC WREG, 0
  434.     CALL LEDW1
  435.     BTFSS WREG, 0
  436.     CALL LEDW0
  437.        
  438.     BTFSC WREG, 1
  439.     CALL LEDW1
  440.     BTFSS WREG, 1
  441.     CALL LEDW0
  442.        
  443.     BTFSC WREG, 2
  444.     CALL LEDW1
  445.     BTFSS WREG, 2
  446.     CALL LEDW0
  447.        
  448.     BTFSC WREG, 3
  449.     CALL LEDW1
  450.     BTFSS WREG, 3
  451.     CALL LEDW0
  452.        
  453.     BTFSC WREG, 4
  454.     CALL LEDW1
  455.     BTFSS WREG, 4
  456.     CALL LEDW0
  457.        
  458.     BTFSC WREG, 5
  459.     CALL LEDW1
  460.     BTFSS WREG, 5
  461.     CALL LEDW0
  462.        
  463.     BTFSC WREG, 6
  464.     CALL LEDW1
  465.     BTFSS WREG, 6
  466.     CALL LEDW0
  467.        
  468.     BTFSC WREG, 7
  469.     CALL LEDW1
  470.     BTFSS WREG, 7
  471.     CALL LEDW0
  472.    
  473.    
  474.     RETURN
  475.  
  476. ;*******************************************************************************
  477. ; TEMPO ROUTINES
  478. ;*******************************************************************************
  479.    
  480. ; TEMPO ROUTINE LVL 1
  481. TEMPO_1
  482.     MOVLW 0xFF
  483.     MOVWF i
  484.    
  485. DEC_I
  486.     DECF i
  487.     MOVLW 0x00
  488.     CPFSEQ i
  489.         GOTO DEC_I
  490.        
  491.     RETURN
  492.  
  493. ; TEMPO ROUTINE LVL 2
  494. TEMPO_2
  495.     MOVLW 0xFF
  496.     MOVWF j
  497.    
  498. DEC_J
  499.     CALL TEMPO_1
  500.     DECF j
  501.     MOVLW 0x00
  502.     CPFSEQ j
  503.         GOTO DEC_J
  504.        
  505.     RETURN
  506.    
  507. ; TEMPO ROUTINE LVL 3
  508. TEMPO_3    
  509.     MOVLW 0x05
  510.     MOVWF k
  511.    
  512. DEC_K
  513.     CALL TEMPO_2
  514.     DECF k
  515.     MOVLW 0x00
  516.     CPFSEQ k
  517.         GOTO DEC_K
  518.        
  519.     RETURN
  520.  
  521. ;*******************************************************************************
  522. ; MATRIX STREAMING (FROM VECTOR)
  523. ;*******************************************************************************
  524.  
  525. ; STREAM A MATRIX TILE
  526. TILE
  527.     CALL VEC_PULL
  528.     CALL LED
  529.     CALL VEC_PULL
  530.     CALL LED
  531.     CALL VEC_PULL
  532.     CALL LED
  533.     CALL VEC_PULL
  534.     CALL LED
  535.     INCF TILE_ITR
  536.    
  537.     RETURN
  538.    
  539. ; STREAM A MATRIX WIDTH    
  540. WIDTH
  541.     ; Reset TILE_ITR
  542.     MOVLW 0x00
  543.     MOVWF TILE_ITR
  544.    
  545.     ; Do TILE while TILE_ITR < MATRIX_WIDTH
  546. WIDTH_DO_TILE
  547.     CALL TILE
  548.     MOVF MATRIX_WIDTH, 0
  549.     CPFSLT TILE_ITR
  550.         RETURN
  551.    
  552.     GOTO WIDTH_DO_TILE
  553.    
  554.     RETURN
  555.  
  556. ; STREAM ALL THE MATRIX
  557. FILL_MAT
  558.     ; Reset MATRIX_ITR
  559.     MOVLW 0x00
  560.     MOVWF MATRIX_ITR
  561.    
  562.     ; Do WIDTH while MATRIX_ITR < MATRIX_HEIGHT
  563. HEIGHT_DO_TILE
  564.     CALL WIDTH
  565.     INCF MATRIX_ITR
  566.     MOVF MATRIX_HEIGHT, 0
  567.     CPFSLT MATRIX_ITR
  568.         RETURN
  569.    
  570.     GOTO HEIGHT_DO_TILE
  571.    
  572.     RETURN
  573.  
  574. ;*******************************************************************************
  575. ; TILE LEVELS WRITING (INTO VECTOR)
  576. ;*******************************************************************************
  577.    
  578. ; TILE LEDS FOR NO LVL (NO COLORS)
  579. TILE_LVL_0
  580.     MOVLW 0x00
  581.     CALL VEC_PUSH
  582.     MOVLW 0x00
  583.     CALL VEC_PUSH
  584.     MOVLW 0x00
  585.     CALL VEC_PUSH
  586.     MOVLW 0x00
  587.     CALL VEC_PUSH
  588.    
  589.     RETURN
  590.  
  591. ; TILE LEDS FOR COLOR LVL 1
  592. TILE_LVL_1    
  593.     MOVLW 0x00
  594.     CALL VEC_PUSH
  595.     MOVLW 0x60
  596.     CALL VEC_PUSH
  597.     MOVLW 0x20
  598.     CALL VEC_PUSH
  599.     MOVLW 0x00
  600.     CALL VEC_PUSH
  601.     RETURN
  602.    
  603. ; TILE LEDS FOR COLOR LVL 2
  604. TILE_LVL_2
  605.     MOVLW 0x00
  606.     CALL VEC_PUSH
  607.     MOVLW 0x00
  608.     CALL VEC_PUSH
  609.     MOVLW 0xA0
  610.     CALL VEC_PUSH
  611.     MOVLW 0x00
  612.     CALL VEC_PUSH
  613.    
  614.     RETURN
  615.    
  616. ; TILE LEDS FOR COLOR LVL 3
  617. TILE_LVL_3
  618.     MOVLW 0x90
  619.     CALL VEC_PUSH
  620.     MOVLW 0x00
  621.     CALL VEC_PUSH
  622.     MOVLW 0x10
  623.     CALL VEC_PUSH
  624.     MOVLW 0x00
  625.     CALL VEC_PUSH
  626.     RETURN
  627.    
  628. ; TILE LEDS FOR COLOR LVL 4
  629. TILE_LVL_4
  630.     MOVLW 0x70
  631.     CALL VEC_PUSH
  632.     MOVLW 0x00
  633.     CALL VEC_PUSH
  634.     MOVLW 0x40
  635.     CALL VEC_PUSH
  636.     MOVLW 0x00
  637.     CALL VEC_PUSH
  638.     RETURN
  639.    
  640. ; TILE LEDS FOR COLOR LVL 5
  641. TILE_LVL_5
  642.     MOVLW 0x30
  643.     CALL VEC_PUSH
  644.     MOVLW 0x80
  645.     CALL VEC_PUSH
  646.     MOVLW 0x00
  647.     CALL VEC_PUSH
  648.     MOVLW 0x00
  649.     CALL VEC_PUSH
  650.     RETURN
  651.    
  652. ; TILE LEDS FOR COLOR LVL 6
  653. TILE_LVL_6
  654.     MOVLW 0x58
  655.     CALL VEC_PUSH
  656.     MOVLW 0x28
  657.     CALL VEC_PUSH
  658.     MOVLW 0x00
  659.     CALL VEC_PUSH
  660.     MOVLW 0x00
  661.     CALL VEC_PUSH
  662.     RETURN
  663.    
  664. ; TILE LEDS FOR COLOR LVL 7
  665. TILE_LVL_7
  666.     MOVLW 0x20
  667.     CALL VEC_PUSH
  668.     MOVLW 0x70
  669.     CALL VEC_PUSH
  670.     MOVLW 0x00
  671.     CALL VEC_PUSH
  672.     MOVLW 0x00
  673.     CALL VEC_PUSH
  674.     RETURN
  675.    
  676. ; TILE LEDS FOR COLOR LVL 8
  677. TILE_LVL_8
  678.     MOVLW 0x00
  679.     CALL VEC_PUSH
  680.     MOVLW 0xB0
  681.     CALL VEC_PUSH
  682.     MOVLW 0x00
  683.     CALL VEC_PUSH
  684.     MOVLW 0x00
  685.     CALL VEC_PUSH
  686.     RETURN
  687.  
  688. ;*******************************************************************************
  689. ; COLUMN FILL LEVELS WRITING (INTO VECTOR)
  690. ;*******************************************************************************
  691.    
  692. ; FILL COLUMN FOR LEVEL 0
  693. COL_LVL_0
  694.     CALL TILE_LVL_0
  695.     CALL TILE_LVL_0
  696.     CALL TILE_LVL_0
  697.     CALL TILE_LVL_0
  698.     CALL TILE_LVL_0
  699.     CALL TILE_LVL_0
  700.     CALL TILE_LVL_0
  701.     CALL TILE_LVL_0
  702.     CALL TILE_LVL_0
  703.     CALL TILE_LVL_0
  704.     CALL TILE_LVL_0
  705.     CALL TILE_LVL_0
  706.     CALL TILE_LVL_0
  707.     CALL TILE_LVL_0
  708.     CALL TILE_LVL_0
  709.     CALL TILE_LVL_0
  710.    
  711.     RETURN
  712.    
  713. ; FILL COLUMN FOR LEVEL 1
  714. COL_LVL_1
  715.     CALL TILE_LVL_1
  716.     CALL TILE_LVL_0
  717.     CALL TILE_LVL_0
  718.     CALL TILE_LVL_0
  719.     CALL TILE_LVL_0
  720.     CALL TILE_LVL_0
  721.     CALL TILE_LVL_0
  722.     CALL TILE_LVL_0
  723.     CALL TILE_LVL_1
  724.     CALL TILE_LVL_0
  725.     CALL TILE_LVL_0
  726.     CALL TILE_LVL_0
  727.     CALL TILE_LVL_0
  728.     CALL TILE_LVL_0
  729.     CALL TILE_LVL_0
  730.     CALL TILE_LVL_0
  731.    
  732.     RETURN
  733.    
  734. ; FILL COLUMN FOR LEVEL 2
  735. COL_LVL_2
  736.     CALL TILE_LVL_1
  737.     CALL TILE_LVL_2
  738.     CALL TILE_LVL_0
  739.     CALL TILE_LVL_0
  740.     CALL TILE_LVL_0
  741.     CALL TILE_LVL_0
  742.     CALL TILE_LVL_0
  743.     CALL TILE_LVL_0
  744.     CALL TILE_LVL_1
  745.     CALL TILE_LVL_2
  746.     CALL TILE_LVL_0
  747.     CALL TILE_LVL_0
  748.     CALL TILE_LVL_0
  749.     CALL TILE_LVL_0
  750.     CALL TILE_LVL_0
  751.     CALL TILE_LVL_0
  752.    
  753.     RETURN
  754.    
  755. ; FILL COLUMN FOR LEVEL 3
  756. COL_LVL_3
  757.     CALL TILE_LVL_1
  758.     CALL TILE_LVL_2
  759.     CALL TILE_LVL_3
  760.     CALL TILE_LVL_0
  761.     CALL TILE_LVL_0
  762.     CALL TILE_LVL_0
  763.     CALL TILE_LVL_0
  764.     CALL TILE_LVL_0
  765.     CALL TILE_LVL_1
  766.     CALL TILE_LVL_2
  767.     CALL TILE_LVL_3
  768.     CALL TILE_LVL_0
  769.     CALL TILE_LVL_0
  770.     CALL TILE_LVL_0
  771.     CALL TILE_LVL_0
  772.     CALL TILE_LVL_0
  773.    
  774.     RETURN
  775.    
  776. ; FILL COLUMN FOR LEVEL 4
  777. COL_LVL_4
  778.     CALL TILE_LVL_1
  779.     CALL TILE_LVL_2
  780.     CALL TILE_LVL_3
  781.     CALL TILE_LVL_4
  782.     CALL TILE_LVL_0
  783.     CALL TILE_LVL_0
  784.     CALL TILE_LVL_0
  785.     CALL TILE_LVL_0
  786.     CALL TILE_LVL_1
  787.     CALL TILE_LVL_2
  788.     CALL TILE_LVL_3
  789.     CALL TILE_LVL_4
  790.     CALL TILE_LVL_0
  791.     CALL TILE_LVL_0
  792.     CALL TILE_LVL_0
  793.     CALL TILE_LVL_0
  794.    
  795.     RETURN
  796.    
  797. ; FILL COLUMN FOR LEVEL 5
  798. COL_LVL_5
  799.     CALL TILE_LVL_1
  800.     CALL TILE_LVL_2
  801.     CALL TILE_LVL_3
  802.     CALL TILE_LVL_4
  803.     CALL TILE_LVL_5
  804.     CALL TILE_LVL_0
  805.     CALL TILE_LVL_0
  806.     CALL TILE_LVL_0
  807.     CALL TILE_LVL_1
  808.     CALL TILE_LVL_2
  809.     CALL TILE_LVL_3
  810.     CALL TILE_LVL_4
  811.     CALL TILE_LVL_5
  812.     CALL TILE_LVL_0
  813.     CALL TILE_LVL_0
  814.     CALL TILE_LVL_0
  815.    
  816.     RETURN
  817.    
  818. ; FILL COLUMN FOR LEVEL 6
  819. COL_LVL_6
  820.     CALL TILE_LVL_1
  821.     CALL TILE_LVL_2
  822.     CALL TILE_LVL_3
  823.     CALL TILE_LVL_4
  824.     CALL TILE_LVL_5
  825.     CALL TILE_LVL_6
  826.     CALL TILE_LVL_0
  827.     CALL TILE_LVL_0
  828.     CALL TILE_LVL_1
  829.     CALL TILE_LVL_2
  830.     CALL TILE_LVL_3
  831.     CALL TILE_LVL_4
  832.     CALL TILE_LVL_5
  833.     CALL TILE_LVL_6
  834.     CALL TILE_LVL_0
  835.     CALL TILE_LVL_0
  836.    
  837.     RETURN
  838.    
  839. ; FILL COLUMN FOR LEVEL 7
  840. COL_LVL_7
  841.     CALL TILE_LVL_1
  842.     CALL TILE_LVL_2
  843.     CALL TILE_LVL_3
  844.     CALL TILE_LVL_4
  845.     CALL TILE_LVL_5
  846.     CALL TILE_LVL_6
  847.     CALL TILE_LVL_7
  848.     CALL TILE_LVL_0
  849.     CALL TILE_LVL_1
  850.     CALL TILE_LVL_2
  851.     CALL TILE_LVL_3
  852.     CALL TILE_LVL_4
  853.     CALL TILE_LVL_5
  854.     CALL TILE_LVL_6
  855.     CALL TILE_LVL_7
  856.     CALL TILE_LVL_0
  857.    
  858.     RETURN
  859.    
  860. ; FILL COLUMN FOR LEVEL 8
  861. COL_LVL_8
  862.     CALL TILE_LVL_1
  863.     CALL TILE_LVL_2
  864.     CALL TILE_LVL_3
  865.     CALL TILE_LVL_4
  866.     CALL TILE_LVL_5
  867.     CALL TILE_LVL_6
  868.     CALL TILE_LVL_7
  869.     CALL TILE_LVL_8
  870.     CALL TILE_LVL_1
  871.     CALL TILE_LVL_2
  872.     CALL TILE_LVL_3
  873.     CALL TILE_LVL_4
  874.     CALL TILE_LVL_5
  875.     CALL TILE_LVL_6
  876.     CALL TILE_LVL_7
  877.     CALL TILE_LVL_8
  878.    
  879.     RETURN
  880.    
  881. ; WRITE A COLUMN
  882. WRITE_COL_VEC
  883.     MOVWF COL_LEVEL
  884.  
  885. ; COLUMN: TEST FOR LEVEL 1
  886. WRITE_COL_VEC_1
  887.     MOVLW 0x01
  888.     CPFSEQ COL_LEVEL
  889.         GOTO WRITE_COL_VEC_2
  890.     CALL COL_LVL_1
  891.     GOTO WRITE_COL_VEC_END
  892.    
  893. ; COLUMN: TEST FOR LEVEL 2    
  894. WRITE_COL_VEC_2
  895.     MOVLW 0x02
  896.     CPFSEQ COL_LEVEL
  897.         GOTO WRITE_COL_VEC_3
  898.     CALL COL_LVL_2
  899.     GOTO WRITE_COL_VEC_END
  900.  
  901. ; COLUMN: TEST FOR LEVEL 3
  902. WRITE_COL_VEC_3
  903.     MOVLW 0x03
  904.     CPFSEQ COL_LEVEL
  905.         GOTO WRITE_COL_VEC_4
  906.     CALL COL_LVL_3
  907.     GOTO WRITE_COL_VEC_END
  908.  
  909. ; COLUMN: TEST FOR LEVEL 4
  910. WRITE_COL_VEC_4
  911.     MOVLW 0x04
  912.     CPFSEQ COL_LEVEL
  913.         GOTO WRITE_COL_VEC_5
  914.     CALL COL_LVL_4
  915.     GOTO WRITE_COL_VEC_END
  916.  
  917. ; COLUMN: TEST FOR LEVEL 5    
  918. WRITE_COL_VEC_5
  919.     MOVLW 0x05
  920.     CPFSEQ COL_LEVEL
  921.         GOTO WRITE_COL_VEC_6
  922.     CALL COL_LVL_5
  923.     GOTO WRITE_COL_VEC_END
  924.  
  925. ; COLUMN: TEST FOR LEVEL 6  
  926. WRITE_COL_VEC_6
  927.     MOVLW 0x06
  928.     CPFSEQ COL_LEVEL
  929.         GOTO WRITE_COL_VEC_7
  930.     CALL COL_LVL_6
  931.     GOTO WRITE_COL_VEC_END
  932.  
  933. ; COLUMN: TEST FOR LEVEL 7
  934. WRITE_COL_VEC_7
  935.     MOVLW 0x07
  936.     CPFSEQ COL_LEVEL
  937.         GOTO WRITE_COL_VEC_8
  938.     CALL COL_LVL_7
  939.     GOTO WRITE_COL_VEC_END
  940.  
  941. ; COLUMN: TEST FOR LEVEL 8
  942. WRITE_COL_VEC_8
  943.     MOVLW 0x08
  944.     CPFSEQ COL_LEVEL
  945.         GOTO WRITE_COL_VEC_0
  946.     CALL COL_LVL_8
  947.     GOTO WRITE_COL_VEC_END
  948.  
  949. ; COLUMN: DEFAULT LEVEL 0
  950. WRITE_COL_VEC_0
  951.     CALL COL_LVL_0
  952.  
  953. ; COLUMN: END POINT    
  954. WRITE_COL_VEC_END
  955.     RETURN
  956.  
  957. ;*******************************************************************************
  958. ; ADC AND FREQUENCY LEVELS UTILS
  959. ;*******************************************************************************
  960.  
  961. ; WAIT FOR ADC TO COMPUTE
  962. POLL
  963.     BTFSC ADCON0, 0
  964.     GOTO POLL
  965.    
  966.     RETURN
  967.  
  968. ; SHOW CURRENT ADC LEVEL ON RIGHT SIDE LEDS
  969. LED_LEVEL
  970.     ; INIT: TURN OFF LEDs
  971.     MOVLW 0x00
  972.     MOVWF LATC
  973.    
  974.     MOVLW 0x80      ; > 0, turn on LED0
  975.     CPFSLT TEMP
  976.     BSF LATC, 7
  977.    
  978.     MOVLW 0x90      ; > 32, turn on LED3
  979.     CPFSLT TEMP
  980.     BSF LATC, 6
  981.    
  982.     MOVLW 0xA0      ; > 64, turn on LED2
  983.     CPFSLT TEMP
  984.     BSF LATC, 5
  985.    
  986.     MOVLW 0xB0     ; > 96, turn on LED2
  987.     CPFSLT TEMP
  988.     BSF LATC, 4
  989.    
  990.     MOVLW 0xC0      ; > 128, turn on LED2
  991.     CPFSLT TEMP
  992.     BSF LATC, 3
  993.    
  994.     MOVLW 0xD0      ; > 160, turn on LED2
  995.     CPFSLT TEMP
  996.     BSF LATC, 2
  997.    
  998.     MOVLW 0xE0      ; > 192, turn on LED2
  999.     CPFSLT TEMP
  1000.     BSF LATC, 1
  1001.    
  1002.     MOVLW 0xF0      ; > 224, turn on LED2
  1003.     CPFSLT TEMP
  1004.     BSF LATC, 0
  1005.    
  1006.     RETURN
  1007.  
  1008. ;*******************************************************************************
  1009. ; FREQUENCY LEVELS ADJUSTERS
  1010. ;*******************************************************************************
  1011.  
  1012. ; FREQUENCY LEVEL SETTERS
  1013. ; SET FREQUENCY LEVEL TO 1 AND GO TO FREQUENCY CALCULATION END POINT
  1014. SET_FREQ_1
  1015.     MOVLW 0x01
  1016.     GOTO CALC_FREQ_END
  1017.  
  1018. ; SET FREQUENCY LEVEL TO 2 AND GO TO FREQUENCY CALCULATION END POINT
  1019. SET_FREQ_2
  1020.     MOVLW 0x02
  1021.     GOTO CALC_FREQ_END
  1022.  
  1023. ; SET FREQUENCY LEVEL TO 3 AND GO TO FREQUENCY CALCULATION END POINT
  1024. SET_FREQ_3
  1025.     MOVLW 0x03
  1026.     GOTO CALC_FREQ_END
  1027.    
  1028. ; SET FREQUENCY LEVEL TO 4 AND GO TO FREQUENCY CALCULATION END POINT
  1029. SET_FREQ_4
  1030.     MOVLW 0x04
  1031.     GOTO CALC_FREQ_END
  1032.    
  1033. ; SET FREQUENCY LEVEL TO 5 AND GO TO FREQUENCY CALCULATION END POINT
  1034. SET_FREQ_5
  1035.     MOVLW 0x05
  1036.     GOTO CALC_FREQ_END
  1037.    
  1038. ; SET FREQUENCY LEVEL TO 6 AND GO TO FREQUENCY CALCULATION END POINT
  1039. SET_FREQ_6
  1040.     MOVLW 0x06
  1041.     GOTO CALC_FREQ_END
  1042.    
  1043. ; SET FREQUENCY LEVEL TO 7 AND GO TO FREQUENCY CALCULATION END POINT
  1044. SET_FREQ_7
  1045.     MOVLW 0x07
  1046.     GOTO CALC_FREQ_END
  1047.    
  1048. ; SET FREQUENCY LEVEL TO 8 AND GO TO FREQUENCY CALCULATION END POINT
  1049. SET_FREQ_8
  1050.     MOVLW 0x08
  1051.     GOTO CALC_FREQ_END
  1052.  
  1053. ; FREQUENCY CALCULATION END POINT
  1054. CALC_FREQ_END
  1055.     RETURN
  1056.    
  1057. ; RETURN A VALUE IN W [0, 8] DEPENDING ON THE (LOW ?) FREQUENCY VOLTAGE
  1058. CALC_FREQ_LOW
  1059.     ; > 4.67V (238, 0xEE)
  1060.     MOVLW 0xDB
  1061.     CPFSLT TEMP
  1062.     GOTO SET_FREQ_8
  1063.    
  1064.     ; > 4.34V (221, 0xDD)
  1065.     MOVLW 0xD1
  1066.     CPFSLT TEMP
  1067.     GOTO SET_FREQ_7
  1068.    
  1069.     ; > 4V (204, 0xCC)
  1070.     MOVLW 0xC8
  1071.     CPFSLT TEMP
  1072.     GOTO SET_FREQ_6
  1073.    
  1074.     ; > 3.67V (187, 0xBB)
  1075.     MOVLW 0xBE
  1076.     CPFSLT TEMP
  1077.     GOTO SET_FREQ_5
  1078.    
  1079.     ; > 3.34V (170, 0xAA)
  1080.     MOVLW 0xB5
  1081.     CPFSLT TEMP
  1082.     GOTO SET_FREQ_4
  1083.    
  1084.     ; > 3V (153, 0x99)
  1085.     MOVLW 0xAB
  1086.     CPFSLT TEMP
  1087.     GOTO SET_FREQ_3
  1088.    
  1089.     ; > 2.67V (136, 0x88)
  1090.     MOVLW 0xA2
  1091.     CPFSLT TEMP
  1092.     GOTO SET_FREQ_2
  1093.    
  1094.     ; > 2.36V (120, 0x77)
  1095.     MOVLW 0x99
  1096.     CPFSLT TEMP
  1097.     GOTO SET_FREQ_1
  1098.    
  1099.     ; DEFAULT VALUE = 0x00
  1100.     MOVLW 0x00
  1101.    
  1102.     RETURN
  1103.    
  1104. ;*******************************************************************************
  1105. ; ADC FREQUENCY COMPUTION
  1106. ;*******************************************************************************
  1107.  
  1108. ; GET LOW FREQUENCY VALUE FROM ADC
  1109. GET_FREQ_LOW
  1110.     MOVLW b'00000000'   ; ANA0
  1111.     MOVLB 0x0F
  1112.     MOVWF ADPCH, 1      ; SELECT ANA0
  1113.     BSF ADCON0, 0       ; START ADC
  1114.     CALL POLL           ; WAIT FOR RESULT
  1115.     MOVFF ADRESH, TEMP
  1116.    
  1117.     CALL CALC_FREQ_LOW  ; CALCUL FREQUENCY LEVEL
  1118.    
  1119.     RETURN
  1120.  
  1121. ; GET MEDIUM LOW FREQUENCY VALUE FROM ADC
  1122. GET_FREQ_MEDIUM_LOW
  1123.     MOVLW b'00000001'   ; ANA1
  1124.     MOVLB 0x0F
  1125.     MOVWF ADPCH, 1      ; SELECT ANA1
  1126.     BSF ADCON0, 0       ; START ADC
  1127.     CALL POLL           ; WAIT FOR RESULT
  1128.     MOVFF ADRESH, TEMP
  1129.    
  1130.     CALL CALC_FREQ_LOW  ; CALCUL FREQUENCY LEVEL
  1131.    
  1132.     RETURN
  1133.  
  1134. ; GET MEDIUM HIGH FREQUENCY VALUE FROM ADC
  1135. GET_FREQ_MEDIUM_HIGH
  1136.     MOVLW b'00000010'   ; ANA2
  1137.     MOVLB 0x0F
  1138.     MOVWF ADPCH, 1      ; SELECT ANA2
  1139.     BSF ADCON0, 0       ; START ADC
  1140.     CALL POLL           ; WAIT FOR RESULT
  1141.     MOVFF ADRESH, TEMP
  1142.    
  1143.     CALL CALC_FREQ_LOW  ; CALCUL FREQUENCY LEVEL
  1144.    
  1145.     RETURN
  1146.    
  1147. ; GET HIGH FREQUENCY VALUE FROM ADC
  1148. GET_FREQ_HIGH
  1149.     MOVLW b'00000011'   ; ANA3
  1150.     MOVLB 0x0F
  1151.     MOVWF ADPCH, 1      ; SELECT ANA3
  1152.     BSF ADCON0, 0       ; START ADC
  1153.     CALL POLL           ; WAIT FOR RESULT
  1154.     MOVFF ADRESH, TEMP
  1155.    
  1156.     CALL CALC_FREQ_LOW  ; CALCUL FREQUENCY LEVEL
  1157.    
  1158.     RETURN
  1159.    
  1160. ; UP LEDs DEPENDING ON THE VOLUME
  1161. LED_VOLUME
  1162.     MOVLW b'00000100'   ; ANA4
  1163.     MOVLB 0x0F
  1164.     MOVWF ADPCH, 1      ; SELECT ANA3
  1165.     BSF ADCON0, 0       ; START ADC
  1166.     CALL POLL           ; WAIT FOR RESULT
  1167.     MOVFF ADRESH, TEMP
  1168.    
  1169.     CALL LED_LEVEL
  1170.    
  1171.     RETURN
  1172.    
  1173. ;*******************************************************************************
  1174. ; MAIN CODE - RUN
  1175. ;*******************************************************************************
  1176.  
  1177. RUN
  1178.     ; Init values
  1179.     CALL INIT
  1180.    
  1181.    
  1182.     ; --- MAIN LOOP
  1183.     LOOP
  1184.         CALL LED_VOLUME
  1185.    
  1186.         CALL RESET_PTR0 ; RESET VECTOR POSITION
  1187.        
  1188.         CALL GET_FREQ_LOW   ; GET LOW FREQUENCY LEVEL
  1189.         CALL WRITE_COL_VEC  ; WRITE COLUMN
  1190.         ;CALL TEMPO_2
  1191.        
  1192.         CALL GET_FREQ_MEDIUM_LOW   ; GET LOW FREQUENCY LEVEL
  1193.         CALL WRITE_COL_VEC  ; WRITE COLUMN
  1194.         ;CALL TEMPO_2
  1195.        
  1196.         CALL GET_FREQ_MEDIUM_HIGH   ; GET LOW FREQUENCY LEVEL
  1197.         CALL WRITE_COL_VEC  ; WRITE COLUMN
  1198.         ;CALL TEMPO_2
  1199.        
  1200.         CALL GET_FREQ_HIGH   ; GET LOW FREQUENCY LEVEL
  1201.         CALL WRITE_COL_VEC  ; WRITE COLUMN
  1202.         ;CALL TEMPO_2
  1203.        
  1204.         ; FILL MATRIX
  1205.         CALL RESET_PTR0
  1206.         CALL FILL_MAT
  1207.        
  1208.         ;MOVLW 0x00
  1209.         ;MOVWF ADRESH
  1210.        
  1211.         ; WAIT
  1212.         CALL TEMPO_2
  1213.        
  1214.         GOTO LOOP
  1215.        
  1216.     GOTO $
  1217.  
  1218.     END
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement
Public Pastes
Advertisement
We use cookies for various purposes including analytics. By continuing to use Pastebin, you agree to our use of cookies as described in the Cookies Policy.  OK, I Understand
Not a member of Pastebin yet?
Sign Up, it unlocks many cool features!