SHOW:
|
|
- or go back to the newest paste.
| 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 |
