http://www.edtn.com/embapps/emba035.htm
http://www.geocities.com/robert_lacoste
Steve Thackery says:
[Microchip Application Note AN542 doesn't work]*No* disrespect to the guys who wrote it, but it doesn't work.
Over the last several months I've been developing a product for my employer which uses a fast fourier transform as part of its functionality. The product is based upon a 17C44, by the way.
I was foolish enough to plan my timescales assuming that the Microchip FFT would be pretty well "plug and play". After all, I do tend to trust the stuff they publish. How wrong I was!
I won't bore you with the details, but Microchip's FFT is seriously defective. I can only guess that it didn't receive much testing. In fact, reading between the lines in AN542 it becomes clear that it was primarily written as a *benchmarking* exercise rather than a reliable FFT module for use in our projects.
Basically, if you test it with the waveform shown in the AN, it works perfectly. I should have been suspicous, even so. The waveform shown is of very low frequency, and has a whole number of cycles in the sampling window. Alter that frequency by even a small amount, so that there isn't a whole number of cycles in the window and the whole thing goes haywire! It generates artefacts in the FFT output all over the place, both above and below the "real" frequency. Similarly, test it at higher frequencies with sine or square waves, and you get a complete spectrum of rubbish at the output.
Incidentally, it wasn't made clear in the AN that permissible input range of values is between 0 and 3FFF. In other words, you need to DC-shift your sound sample so its centred around 1FFF, and adjust its gain. That caught us out for a couple of days!
We assumed it must be something we were doing wrong and spent ages poring over the AN to see if we were doing something stupid. We also tried working through the code itself, but it is almost inpenetrable. We tried everything, including using very small amplitude signals, but to no avail. The output is rubbish *except* with very low frequency square waves with a whole number of cycles in the window.
I can only imagine that there is a scaling problem somewhere in the maths. It looks like there is some sort of overflow or fold-back going on.
This cost me two months of development time and made me very unpopular with my employer and customer!
In the end we gave up and looked elsewhere. This is where Robert Lacoste comes into the picture. He developed his own FFT module from scratch and incorporated it into his PIC'Spectrum product. I contacted him and asked if he would be willing to let us use his FFT module - for prototyping and test purposes only - in our own product. He was willing and incredibly helpful, answering all our questions with clarity.
It took us two days to unplug the Microchip FFT module and plug in the Lacoste module. Here's what happened. It worked PERFECTLY! The output is classic, text-book perfect under all circumstances. Furthermore, it runs at least ten times as fast as the Microchip module.
Let me state publicly my most grateful thanks to Robert. If you need to include an FFT in any of your products, contact him on robert_lacoste@yahoo.fr He allowed us free use in our prototypes, and suggested a very reasonable royalty on our production models. I expect he might extend a similar deal to others.
In summary, then: BEWARE the Microchip FFT, and THANK YOU Robert Lacoste!
;============================================================================ ; PROJECT : PIC'SPECTRUM ; ; FILE : PICSPECT.ASM ; ; VERSION : 1.0 ; ; DESCRIPTION : ; ; PIC'SCOPE digital audio spectrum analyser - Main source file ; ; This project is a complete audio spectrum analyser with output on a ; standard VGA display, done entirely with a PIC17C756 microcontroler. ; ; The controler is in charge of : ; - ADC acquisition of the incoming signal ; - Fast Fourier Transform of the signal ; - Power calculation and if required logarithmic scaling ; - Video generation entirely in software ; of course in real time. ; ; Developped on MICROCHIP's MPLAB 3.31.0 ; To be embedded in a PIC17C756 (32MHz crystal) ; ;============================================================================ ; Developped & Copyrighted by Robert LACOSTE ;============================================================================ ;---------------------------------------------------------------------------- ; System definitions ;---------------------------------------------------------------------------- PROCESSOR 17C756 ; Assembler directives RADIX HEX ERRORLEVEL 0 ERRORLEVEL -302 ; no bank control warnings TITLE "PIC'SPECTRUM" SUBTITLE "(C) Robert Lacoste" #include "P17C756.INC" ; Processor dependant declarations ; config register : ; XT osc, no watchdog, brown-out reset active, microcontroler __CONFIG (_XT_OSC & _WDT_OFF & _BODEN_ON & _MC_MODE) ;---------------------------------------------------------------------------- ; Application constants ;---------------------------------------------------------------------------- MAXPIXVAL equ D'127' ; maximum scaled pixel value INITTIM equ H'FFFF'-D'254'+D'13'+D'5'; timer load value, ; 254 because 31.77µS=254*4/32MHz ; minus 13 for irq to reload delay ; minus 5 for timer to irq delay BKG_COLOR equ B'00000100' ; background=Blue SLINE_COLOR equ B'00000011' ; separation lines=Yellow SHORTS_COLOR equ B'00000011' ; small scale indicator=Yellow LONGS_COLOR equ B'00000011' ; long scale indicator=Yellow FREQ_COLOR equ B'00000001' ; Frequency bars=Red BKGTITLE_COLOR equ B'00000010' ; Background title=Green TITLE_COLOR equ B'00000000' ; Title=Black HOLD_COLOR equ B'00000001' ; Hold=Red ;---------------------------------------------------------------------------- ; Vectors ;---------------------------------------------------------------------------- reset_vector org H'0000' goto start ; Initialisation intpin_vector org H'0008' goto start ; should not occur timer0_vector org H'0010' goto it_timer ; horizontal sync interrupt t0cki_vector org H'0018' goto start ; should not occur periph_vector org H'0020' goto start ; should not occur start_appl org H'0050' ; start of application area ;---------------------------------------------------------------------------- ; Inclusion of extern application files ;---------------------------------------------------------------------------- #include "vars.inc" ; Variables declarations #include "fixed.inc" ; Fixed point arithmetic #include "testsig.inc" ; Test signals generation #include "fft.inc" ; FFT calculation routines #include "powers.inc" ; power calculation & display access #include "irq.inc" ; interrupt routine & video generation ;---------------------------------------------------------------------------- ; Main starting point ;---------------------------------------------------------------------------- start nop BANKSEL zone_main ;--> Initialisation call initialize ; initialization of ports & variables call realfft ; do the first FFT (on the test signal) call init_timer ; launch timer0 interrupts mainloop nop ;--> Power spectrum calculation & scaling movlb 0 ; if RB7=0 (mode log), btfsc PORTB,7 goto spectlin spectlog call powerlog ; calculate spectrum in log scale goto main1 spectlin call powerlin ; else calculate spectrum in lin scale main1 nop ;--> Analog acquisition movlb 0 ; if RB6=1 (non hold mode), btfss PORTB,6 ; do analog sample acquisition : goto main2 movlb 1 ; RD1=1 (debug line : ADC going on) bsf PORTD,1 BANKSEL num_sample ; sample number=0 clrf num_sample,F call init_adc ; initialize analog acquisition BANKSEL acq_request movlw 1 ; put acqrequest flag to 1 movwf acq_request clrf WREG,F ; and wait for it to be 0 acqwait cpfseq acq_request goto acqwait movlb 1 ; RD1=0 (debug line : ADC going on) bcf PORTD,1 ;--> Do the FFT movlb 1 ; RD0=1 (debug line : FFT going on) bsf PORTD,0 BANKSEL zone_main call realfft ; do the FFT movlb 1 ; RD0=0 (debug line : FFT going on) bcf PORTD,0 ;--> And loop ! main2 goto mainloop ;---------------------------------------------------------------------------- ; Ports & variables initialization ;---------------------------------------------------------------------------- initialize nop ;--> Variables initialization BANKSEL acq_request ; reset adc control registers clrf acq_request,F clrf num_sample,F BANKSEL scan_line ; reset scan line number clrf scan_line,F ; (will be incremented to 1 at the clrf scan_line+1,F ; first interrupt) BANKSEL displ0 ; reset displ0 buffer movlw low displ0 movwf FSR0 bcf ALUSTA,FS1 ; auto increment mode bsf ALUSTA,FS0 bcf ALUSTA,C movlw low displ0+D'64' rstdispl0 clrf INDF0,F cpfseq FSR0 goto rstdispl0 BANKSEL displ1 ; reset displ1 buffer movlw low displ1 movwf FSR0 bcf ALUSTA,FS1 ; auto increment mode bsf ALUSTA,FS0 bcf ALUSTA,C movlw low displ0+D'64' rstdispl1 clrf INDF0,F cpfseq FSR0 goto rstdispl1 bsf ALUSTA,FS1 ; return to non-increment mode BANKSEL zone_main m_ldaconst H'2000' ; generate test square signal movlw D'16' call test_square ;--> Ports initialization movlw B'11111000' ; RB0 to RB2 are outputs movlb 0 movwf DDRB clrf PORTB,F ; initialized to 0 movlw B'10101111' ; RC4 and RC6 are outputs movlb 1 movwf DDRC bcf PORTC,4 ; RC4=0 (Hsync) bsf PORTC,6 ; RC6=1 (Vsync) movlw B'11111000' ; RD0 to RD2 are outputs movlb 1 movwf DDRD clrf PORTD,F ; initialized to 0 movlw B'01111111' ; RG7 is output movlb 5 movwf DDRG clrf PORTG,F ; initialized to 0 return ;---------------------------------------------------------------------------- ; Initialization of timer0 ; ; Generate an interrupt every 31.77 micro-second (horizontal refresh ; rate for VGA display in 640x350 mode = 31.476KHz) ; ; Warning : interrupts will start immediatly after calling this routine ;---------------------------------------------------------------------------- init_timer nop bsf CPUSTA,GLINTD ; disable global interrupts bsf T0STA,T0CS ; select internal clock bcf T0STA,T0PS3 ; and prescale factor 1:1 bcf T0STA,T0PS2 bcf T0STA,T0PS1 bcf T0STA,T0PS0 BANKSEL tmpcpt movlw high INITTIM ; load timer movwf tmpcpt movlw low INITTIM movwf TMR0L movfp tmpcpt,TMR0H bcf INTSTA,PEIE ; disable PEI interrupts bcf INTSTA,T0CKIE ; disable external interrupts on RA1 bcf INTSTA,INTE ; disable external interrupts on RA0 bsf INTSTA,T0IE ; enable timer0 interrupts bcf CPUSTA,GLINTD ; enable global interrupts return ;---------------------------------------------------------------------------- ; Configuration of analog acquisition port ; ; Connect the analog source and configure the A/D sub-system. Acquisition ; will be done by the interrupt routine synchronously with video generation. ;---------------------------------------------------------------------------- init_adc movlb 5 movlw B'10000000' ; clock=F/64 (2µS conversion), movwf ADCON1 ; left justified, ref 0/5V movlw B'10000000' ; select chanel AD8 movwf ADCON0 bsf ADCON0,ADON ; switch on ADC sub-system return END ;============================================================================ ; - END OF FILE - ;============================================================================ ;============================================================================ ; PROJECT : UPS'SPECTRUM ; ; FILE : VARS.INC ; ; VERSION : 1.0 ; ; DESCRIPTION : ; ; Definition of all RAM variables, bank per bank. ; Usage of each variable (used by main program, by interrupt routine or ; both) is defined ; ;============================================================================ ; Developped & Copyrighted by Robert LACOSTE ;============================================================================ ;---------------------------------------------------------------------------- ; Unbanked RAM ;---------------------------------------------------------------------------- ; unbanked RAM $1A to $1A : private unbanked save location for interrupt ; routine. Other locations are in bank 0. cblock H'001A' sv_bsr ; BSR save location endc ; unbanked ram $1B to $1F : arithmetic working registers, to be used only ; by the main program cblock H'001B' ; arithmetic working registers ra:2 ; (format s-2-13) rb:2 ; (format s-2-13) rdiv:1 ; (8 bit unsigned int) endc ;---------------------------------------------------------------------------- ; Bank 0 ;---------------------------------------------------------------------------- ; $20 to $7F : private registers for the interrupt routine ; and exchange registers & flags between main pgr and interrupt cblock H'0020' zone_irq:0 endc cblock scan_line:2 ; scan line number, from 1 to 449, H-L frame_num:1 ; frame number (for blinkings) tmpcolor:1 ; temporary storage of color tmpi:2 ; temporary variable tmpi2:2 ; temporary variable endc cblock sv_alusta ; save location for registers sv_wreg ; during interrupt sv_fsr0 endc ; WARNING : only these 4 registers (with bsr, saved in ; non-banked ram) are automaticaly saved. Be carefull when ; using FSR1 or table read registers ! ; Exchange registers et flags between main pgr and interrupt cblock acq_request:1 ; Analog acquisition flag ; (0:finished, 1:sampling, 2:convert) num_sample:1 ; Analog sample number endc ; $80 to $FF : FFT data buffer 0...63 (2 bytes/value, big endian : H-L) cblock H'0080' data0:128 ; (format s-2-13) endc ;---------------------------------------------------------------------------- ; Bank 1 ;---------------------------------------------------------------------------- ; $20 to $7F : private registers for the main program cblock H'0120' zone_main:0 endc cblock ; temporary variables for FFT and ; powers wr:2 ; (format s-2-13) wpr:2 ; (format s-2-13) wi:2 ; (format s-2-13) wpi:2 ; (format s-2-13) theta:2 ; (format s-2-13) mmax:1 ; counter m:1 ; counter j:1 ; counter istep:1 ; counter i:1 ; counter i1:1 ; counter i2:1 ; counter i3:1 ; counter i4:1 ; counter endc cblock ; temporary arithm. variables h1r:2 ; (format s-2-13) h1i:2 ; (format s-2-13) h2r:2 ; (format s-2-13) h2i:2 ; (format s-2-13) wtemp:2 ; (format s-2-13) endc cblock ; generic counters cptm:2 ; (16 bit unsigned int) cpti:2 ; (16 bit unsigned int) cptj:2 ; (16 bit unsigned int) endc cblock ; temporary registers for math.inc mres3:1 ; for m_mult and m_divi mres2:1 mres1:1 mres0:1 msign:1 x0:2 ; for m_sin x1:2 x2:2 sin_saveb:2 scaletmp:2 ; for m_scalelin and m_scalelog logresult:2 ; for m_scalelog endc cblock ; temporary registers for testsig.inc test_halfp:1 test_step:2 test_cval:2 endc cblock tmpcpt:1 ; temporary register for inittimer endc ; $80 to $FF : FFT data buffer 64...127 (2 bytes/value, big endian : H-L) cblock H'0180' data1:128 ; (format s-2-13) endc ;---------------------------------------------------------------------------- ; Bank 2 ;---------------------------------------------------------------------------- ; $20 to $5F : Display buffer 0...63 cblock H'0220' displ0:64 ; (value 0..MAXPIXVAL) endc ; $60 to $7F : unused ; $80 to $FF : FFT data buffer 128...191 (2 bytes/value, big endian : H-L) cblock H'0280' data2:128 ; (format s-2-13) endc ;---------------------------------------------------------------------------- ; Bank 3 ;---------------------------------------------------------------------------- ; $20 to $5F : Display buffer 64...127 cblock H'0320' displ1:64 ; (value 0..MAXPIXVAL) endc ; $60 to $7F : unused ; $80 to $FF : FFT data buffer 192...255 (2 bytes/value, big endian : H-L) cblock H'0380' data3:128 ; (format s-2-13) endc ;============================================================================ ; - END OF FILE - ;============================================================================ ;============================================================================ ; PROJECT : PIC'SPECTRUM ; ; FILE : FIXED.INC ; ; VERSION : 1.0 ; ; DESCRIPTION : ; ; Fixed point math routines, using a s-2-13 format (sign bit in 2-complement, ; 2 bits for the integer part, 13 bits for the decimal part). ; ; So values ranging +/-3.99999, resolution 1/2 exp 13 = 0.000122 ; ; All functions and macros operate on registers ra,rb and rdiv. ; Storage could be in a generic "arithmetic" register (2 bytes) or in the ; FFT data storage table ("data") ; ; The FFT data table ("data") is a 4x64 word (2 bytes) array, each of the ; four blocks being at at fixed adress ($80 to $ff) in the 4 banks. ; ; WARNING : ra/rb/rdiv are supposed to be in unbanked memory. Bank selector ; must be zone_main on input (access to arithmetic tempory registers) and is ; garanteed to be zone_main on exit ; ; In general, WREG is scrambled ; ;============================================================================ ; Developped & Copyrighted by Robert LACOSTE ;============================================================================ ;---------------------------------------------------------------------------- ; m_lda : copy a given general register (2 bytes) in register A ;---------------------------------------------------------------------------- m_lda macro inreg movfp inreg,WREG movwf ra movfp inreg+1,WREG movwf ra+1 endm ;---------------------------------------------------------------------------- ; m_ldai : get the data value pointed by reg and store it in A ;---------------------------------------------------------------------------- m_ldai macro indexreg movfp indexreg, WREG movlr 0 ; start with bank 0 btfsc WREG,7 ; select the good bank bsf BSR,5 btfsc WREG,6 ; based on 2 first bits of WREG bsf BSR,4 bcf ALUSTA,C ; multiply by 2 rlcf WREG,1 bsf WREG,7 ; and set high bit (data start at $80) movwf FSR0 ; and use it as an index movpf INDF0,ra ; to get msb value incf FSR0,1 movpf INDF0,ra+1 ; and lsb value BANKSEL zone_main ; reset bank register endm ;---------------------------------------------------------------------------- ; m_ldb : copy a given general register (2 bytes) in register B ;---------------------------------------------------------------------------- m_ldb macro inreg movfp inreg,WREG movwf rb movfp inreg+1,WREG movwf rb+1 endm ;---------------------------------------------------------------------------- ; m_ldbi : get the data value pointed by reg and store it in B ;---------------------------------------------------------------------------- m_ldbi macro indexreg movfp indexreg,WREG movlr 0 ; start with bank 0 btfsc WREG,7 ; select the good bank bsf BSR,5 btfsc WREG,6 ; based on 2 first bits of WREG bsf BSR,4 bcf ALUSTA,C ; multiply by 2 rlcf WREG,1 bsf WREG,7 ; and set high bit (data start at $80) movwf FSR0 ; and use it as an index movpf INDF0,rb ; to get msb value incf FSR0,1 movpf INDF0,rb+1 ; and lsb value BANKSEL zone_main ; reset bank register endm ;---------------------------------------------------------------------------- ; m_lddiv : copy a given register (int, 1 byte) in register DIV ;---------------------------------------------------------------------------- m_lddiv macro inreg movfp inreg,WREG movwf rdiv endm ;---------------------------------------------------------------------------- ; m_sta : store the value of A in a given general register (2 bytes) ;---------------------------------------------------------------------------- m_sta macro outreg movfp ra,WREG movwf outreg movfp ra+1,WREG movwf outreg+1 endm ;---------------------------------------------------------------------------- ; m_stai : store the value of A in the data value pointed by reg ;---------------------------------------------------------------------------- m_stai macro indexreg movfp indexreg, WREG movlr 0 ; start with bank 0 btfsc WREG,7 ; select the good bank bsf BSR,5 btfsc WREG,6 ; based on 2 first bits of WREG bsf BSR,4 bcf ALUSTA,C ; multiply by 2 rlcf WREG,1 bsf WREG,7 ; and set high bit (data start at $80) movwf FSR0 ; and use it as an index movfp ra,INDF0 ; to store msb value incf FSR0,1 movfp ra+1,INDF0 ; and lsb value BANKSEL zone_main ; reset bank register endm ;---------------------------------------------------------------------------- ; m_ldaconst : load an immediate value in A ;---------------------------------------------------------------------------- m_ldaconst macro immvalue movlw high immvalue movwf ra movlw low immvalue movwf ra+1 endm ;---------------------------------------------------------------------------- ; m_mvba : copy B to A ;---------------------------------------------------------------------------- m_mvba macro movfp rb,WREG movwf ra movfp rb+1,WREG movwf ra+1 endm ;---------------------------------------------------------------------------- ; m_mvab : copy A to B ;---------------------------------------------------------------------------- m_mvab macro movfp ra,WREG movwf rb movfp ra+1,WREG movwf rb+1 endm ;---------------------------------------------------------------------------- ; m_add : add B to A (A=A+B) ;---------------------------------------------------------------------------- m_add macro movfp rb+1,WREG ; low byte first addwf ra+1,1 movfp rb,WREG ; and high byte with carry addwfc ra,1 endm ;---------------------------------------------------------------------------- ; m_sub : substract B to A (A=A-B) ;---------------------------------------------------------------------------- m_sub macro movfp rb+1,WREG ; low byte first subwf ra+1,1 movfp rb,WREG ; and high byte with borrow subwfb ra,1 endm ;---------------------------------------------------------------------------- ; m_mult : multiply A to B (A=A*B) ; Warning : overflow not detected if result>4 ;---------------------------------------------------------------------------- m_mult movfp ra+1,WREG ; low byte x low byte mulwf rb+1 movpf PRODH,mres1 movpf PRODL,mres0 movfp ra,WREG ; high byte x high byte mulwf rb movpf PRODH,mres3 movpf PRODL,mres2 movfp ra+1,WREG ; low byte x high byte mulwf rb movfp PRODL,WREG addwf mres1,F movfp PRODH,WREG addwfc mres2,F clrf WREG,F addwfc mres3,F movfp ra,WREG ; high byte x low byte mulwf rb+1 movfp PRODL,WREG addwf mres1,F movfp PRODH,WREG addwfc mres2,F clrf WREG,F addwfc mres3,F btfss rb,7 ; test if B<0 goto sign_ra movfp ra+1,WREG ; if so, adjust value subwf mres2,F movfp ra,WREG subwfb mres3,F sign_ra btfss ra,7 ; test if A<0 goto sign_end movfp rb+1,WREG ; if so, adjust value subwf mres2,F movfp rb,WREG subwfb mres3,F sign_end rlcf mres1,F ; shift left one time rlcf mres2,F rlcf mres3,F rlcf mres1,F ; shift left one time rlcf mres2,F rlcf mres3,F rlcf mres1,F ; shift left one time rlcf mres2,F rlcf mres3,F movfp mres3, ra ; forget mres1 and store result movfp mres2, ra+1 ; in register A end_mult return ;---------------------------------------------------------------------------- ; m_divi : divide A with rdiv (A=A/DIV), rdiv being a non signed integer ; value and not a fixed decimal value ; ; call routines provided in Microchip's application notes (see div.inc) ;---------------------------------------------------------------------------- ; Correspondances between AN617 variables and pic'spectrum's... #define AARGB0 (ra) #define AARGB1 (ra+1) #define ACCB0 (ra) #define ACCB1 (ra+1) #define BARGB0 (rdiv) #define REMB0 (mres0) #define TEMP (mres1) #include "div.inc" ; include 16/8 unsigned routine ; from microchip's application ; note AN617 m_divi bcf msign,0 btfss ra,7 ; save sign of A goto m_divdiv bsf msign,0 comf ra,F ; if A<0, A=-A comf ra+1,F movlw 1 addwf ra+1,F movlw 0 addwfc ra,F m_divdiv call FXD1608U ; do the division btfss msign,0 ; if A was <0 goto end_mdivi comf ra,F ; A=-A comf ra+1,F movlw 1 addwf ra+1,F movlw 0 addwfc ra,F end_mdivi return ;---------------------------------------------------------------------------- ; m_div2 : divide A with 2 (A=A/2) ;---------------------------------------------------------------------------- m_div2 macro bcf ALUSTA,C rrcf ra,1 ; divide high byte rrcf ra+1,1 ; and low byte btfsc ra,6 ; test old sign bit bsf ra,7 ; if set, report it to msb endm ;---------------------------------------------------------------------------- ; m_sin : replace A with sin(A) ; ; Sinus calculated by interpolation of tables values got with the MSB of A ; (v_msb and v_msb+1 are the table values corresponding for msb A and the next ; one in the table, with rollover on 0) ; ; ra=(((v_msb+1)*lsb ra+(v_msb)*(1-lsb ra)); ; ;---------------------------------------------------------------------------- radix dec sintable dw 0 dw 255, 511, 766, 1021, 1274, 1527, 1777, 2026 dw 2273, 2518, 2760, 3000, 3237, 3470, 3700, 3927 dw 4150, 4368, 4583, 4793, 4998, 5198, 5393, 5583 dw 5768, 5947, 6120, 6287, 6448, 6603, 6751, 6893 dw 7028, 7156, 7277, 7391, 7498, 7597, 7689, 7774 dw 7850, 7920, 7981, 8035, 8081, 8119, 8149, 8171 dw 8185, 8191, 8189, 8179, 8162, 8136, 8102, 8060 dw 8011, 7953, 7888, 7815, 7735, 7647, 7551, 7448 dw 7338, 7221, 7097, 6965, 6827, 6682, 6531, 6373 dw 6210, 6040, 5864, 5682, 5495, 5303, 5105, 4902 dw 4695, 4483, 4266, 4046, 3821, 3593, 3361, 3126 dw 2888, 2647, 2404, 2158, 1910, 1660, 1408, 1156 dw 902, 647, 391, 135, -120, -375, -631, -886 dw -1140, -1393, -1644, -1894, -2142, -2388, -2632, -2873 dw -3111, -3347, -3579, -3807, -4032, -4253, -4469, -4682 dw -4889, -5092, -5290, -5483, -5671, -5853, -6029, 6199 dw 6029, 5853, 5671, 5483, 5290, 5092, 4889, 4682 dw 4469, 4253, 4032, 3807, 3579, 3347, 3111, 2873 dw 2632, 2388, 2142, 1894, 1644, 1393, 1140, 886 dw 631, 375, 120, -135, -391, -647, -902, -1156 dw -1408, -1660, -1910, -2158, -2404, -2647, -2888, -3126 dw -3361, -3593, -3821, -4046, -4266, -4483, -4695, -4902 dw -5105, -5303, -5495, -5682, -5864, -6040, -6210, -6373 dw -6531, -6682, -6827, -6965, -7097, -7221, -7338, -7448 dw -7551, -7647, -7735, -7815, -7888, -7953, -8011, -8060 dw -8102, -8136, -8162, -8179, -8189, -8191, -8185, -8171 dw -8149, -8119, -8081, -8035, -7981, -7920, -7850, -7774 dw -7689, -7597, -7498, -7391, -7277, -7156, -7028, -6893 dw -6751, -6603, -6448, -6287, -6120, -5947, -5768, -5583 dw -5393, -5198, -4998, -4793, -4583, -4368, -4150, -3927 dw -3700, -3470, -3237, -3000, -2760, -2518, -2273, -2026 dw -1777, -1527, -1274, -1021, -766, -511, -255 radix hex m_sin movpf rb,sin_saveb ; save B register movpf rb+1,sin_saveb+1 clrf x0+1,F movlw low (sintable) ; get table value corresponding addwf ra,W ; to the MSB of A -> x0 movwf TBLPTRL movlw high (sintable) addwfc x0+1,W movwf TBLPTRH tablrd 0,0,x0+1 ; dummy read, update TABLATH tlrd 1,x0 ; read high byte tablrd 0,1,x0+1 ; and low byte. clrf x1+1,F movfp ra,WREG ; get table value corresponding incf WREG,W ; to the MSB of A+1, with rollover at 0 addlw low (sintable) ; -> x1 movwf TBLPTRL movlw high (sintable) addwfc x1+1,W movwf TBLPTRH tablrd 0,0,x1+1 ; dummy read, update TABLATH tlrd 1,x1 ; read high byte tablrd 0,1,x1+1 ; and low byte. movfp ra+1,WREG ; get LSB of A in B movwf rb ; and convert it to a weight factor clrf rb+1,F bcf ALUSTA,C rrcf rb,F rrcf rb+1,F bcf ALUSTA,C rrcf rb,F rrcf rb+1,F bcf ALUSTA,C rrcf rb,F rrcf rb+1,F m_lda x1 ; multiply "next" table value by B call m_mult m_sta x2 ; and save it m_ldaconst H'2000' ; calculate 1-weight factor m_sub m_ldb x0 ; and multiply it by "previous" value call m_mult m_ldb x2 ; add the 2 values m_add end_sin m_ldb sin_saveb ; restore B return ;---------------------------------------------------------------------------- ; m_scalelin : linear scaling of A, result in WREG (0 to MAXPIXVAL) ; and in rdiv ;---------------------------------------------------------------------------- m_scalelin movpf ra,scaletmp ; copy A to scaletmp reg movpf ra+1,scaletmp+1 bcf ALUSTA,C ; divide by 16 rrcf scaletmp,F ; 2 rrcf scaletmp+1,F bcf ALUSTA,C rrcf scaletmp,F ; 4 rrcf scaletmp+1,F bcf ALUSTA,C rrcf scaletmp,F ; 8 rrcf scaletmp+1,F bcf ALUSTA,C rrcf scaletmp,F ; 16 rrcf scaletmp+1,F tstfsz scaletmp ; if tmp>255, return MAXPIVXVAL goto m_scaleover movlw MAXPIXVAL ; if tmp>MAXPIXVAL, return MAXPIXVAL cpfslt scaletmp+1 goto m_scaleover movfp scaletmp+1,WREG goto end_scalelin m_scaleover movlw MAXPIXVAL ; return MAXPIXVAL end_scalelin movwf rdiv return ;---------------------------------------------------------------------------- ; m_scalelog : logarithmic scaling of A, result in WREG (0 to 127) ; and in rdiv ;---------------------------------------------------------------------------- radix dec logtable dw -4652, -4599, -4548, -4496, -4445, -4394, -4344, -4294 dw -4245, -4196, -4147, -4098, -4050, -4002, -3955, -3908 dw -3861, -3815, -3769, -3723, -3677, -3632, -3587, -3543 dw -3498, -3454, -3410, -3367, -3324, -3281, -3238, -3196 dw -3154, -3112, -3071, -3029, -2988, -2947, -2907, -2867 dw -2826, -2787, -2747, -2708, -2669, -2630, -2591, -2553 dw -2514, -2476, -2438, -2401, -2363, -2326, -2289, -2253 dw -2216, -2180, -2143, -2107, -2072, -2036, -2001, -1965 dw -1930, -1895, -1861, -1826, -1792, -1758, -1724, -1690 dw -1656, -1623, -1590, -1556, -1523, -1491, -1458, -1425 dw -1393, -1361, -1329, -1297, -1265, -1234, -1202, -1171 dw -1140, -1109, -1078, -1047, -1017, -986, -956, -926 dw -896, -866, -836, -806, -777, -748, -718, -689 dw -660, -631, -603, -574, -545, -517, -489, -461 dw -433, -405, -377, -349, -322, -294, -267, -240 dw -213, -186, -159, -132, -105, -79, -52, -26 radix hex m_scalelog tstfsz ra ; if A<32, return 0 goto log_testover movlw D'32' cpfslt ra+1 goto log_testover movlw 0 goto end_scalelog log_testover movlw high (D'032'*MAXPIXVAL) ; if A>32xMAXPIXVAL, cpfsgt ra ; return MAXPIXVAL goto log_1 goto log_scaleover log_1 cpfseq ra goto log_ok movlw low (D'032'*MAXPIXVAL) cpfslt ra+1 goto log_scaleover log_ok clrf logresult,F ; clear result register clrf logresult+1,F movpf ra,scaletmp ; copy A to scaletmp reg movpf ra+1,scaletmp+1 ; (A is between 32 and 32xMAXPIXVAL) bcf ALUSTA,C ; multiply tmp by 8 rlcf scaletmp+1,F ; 2 rlcf scaletmp,F bcf ALUSTA,C rlcf scaletmp+1,F ; 4 rlcf scaletmp,F bcf ALUSTA,C rlcf scaletmp+1,F ; 8 rlcf scaletmp,F ; (tmp is between 256 and 256xMAXPIXVAL) ; normalization phase, until tmp < 256 log_normalize tstfsz scaletmp goto log_2 goto log_endnorm log_2 movlw low D'4652' ; add 256*ln(2)*MAXPIXVAL/ln(MAXPIXVAL) addwf logresult+1,F ; (=4652) to current evaluation movlw high D'4652' addwfc logresult,F bcf ALUSTA,C rrcf scaletmp,F ; divide tmp by 2 rrcf scaletmp+1,F goto log_normalize ; and loop log_endnorm movlw H'7F' ; tmp is now between 128 and 255 andwf scaletmp+1,W ; substract 128 addlw low (logtable) ; and use it as index in logtable movwf TBLPTRL movlw high (logtable) addwfc scaletmp,W movwf TBLPTRH tablrd 0,0,scaletmp+1 ; dummy read, update TABLATH tlrd 1,scaletmp ; read high byte tablrd 0,1,scaletmp+1 ; and low byte. movfp scaletmp+1,WREG addwf logresult+1,F ; add this value to result movfp scaletmp,WREG addwf logresult,F movfp logresult,WREG ; returned value is high byte goto end_scalelog log_scaleover movlw MAXPIXVAL end_scalelog movwf rdiv return ;---------------------------------------------------------------------------- ; m_mathtest : Test utility for mathlib functions ; ; to be used for debug only ;---------------------------------------------------------------------------- m_mathtest m_ldaconst H'23EF' ; (1.123) m_mvab m_ldaconst H'B561' ; (-2.332) m_lddiv 0 nop ; expected : ; RA = -19103 $B561 -2.331909 RB = 9199 $23EF 1.122925 RDIV = 0 $00 call m_sin nop ; expected : ; RA = -5931 $E8D5 -0.723999 RB = 9199 $23EF 1.122925 RDIV = 0 $00 call m_mult nop ; expected : ; RA = -6660 $E5FC -0.812988 RB = 9199 $23EF 1.122925 RDIV = 0 $00 m_mvab m_ldaconst H'F88B' ; (-0.233) m_add nop ; expected : ; RA = -8568 $DE88 -1.045898 RB = -6660 $E5FC -0.812988 RDIV = 0 $00 movlw D'44' movwf h1i m_stai h1i m_ldaconst 0 movlw D'44' movwf h1i m_ldbi h1i m_mvba nop ; expected : ; RA = -8568 $DE88 -1.045898 RB = -8568 $DE88 -1.045898 RDIV = 0 $00 m_ldaconst H'F8DB' ; (-0.2233); m_sub nop ; expected : ; RA = 6739 $1A53 0.822632 RB = -8568 $DE88 -1.045898 RDIV = 0 $00 m_mvab m_ldaconst H'470A' ; (2.22) m_add nop ; expected : ; RA = 24925 $615D 3.042603 RB = 6739 $1A53 0.822632 RDIV = 0 $00 call m_sin m_mvab m_ldaconst H'F560' ; (-0.332) call m_mult nop ; expected : ; RA = -268 $FEF4 -0.032715 RB = 809 $0329 0.098755 RDIV = 0 $00 m_sta h1r movlw D'31' movwf h2r m_lddiv h2r call m_divi nop ; expected : ; RA = -8 $FFF8 -0.000977 RB = 809 $0329 0.098755 RDIV = 31 $1F m_ldb h1r m_sub call m_mult nop ; expected : ; RA = -8 $FFF8 -0.000977 RB = -268 $FEF4 -0.032715 RDIV = 31 $1F m_mvab m_lda h1r call m_sin call m_mult nop ; expected : ; RA = 0 $0000 0.000000 RB = -8 $FFF8 -0.000977 RDIV = 31 $1F m_ldaconst H'18E2' ; (0.7776) call m_scalelin nop ; expected : ; RA = 6370 $18E2 0.777588 RB = -8 $FFF8 -0.000977 RDIV = 127 $7F m_ldaconst H'C15' ; (0.3776); call m_scalelin nop ; expected : ; RA = 3093 $0C15 0.377563 RB = -8 $FFF8 -0.000977 RDIV = 96 $60 m_ldaconst H'C15' ; (0.3776) m_div2 call m_scalelin nop ; expected : ; RA = 1546 $060A 0.188721 RB = -8 $FFF8 -0.000977 RDIV = 48 $30 m_ldaconst H'18E2' ; (0.7776); call m_scalelog nop ; expected : ; RA = 6370 $18E2 0.777588 RB = -8 $FFF8 -0.000977 RDIV = 127 $7F m_ldaconst H'C15' ; (0.3776) call m_scalelog nop ; expected : ; RA = 3093 $0C15 0.377563 RB = -8 $FFF8 -0.000977 RDIV = 119 $77 m_ldaconst H'C15' ; (0.3776) m_div2 call m_scalelog nop ; expected : ; RA = 1546 $060A 0.188721 RB = -8 $FFF8 -0.000977 RDIV = 101 $65 m_lda h1r m_div2 call m_sin m_mvab m_ldaconst H'438D' ; (2.111) call m_mult nop ; expected : ; RA = -280 $FEE8 -0.034180 RB = -133 $FF7B -0.016235 RDIV = 101 $65 call m_scalelog nop ; expected : ; RA = -280 $FEE8 -0.034180 RB = -133 $FF7B -0.016235 RDIV = 0 $00 return ;============================================================================ ; - END OF FILE - ;============================================================================ ;============================================================================ ; PROJECT : PIC'SPECTRUM ; ; FILE : TESTSIG.INC ; ; VERSION : 1.0 ; ; DESCRIPTION : ; ; Test signals generation (for validation of the FFT routines) ; ; A square test signal is generated during ram initialization, and is ; displayed if the Pic'Spectrum is switched on in hold mode. ; ;============================================================================ ; Developped & Copyrighted by Robert LACOSTE ;============================================================================ ;---------------------------------------------------------------------------- ; test_square : Generate a square signal ; ; On input, amplitude is in math register A, half-period in WREG ;---------------------------------------------------------------------------- test_square clrf cpti,F ; cpti=index to data clrf cptj,F ; cptj=phase movwf test_halfp ; test_halfp=halfperiod testsquare_b incf cptj,F ; increment phase movfp cptj,WREG cpfseq test_halfp ; equal to half-period ? goto testsquare_norm clrf cptj,F ; if yes, reset phase m_mvab m_ldaconst H'E000' ; and multiply phase by -1 call m_mult testsquare_norm m_stai cpti ; store current amplitude incfsz cpti,F goto testsquare_b ; and loop return ;---------------------------------------------------------------------------- ; test_triangle : Generate a triangle signal ; ; On input, step is in math register A, half-period in WREG ;---------------------------------------------------------------------------- test_triangle clrf cpti,F ; cpti=index to data movwf test_halfp ; halfp=halfperiod bcf ALUSTA,C rrcf WREG,W movwf cptj ; cptj=phase (initialised to 50%) m_sta test_step ; test_step=step m_ldaconst 0 m_sta test_cval ; test_cval=current value testtriangle_b incf cptj,F ; increment phase movfp cptj,WREG cpfseq test_halfp ; equal to half-period ? goto testtriang_norm clrf cptj,F ; if yes, reset phase m_lda test_step m_mvab m_ldaconst H'E000' ; and multiply step by -1 call m_mult m_sta test_step testtriang_norm m_lda test_cval ; increment value by step value m_mvab m_lda test_step m_add m_sta test_cval m_stai cpti ; store current amplitude incfsz cpti,F goto testtriangle_b ; and loop return ;============================================================================ ; - END OF FILE - ;============================================================================ ;============================================================================ ; PROJECT : PIC'SPECTRUM ; ; FILE : FFT.INC ; ; VERSION : 1.0 ; ; DESCRIPTION : ; ; 256 points FFT routines, using s/2/13 format for numeric computations ; (through the fixed.inc library). All data are stored in the internal ; registers of the 17C756 (array DATA). ; ; Execution time on a PIC17C756/32MHz : around 50ms without concurrent ; video generation (resulting in a 90-100ms refresh time with spectrum ; power calculation, analog acquisition and video refresh) ; ;============================================================================ ; Developped & Copyrighted by Robert LACOSTE ;============================================================================ ;---------------------------------------------------------------------------- ; Complex FFT, radix-1, decimation in place, 128 points ; ; Algorithm from "Numerical recipes in C", manually compiled in assembler ; and adapted... ; ; Input : 128 complex values (each on 4 bytes), stored in data[0..511] ; For each data : byte 0 = MSB of real part ; byte 1 = LSB of real part ; byte 2 = MSB of complex part ; byte 3 = LSB of complex part ; ; Replace data[0..511] by its FFT (128 frequencies, complex values) ;---------------------------------------------------------------------------- fft nop ; Control point : Input FFT ; ------> initialisation clrf j,F ; j=0 ; nn=128 (implicit), n=256 (implicit) ; ------> bit reversal clrf i,F ; for(i=0;i<n-1;i+=2) { iloop1 nop if1 movfp i,WREG ; if (j>i) { cpfsgt j goto endif1 m_ldai j ; m_ldai(j) m_ldbi i ; m_ldbi(i) m_stai i ; m_stai(i) m_mvba ; m_mvba() m_stai j ; m_stai(j); incf j,F incf i,F m_ldai j ; m_ldai(j+1) m_ldbi i ; m_ldbi(i+1) m_stai i ; m_stai(i+1) m_mvba ; m_mvba() m_stai j ; m_stai(j+1) decf j,F decf i,F endif1 nop ; } endif movlw D'128' ; m=n>>1 movwf m while1 movlw D'2' ; while(m>=2 && j>=m) { cpfslt m goto $+2 goto wend1 movfp m,WREG cpfslt j goto $+2 goto wend1 movfp m,WREG ; j-=m subwf j,F bcf ALUSTA,C ; m>>=1 rrcf m,F wloop1 goto while1 ; } wend1 movfp m,WREG ; j+=m addwf j,F inext1 incf i,F ; } next i incfsz i,F goto iloop1 ; ------> FFT itself movlw D'2' ; mmax=2 movwf mmax while2 tstfsz mmax ; while(n>mmax) { goto $+2 goto wend2 movfp mmax, WREG ; istep=mmax<<1 bcf ALUSTA,C rlcf WREG,F movwf istep ; theta=2pi/mmax m_ldaconst H'6488' ; m_ldaconst(3.14159265459) m_lddiv mmax ; m_lddiv(mmax>>1) bcf ALUSTA,C rrcf rdiv,F call m_divi ; m_divi() m_sta theta ; m_sta(&theta) ; wpr=-2*sin(theta/2)^2 movlw D'2' ; m_lddiv(2) movwf rdiv call m_divi ; m_divi() call m_sin ; m_sin() m_mvab ; m_mvab() call m_mult ; m_mult() m_mvab ; m_mvab() m_ldaconst H'C000' ; m_ldaconst(-2.0) call m_mult ; m_mult() m_sta wpr ; m_sta(&wpr) ; wpi=n_sin(theta) m_lda theta ; m_lda(theta) call m_sin ; m_sin() m_sta wpi ; m_sta(&wpi) ; wr=1, wi=0 m_ldaconst H'2000' ; m_ldaconst(1.0) m_sta wr ; m_sta(&wr) m_ldaconst H'0000' ; m_ldaconst(0.0) m_sta wi ; m_sta(&wi) ffttst1 nop clrf m,F ; for(m=0;m<mmax-1;m+=2) { mloop1 movfp mmax,WREG decf WREG,W cpfslt m goto mend1 ffttst2 nop movfp m,WREG ; for(i=m;i<n;i+=istep) { movwf i iloop2 nop movfp i,WREG ; j=i+mmax movwf j movfp mmax,WREG addwf j,F ffttst3 nop ; h1r=wr*data[j]-wi*data[j+1] m_lda wi ; m_lda(wi) incf j,F ; m_ldbi(j+1) m_ldbi j decf j,F call m_mult ; m_mult() m_sta h1r ; m_sta(&h1r) m_lda wr ; m_lda(wr) m_ldbi j ; m_ldbi(j) call m_mult ; m_mult() m_ldb h1r ; m_ldb(h1r) m_sub ; m_sub() m_sta h1r ; m_sta(&h1r) ; h1i=wr*data[j+1]+wi*data[j] m_lda wi ; m_lda(wi) m_ldbi j ; m_ldbi(j) call m_mult ; m_mult() m_sta h1i ; m_sta(&h1i) m_lda wr ; m_lda(wr) incf j,F ; m_ldbi(j+1) m_ldbi j decf j,F call m_mult ; m_mult() m_ldb h1i ; m_ldb(h1i) m_add ; m_add() m_sta h1i ; m_sta(&h1i) ; butterfly update, with in-place scaling ; data[j]=(data[i]-h1r)/2 m_ldai i ; m_ldai(i) m_ldb h1r ; m_ldb(h1r) m_sub ; m_sub() m_div2 ; m_div2() m_stai j ; m_stai(j) ; data[j+1]=(data[i+1]-h1i)/2 incf i,F ; m_ldai(i+1) m_ldai i decf i,F m_ldb h1i ; m_ldb(h1i) m_sub ; m_sub() m_div2 ; m_div2() incf j,F ; m_stai(j+1) m_stai j decf j,F ; data[i]=(data[i]+h1r)/2 m_ldai i ; m_ldai(i) m_ldb h1r ; m_ldb(h1r) m_add ; m_add() m_div2 ; m_div2() m_stai i ; m_stai(i) ; data[i+1]=(data[i+1]+h1i)/2 incf i,F ; m_ldai(i+1) m_ldai i decf i,F m_ldb h1i ; m_ldb(h1i) m_add ; m_add() m_div2 ; m_div2() incf i,F ; m_stai(i+1) m_stai i decf i,F inext2 tstfsz istep ; } next i goto $+2 goto iend2 movfp istep,WREG addwf i,F btfss ALUSTA,C goto iloop2 ; wtemp=wr iend2 m_lda wr ; m_lda(wr) m_sta wtemp ; m_sta(&wtemp) ; wr=wr*wpr-wi*wpi+wr m_lda wi ; m_lda(wi) m_ldb wpi ; m_ldb(wpi) call m_mult ; m_mult() m_sta h1r ; m_sta(&h1r) m_lda wr ; m_lda(wr) m_ldb wpr ; m_ldb(wpr) call m_mult ; m_mult() m_ldb h1r ; m_ldb(h1r) m_sub ; m_sub() m_ldb wr ; m_ldb(wr) m_add ; m_add() m_sta wr ; m_sta(&wr) ; wi=wi*wpr+wtemp*wpi+wi m_lda wtemp ; m_lda(wtemp) m_ldb wpi ; m_ldb(wpi) call m_mult ; m_mult() m_sta h1i ; m_sta(&h1i) m_lda wi ; m_lda(wi) m_ldb wpr ; m_ldb(wpr) call m_mult ; m_mult() m_ldb h1i ; m_ldb(h1i) m_add ; m_add() m_ldb wi ; m_ldb(wi) m_add ; m_add() m_sta wi ; m_sta(&wi) mnext1 incf m,F ; } next m incf m,F goto mloop1 mend1 nop movfp istep,WREG ; mmax=istep movwf mmax wloop2 goto while2 ; } end while wend2 return ;---------------------------------------------------------------------------- ; Real FFT ; ; Algorithm from "Numerical recipes in C", manually compiled in assembler ; and adapted... ; ; Calculate FFT of a set of 256 real values stored in data[0..511] ; (2 bytes per value, MSB first). ; ; Replace these data by the positive frequency half of the FFT ; (128 frequencies, complex values). First and last frequencies (which are ; real) are in data[1] and data[2] respectively. ; ; Method : consider the 256 real values as interleaved real/imaginary parts ; of 128 complex values. Do a complex 128 points FFT, and find back the ; FFT of the real numbers from the output of the complex FFT... ; ; Nota : this method allow to do a real FFT with 30-40% less calculations ; and, more important, 50% less RAM requirement. ;---------------------------------------------------------------------------- realfft nop ; control point, N=256 (implicit) ; ------> do a complex FFT of half the number of points, odd real points ; as real data, even real points as imaginary data call fft ;-------> and find the good values from the result... ; theta=2pi/n m_ldaconst H'6488' ; m_ldaconst(3.14159265459) movlw D'128' ; m_lddiv(n>>1) movwf rdiv call m_divi ; m_divi() m_sta theta ; m_sta(&theta) ; wpr=-2*sin(theta/2)^2 movlw D'2' ; m_lddiv(2) movwf rdiv call m_divi ; m_divi() call m_sin ; m_sin() m_mvab ; m_mvab() call m_mult ; m_mult() m_mvab ; m_mvab() m_ldaconst H'C000' ; m_ldaconst(-2.0) call m_mult ; m_mult() m_sta wpr ; m_sta(&wpr) ; wpi=n_sin(theta) m_lda theta ; m_lda(theta) call m_sin ; m_sin() m_sta wpi ; m_sta(&wpi) ; wr=1+wpr, wi=wpi m_ldb wpr ; m_ldb(wpr) m_ldaconst H'2000' ; m_ldaconst(1.0) m_add ; m_add() m_sta wr ; m_sta(&wr) m_lda wpi ; m_lda(wpi) m_sta wi ; m_sta(&wi) movlw D'2' ; for(i=2;i<=(n>>2);i++) { movwf i iloop3 movlw D'64' cpfsgt i goto $+2 goto iend3 movfp i,WREG ; i1=i+i-2 movwf i1 addwf i1,F movlw D'2' subwf i1,F movfp i1,WREG ; i2=1+i1 movwf i2 incf i2,F movfp i2,WREG ; i3=n-i2+1 comf WREG,W incf WREG,W incf WREG,W movwf i3 incf WREG,W movwf i4 ; i4=1+i3 ; h1r=(data[i1]+data[i3])/2 m_ldai i1 ; m_ldai(i1) m_ldbi i3 ; m_ldbi(i3) m_add ; m_add() m_div2 ; m_div2() m_sta h1r ; m_sta(&h1r) ; h1i=(data[i2]-data[i4])/2 m_ldai i2 ; m_ldai(i2) m_ldbi i4 ; m_ldbi(i4) m_sub ; m_sub() m_div2 ; m_div2() m_sta h1i ; m_sta(&h1i) ; h2r=(data[i2]+data[i4])/2 m_ldai i2 ; m_ldai(i2) m_ldbi i4 ; m_ldbi(i4) m_add ; m_add() m_div2 ; m_div2() m_sta h2r ; m_sta(&h2r) ; h2i=-(data[i1]-data[i3])/2 m_ldai i3 ; m_ldai(i3) m_ldbi i1 ; m_ldbi(i1) m_sub ; m_sub() m_div2 ; m_div2() m_sta h2i ; m_sta(&h2i) ; data[i1]=h1r+wr*h2r-wi*h2i m_lda wi ; m_lda(wi) m_ldb h2i ; m_ldb(h2i) call m_mult ; m_mult() m_sta wtemp ; m_sta(&wtemp) m_lda wr ; m_lda(wr) m_ldb h2r ; m_ldb(h2r) call m_mult ; m_mult() m_ldb wtemp ; m_ldb(wtemp) m_sub ; m_sub() m_ldb h1r ; m_ldb(h1r) m_add ; m_add() m_stai i1 ; m_stai(i1) ; data[i2]=h1i+wr*h2i+wi*h2r m_lda wi ; m_lda(wi) m_ldb h2r ; m_ldb(h2r) call m_mult ; m_mult() m_sta wtemp ; m_sta(&wtemp) m_lda wr ; m_lda(wr) m_ldb h2i ; m_ldb(h2i) call m_mult ; m_mult() m_ldb wtemp ; m_ldb(wtemp) m_add ; m_add() m_ldb h1i ; m_ldb(h1i) m_add ; m_add() m_stai i2 ; m_stai(i2) ; data[i3]=h1r-wr*h2r+wi*h2i m_lda wr ; m_lda(wr) m_ldb h2r ; m_ldb(h2r) call m_mult ; m_mult() m_sta wtemp ; m_sta(&wtemp) m_lda wi ; m_lda(wi) m_ldb h2i ; m_ldb(h2i) call m_mult ; m_mult() m_ldb wtemp ; m_ldb(wtemp) m_sub ; m_sub() m_ldb h1r ; m_ldb(h1r) m_add ; m_add() m_stai i3 ; m_stai(i3) ; data[i4]=-h1i+wr*h2i+wi*h2r m_lda wr ; m_lda(wr) m_ldb h2i ; m_ldb(h2i) call m_mult ; m_mult() m_sta wtemp ; m_sta(&wtemp) m_lda wi ; m_lda(wi) m_ldb h2r ; m_ldb(h2r) call m_mult ; m_mult() m_ldb wtemp ; m_ldb(wtemp) m_add ; m_add() m_ldb h1i ; m_ldb(h1i) m_sub ; m_sub() m_stai i4 ; m_stai(i4) ; wtemp=wr m_lda wr ; m_lda(wr) m_sta wtemp ; m_sta(&wtemp) ; wr=wr*wpr-wi*wpi+wr m_lda wi ; m_lda(wi) m_ldb wpi ; m_ldb(wpi) call m_mult ; m_mult() m_sta h1r ; m_sta(&h1r) m_lda wr ; m_lda(wr) m_ldb wpr ; m_ldb(wpr) call m_mult ; m_mult() m_ldb h1r ; m_ldb(h1r) m_sub ; m_sub() m_ldb wr ; m_ldb(wr) m_add ; m_add() m_sta wr ; m_sta(&wr) ; wi=wi*wpr+wtemp*wpi+wi m_lda wi ; m_lda(wi) m_ldb wpr ; m_ldb(wpr) call m_mult ; m_mult() m_sta h1r ; m_sta(&h1r) m_lda wtemp ; m_lda(wtemp) m_ldb wpi ; m_ldb(wpi) call m_mult ; m_mult() m_ldb h1r ; m_ldb(h1r) m_add ; m_add() m_ldb wi ; m_ldb(wi) m_add ; m_add() m_sta wi ; m_sta(&wi) inext3 incf i,F ; } next i goto iloop3 iend3 nop ; ------> special case of the 2 first data ; h1r=data[0] movlw 0 ; m_ldai(0) movwf i m_ldai i m_sta h1r ; m_sta(&h1r) ; data[0]=h1r+data[1] movlw 1 ; m_ldbi(1) movwf i m_ldbi i m_add ; m_add() movlw 0 ; m_stai(0) movwf i m_stai i ; data[1]=h1r-data[1] m_lda h1r ; m_lda(h1r) movlw 1 ; m_ldbi(1) movwf i m_ldbi i m_sub ; m_sub() movlw 1 ; m_stai(1) movwf i m_stai i endrft return ;============================================================================ ; - END OF FILE - ;============================================================================ ;============================================================================ ; PROJECT : PIC'SPECTRUM ; ; FILE : POWERS.INC ; ; VERSION : 1.0 ; ; DESCRIPTION : ; ; Power spectrum calculation starting with the result of the real FFT. ; Result power is scaled (lin or log) and stored in the display buffer ; area (dispbuf) : 1 byte per frequency (1 to 126) ; ; This file define also the routine used by the interrupt routine to ; access the display buffer (with is paged) ; ; The display buffer table ("dispbuf") is a 2x64 bytes array, each of the ; two blocks being at at fixed adress ($20 to $5F) in the banks 2 and 3. ; ; Nota : dispbuf(0) (DC frequency) is not displayed. ; ;============================================================================ ; Developped & Copyrighted by Robert LACOSTE ;============================================================================ ;---------------------------------------------------------------------------- ; dispbufwr : Write a value in the given display buffer cell ; On input : WREG = index (0 to 127) ; RDIV = value (0 to MAXPIXVAL) ; On output : bank selected = zone_main ;---------------------------------------------------------------------------- dispbufwr macro movlr 2 ; start with bank 2 btfsc WREG,6 ; select the good bank bsf BSR,4 ; based on 6th bit of index andlw B'00111111' ; clear 2 MSB bits addlw H'20' ; add $20 (data start at $20) movwf FSR0 ; and use it as an index movfp rdiv,INDF0 ; to store value BANKSEL zone_main ; reset bank register endm ;---------------------------------------------------------------------------- ; dispbufrd : Read a value from the given display buffer cell ; On input : WREG = index (0 to 127) ; On output : WREG = value (0 to MAXPIXVAL) ; bank selected = zone_irq ; ; WARNING : Time critical routine ! In particular, execution time should ; be always exactly the same (if not, pixels won't be aligned ; anymore...) ; ; DURATION : 8 cycles (1.00 microsecond at 32MHz) ;---------------------------------------------------------------------------- dispbufrd macro movlr 2 ; start with bank 2 btfsc WREG,6 ; select the good bank bsf BSR,4 ; based on 6th bit of index andlw B'00111111' ; clear 2 MSB bits addlw H'20' ; add $20 (data start at $20) movwf FSR0 ; and use it as an index movfp INDF0,WREG ; to read value BANKSEL zone_irq ; reset bank register endm ;---------------------------------------------------------------------------- ; intpowerlin : Calculate power spectrum for the complex value stored ; in RA and RB, scale it with a linear scale (result from 0 ; to MAXPIXVAL) and store the result in RDIV ;---------------------------------------------------------------------------- ; A=(A/2)^2+(B/2)^2 (divide by 2 to exclude overflow) intpowerlin m_sta h1r ; m_sta(&h1r) m_mvba ; m_mvba() m_div2 ; m_div2() m_mvab ; m_mvab() call m_mult ; m_mult() m_sta h2r ; m_sta(&h2r) m_lda h1r ; m_lda(h1r) m_div2 ; m_div2() m_mvab ; m_mvab() call m_mult ; m_mult() m_ldb h2r ; m_ldb(h2r) m_add ; m_add() call m_scalelin ; m_scalelin() return ;---------------------------------------------------------------------------- ; intpowerlog : Calculate power spectrum for the complex value stored ; in RA and RB, scale it with a log scale (result from 0 ; to MAXPIXVAL) and store the result in RDIV ;---------------------------------------------------------------------------- ; A=(A/2)^2+(B/2)^2 (divide by 2 to exclude overflow) intpowerlog m_sta h1r ; m_sta(&h1r) m_mvba ; m_mvba() m_div2 ; m_div2() m_mvab ; m_mvab() call m_mult ; m_mult() m_sta h2r ; m_sta(&h2r) m_lda h1r ; m_lda(h1r) m_div2 ; m_div2() m_mvab ; m_mvab() call m_mult ; m_mult() m_ldb h2r ; m_ldb(h2r) m_add ; m_add() call m_scalelog ; m_scalelog() return ;---------------------------------------------------------------------------- ; powerlin : Calculate power spectrum for the complex spectrum stored ; in "data", scale it with a linear scale (result from 0 ; to MAXPIXVAL) and store the result in "dispbuf" ; ; Nota : last frequency (number 128) is discarted ;---------------------------------------------------------------------------- powerlin nop ;--------------> Special case of the first value (real) clrf rdiv,F m_ldai rdiv ; m_ldai(0) m_ldbi rdiv ; m_ldbi(0) call intpowerlin ; intpower() movlw 0 dispbufwr ; dispbuf[0]=(unsigned char)rdiv ;--------------> General case clrf i,F ; for (i=1;i<SLENGTH/2;i++) { incf i,F iloop4 nop movfp i,WREG ; i2=(i<<1) movwf i2 bcf ALUSTA,C rlcf i2,F m_ldai i2 ; m_ldai(i2) incf i2,F ; m_ldbi(i2+1) m_ldbi i2 call intpowerlin ; intpower(); movfp i,WREG ; dispbuf[i]=(unsigned char)rdiv dispbufwr inext4 incf i,F ; } next i movlw D'128' cpfseq i goto iloop4 return ;---------------------------------------------------------------------------- ; powerlog : Calculate power spectrum for the complex spectrum stored ; in "data", scale it with a log scale (result from 0 ; to MAXPIXVAL) and store the result in "dispbuf" ;---------------------------------------------------------------------------- powerlog nop ;--------------> Special case of the first value (real) clrf rdiv,F m_ldai rdiv ; m_ldai(0) m_ldbi rdiv ; m_ldbi(0) call intpowerlog ; intpower() movlw 0 dispbufwr ; dispbuf[0]=(unsigned char)rdiv ;--------------> General case clrf i,F ; for (i=1;i<SLENGTH/2;i++) { incf i,F iloop5 nop movfp i,WREG ; i2=(i<<1) movwf i2 bcf ALUSTA,C rlcf i2,F m_ldai i2 ; m_ldai(i2) incf i2,F ; m_ldbi(i2+1) m_ldbi i2 call intpowerlog ; intpower(); movfp i,WREG ; dispbuf[i]=(unsigned char)rdiv dispbufwr inext5 incf i,F ; } next i movlw D'128' cpfseq i goto iloop5 return ;============================================================================ ; - END OF FILE - ;============================================================================ ;============================================================================ ; PROJECT : UPS'SPECTRUM ; ; FILE : IRQ.INC ; ; VERSION : 1.0 ; ; DESCRIPTION : ; ; Handler of the timer0 interrupt, in charge of all real time tasks, ; mainly analog signal acquisition and software video generation... ; ; WARNING : These routines are VERY time critical, in particular for the ; video generation. Do not change the duration of any routine (even by adding ; or deleting only one instruction) without a deep analysis. Effects can go ; from misaligned pixels to... loss of video synchronisation. ; The main time dependencies are indicated in the source (see "PT" checkpoints ; and "RT" comments) but I'm not sure that the list is complete ! ; ; Comment : Some of the routines may seems a little "bulk force" and ; excessively rom expensive, but think twice about the performances required ; before replacing everything by loop ! In fact, we only do manually what ; modern compilers do as part as their optimization phase... loop unrolling ! ; ;============================================================================ ; Developped & Copyrighted by Robert LACOSTE ;============================================================================ ;---------------------------------------------------------------------------- ; Management of analog acquisitions and generation of Hsync signal ; ; Check if an analog acquisition is requested by the main program. ; If so do the acquisition of 256 samples (one each 2 video scan lines, ; giving a sample rate of 31.5KHz/2=15.75KHz) ; ; Synchronisation with the main program is done through acq_request flag ; and num_sample register : ; ; Main program : ; - To launch a sampling, put acq_request=1 and reset num_sample ; - wait for acq_request to be back 0 ; ; This interrupt routine : ; - if acq_request=0 => Nothing to do ; - if acq_request=1 => Launch acquisition and put acq_request=2 ; - if acq_request=2 => Get result and store it in (num_sample) ; Increment num_sample ; If <256, put acq_request=1 (sampling period) ; else put acq_request=0 ; ; The HSync signal is generated within this routine, insuring that its length ; is constant (=30 clock cycles) and its position fixed. ; ; Warning : The duration of this routine must be CONSTANT, whatever tests ; results are ! (now, its 37 cycles) ; ; Warning : on input, bankselect should be on zone_irq ;---------------------------------------------------------------------------- manage_adc macro bsf PORTC,4 ; set RC4 (HSync signal active) ;--> RT constraint !!! From PT1, delay >= 0.94µS=8 instr (pre-HSync blanking) ; and fixed (whatever test & branch are executed) ;--> RT checkpoint PT2 (start of HSync signal) ;--> RT checkpoint PT0A (start of ADC management) movlw 2 ; acq_request = 2 ? cpfseq acq_request goto adc_not2 ;--> Acq_request=2 ; save RA (because we must use a non banked memory) movpf ra, tmpi movpf ra+1, tmpi+1 ; scale ADC value (0 to 653536 -> -8192 to +8192) movlb 5 movpf ADRESL,ra+1 ; get ADC value movpf ADRESH,ra ; and scale it to our floating format bcf ALUSTA,C rrcf ra,F ; divide by 4 rrcf ra+1,F bcf ALUSTA,C rrcf ra,F rrcf ra+1,F movlw H'20' ; substract H'2000' subwf ra,F ; it's now from -1.0 to +1.0 ; store ADC value in data(num_sample) movlb 5 ; select register bank 5 movfp num_sample, WREG movlr 0 ; start with bank 0 btfsc WREG,7 ; select the good bank bsf BSR,5 btfsc WREG,6 ; based on 2 first bits of WREG bsf BSR,4 bcf ALUSTA,C ; multiply by 2 rlcf WREG,1 bsf WREG,7 ; and set high bit (data start at $80) movwf FSR0 ; and use it as an index movfp ra,INDF0 ; to store msb value... movlb 1 bcf PORTC,4 ; clear RC4 (HSync signal inactive) ;--> RT constraint !!! From PT2, delay = 3.77µS=30 instr (HSync duration) ; and fixed (whatever test & branch are executed) ;--> RT checkpoint PT3 (end of HSync signal) incf FSR0,1 movfp ra+1,INDF0 ; ... and lsb value BANKSEL zone_irq ; reset bank register ; increment num_sample and update aca_request clrf acq_request,F ; acq_request=0 movlw 1 incfsz num_sample,F ; increment num_sample movwf acq_request ; if <>0, acq_request=1 ; restore RA movfp tmpi, ra movfp tmpi+1, ra+1 goto end_manage_adc adc_not2 nop ; acq_request <> 2 nop nop nop nop nop nop ; delay nop's in order to be in nop ; synch with the switch case above nop nop nop nop movlw 1 cpfseq acq_request ; acq_request=1 ? goto adc_0 goto adc_1 ;--> Acq_request=0 adc_0 nop ; acq=request is 0. Nothing to do nop ; except wait... nop nop nop nop nop nop movlb 1 bcf PORTC,4 ; clear RC4 (HSync signal inactive) ;--> RT constraint !!! From PT2, delay = 3.77µS=30 instr (HSync duration) ; and fixed (whatever test & branch are executed) ;--> RT checkpoint PT3 (end of HSync signal) nop nop nop nop nop nop nop nop nop goto end_manage_adc ;--> Acq_request=1 adc_1 nop movlb 5 ; start ADC conversion bsf ADCON0,GO movlw 2 ; acq_request=2 movwf acq_request nop nop movlb 1 bcf PORTC,4 ; clear RC4 (HSync signal inactive) ;--> RT constraint !!! From PT2, delay = 3.77µS=30 instr (HSync duration) ; and fixed (whatever test & branch are executed) ;--> RT checkpoint PT3 (end of HSync signal) nop nop nop nop nop nop nop nop nop nop nop ; and wait end_manage_adc nop endm ;--> RT constraint !!! From PT0A, delay FIXED (now 42 instructions cycles) ;---------------------------------------------------------------------------- ; Routine called on timer0 interrupt ; ; This routine is called at 31.5KHz (horizontal refresh rate for 640x350) ; and do the main real time tasks : ; ; - Registers saving ; - Analog acquisition ; - Video generation ; - Registers restoring ; ; Warning : Time from interrupt to video generation must be rigourously ; stable. ;---------------------------------------------------------------------------- it_timer movpf BSR,sv_bsr ; save BSR ;--> RT checkpoint PT0 (start of interrupt routine) BANKSEL zone_irq movpf ALUSTA,sv_alusta ; save ALUSTA movwf sv_wreg ; save WREG movpf FSR0,sv_fsr0 ; save FSR0 movlb 0 clrf PORTB,F ; switch video off ;--> RT checkpoint PT1 (start of horizontal blanking zone) movlb 1 bsf PORTD,2 ; set RD2 (debug line : IRQ going on) movlw high INITTIM ; reload timer movwf tmpi movlw low INITTIM movwf TMR0L movfp tmpi,TMR0H manage_adc ; ADC management, 35 clock cycles movlw 1 ; increment scan_line addwf scan_line+1,F ; (rollback to 0 done in the last's clrf WREG,W ; line sub-routine) addwfc scan_line,F movlb 0 ; select registers bank 0 for video ; Based on scan_line value (from 1 to 449), calculate ; the address of the line management routine movlw low jump_table ; calculate jump address addwf scan_line+1,W movwf tmpi movlw high jump_table addwfc scan_line,W movwf PCLATH ;--> RT constraint !!! From PT3 to first pixel display, ; delay > 1.89µS=15 instr (post HSync blanking) movfp tmpi, PCL ; and jump to it ! ; at the end of the scan line display, the called routine ; will jump back to resume_irq resume_irq movlb 1 bcf PORTD,2 ; clear RD2 (debug line : IRQ going on) BANKSEL zone_irq movfp sv_alusta,ALUSTA ; restore ALUSTA movfp sv_fsr0,FSR0 ; and FSR0 movfp sv_wreg,WREG ; and WREG movfp sv_bsr,BSR ; and BSR retfie ; return from interrupt ;--> RT constraint !!! From PT0, delay < 30µS=240 instr (Timer0 irq period) ; it lets 240-71=169 instructions for the scan_x routines ;---------------------------------------------------------------------------- ; Jump address table ; ; For each scan line (1 to 449), calculated jump to the good management ; routine, depending on the scan line number ;---------------------------------------------------------------------------- jump_table goto scan_blanking ; scan 000, should not occur goto scan_vsynch_on ; scan 001, switch on VSynch goto scan_blanking ; scan 002, vertical blanking goto scan_vsynch_off ; scan 003, switch off VSynch goto scan_blanking ; scan 004, vertical blanking goto scan_blanking ; scan 005, vertical blanking goto scan_blanking ; scan 006, vertical blanking goto scan_blanking ; scan 007, vertical blanking goto scan_blanking ; scan 008, vertical blanking goto scan_blanking ; scan 009, vertical blanking goto scan_blanking ; scan 010, vertical blanking goto scan_blanking ; scan 011, vertical blanking goto scan_blanking ; scan 012, vertical blanking goto scan_blanking ; scan 013, vertical blanking goto scan_blanking ; scan 014, vertical blanking goto scan_blanking ; scan 015, vertical blanking goto scan_blanking ; scan 016, vertical blanking goto scan_blanking ; scan 017, vertical blanking goto scan_blanking ; scan 018, vertical blanking goto scan_blanking ; scan 019, vertical blanking goto scan_blanking ; scan 020, vertical blanking goto scan_blanking ; scan 021, vertical blanking goto scan_blanking ; scan 022, vertical blanking goto scan_blanking ; scan 023, vertical blanking goto scan_blanking ; scan 024, vertical blanking goto scan_blanking ; scan 025, vertical blanking goto scan_blanking ; scan 026, vertical blanking goto scan_blanking ; scan 027, vertical blanking goto scan_blanking ; scan 028, vertical blanking goto scan_blanking ; scan 029, vertical blanking goto scan_blanking ; scan 030, vertical blanking goto scan_blanking ; scan 031, vertical blanking goto scan_blanking ; scan 032, vertical blanking goto scan_blanking ; scan 033, vertical blanking goto scan_blanking ; scan 034, vertical blanking goto scan_blanking ; scan 035, vertical blanking goto scan_blanking ; scan 036, vertical blanking goto scan_blanking ; scan 037, vertical blanking goto scan_blanking ; scan 038, vertical blanking goto scan_blanking ; scan 039, vertical blanking goto scan_blanking ; scan 040, vertical blanking goto scan_blanking ; scan 041, vertical blanking goto scan_blanking ; scan 042, vertical blanking goto scan_blanking ; scan 043, vertical blanking goto scan_blanking ; scan 044, vertical blanking goto scan_blanking ; scan 045, vertical blanking goto scan_blanking ; scan 046, vertical blanking goto scan_blanking ; scan 047, vertical blanking goto scan_blanking ; scan 048, vertical blanking goto scan_blanking ; scan 049, vertical blanking goto scan_blanking ; scan 050, vertical blanking goto scan_blanking ; scan 051, vertical blanking goto scan_blanking ; scan 052, vertical blanking goto scan_blanking ; scan 053, vertical blanking goto scan_blanking ; scan 054, vertical blanking goto scan_blanking ; scan 055, vertical blanking goto scan_blanking ; scan 056, vertical blanking goto scan_blanking ; scan 057, vertical blanking goto scan_blanking ; scan 058, vertical blanking goto scan_blanking ; scan 059, vertical blanking goto scan_blanking ; scan 060, vertical blanking goto scan_blanking ; scan 061, vertical blanking goto scan_empty ; scan 062 (sl 000), empty line goto scan_empty ; scan 063 (sl 001), empty line goto scan_empty ; scan 064 (sl 002), empty line goto scan_empty ; scan 065 (sl 003), empty line goto scan_empty ; scan 066 (sl 004), empty line goto scan_empty ; scan 067 (sl 005), empty line goto scan_empty ; scan 068 (sl 006), empty line goto scan_empty ; scan 069 (sl 007), empty line goto scan_empty ; scan 070 (sl 008), empty line goto scan_empty ; scan 071 (sl 009), empty line goto scan_empty ; scan 072 (sl 010), empty line goto scan_empty ; scan 073 (sl 011), empty line goto scan_empty ; scan 074 (sl 012), empty line goto scan_empty ; scan 075 (sl 013), empty line goto scan_empty ; scan 076 (sl 014), empty line goto scan_empty ; scan 077 (sl 015), empty line goto scan_empty ; scan 078 (sl 016), empty line goto scan_empty ; scan 079 (sl 017), empty line goto scan_empty ; scan 080 (sl 018), empty line goto scan_empty ; scan 081 (sl 019), empty line goto scan_empty ; scan 082 (sl 020), empty line goto scan_empty ; scan 083 (sl 021), empty line goto scan_empty ; scan 084 (sl 022), empty line goto scan_hscalelong ; scan 085 (sl 023), h.scale long sep goto scan_hscalelong ; scan 086 (sl 024), h.scale long sep goto scan_hscalelong ; scan 087 (sl 025), h.scale long sep goto scan_hscalelong ; scan 088 (sl 026), h.scale long sep goto scan_hscalelong ; scan 089 (sl 027), h.scale long sep goto scan_hscalelong ; scan 090 (sl 028), h.scale long sep goto scan_hscalelong ; scan 091 (sl 029), h.scale long sep goto scan_hscalelong ; scan 092 (sl 030), h.scale long sep goto scan_hscaleshort ; scan 093 (sl 031), h.scale short sep goto scan_hscaleshort ; scan 094 (sl 032), h.scale short sep goto scan_hscaleshort ; scan 095 (sl 033), h.scale short sep goto scan_hscaleshort ; scan 096 (sl 034), h.scale short sep goto scan_hscaleshort ; scan 097 (sl 035), h.scale short sep goto scan_hscaleshort ; scan 098 (sl 036), h.scale short sep goto scan_hscaleshort ; scan 099 (sl 037), h.scale short sep goto scan_empty ; scan 100 (sl 038), empty line goto scan_empty ; scan 101 (sl 039), empty line goto scan_empty ; scan 102 (sl 040), empty line goto scan_hscaleline ; scan 103 (sl 041), h. plain line goto scan_sepline ; scan 104 (sl 042), frequencies sep. goto scan_freqline ; scan 105 (sl 043), freq 001 goto scan_sepline ; scan 106 (sl 044), frequencies sep. goto scan_freqline ; scan 107 (sl 045), freq 002 goto scan_sepline ; scan 108 (sl 046), frequencies sep. goto scan_freqline ; scan 109 (sl 047), freq 003 goto scan_sepline ; scan 110 (sl 048), frequencies sep. goto scan_freqline ; scan 111 (sl 049), freq 004 goto scan_sepline ; scan 112 (sl 050), frequencies sep. goto scan_freqline ; scan 113 (sl 051), freq 005 goto scan_sepline ; scan 114 (sl 052), frequencies sep. goto scan_freqline ; scan 115 (sl 053), freq 006 goto scan_sepline ; scan 116 (sl 054), frequencies sep. goto scan_freqline ; scan 117 (sl 055), freq 007 goto scan_sepline ; scan 118 (sl 056), frequencies sep. goto scan_freqline ; scan 119 (sl 057), freq 008 goto scan_sepline ; scan 120 (sl 058), frequencies sep. goto scan_freqline ; scan 121 (sl 059), freq 009 goto scan_sepline ; scan 122 (sl 060), frequencies sep. goto scan_freqline ; scan 123 (sl 061), freq 010 goto scan_sepline ; scan 124 (sl 062), frequencies sep. goto scan_freqline ; scan 125 (sl 063), freq 011 goto scan_sepline ; scan 126 (sl 064), frequencies sep. goto scan_freqline ; scan 127 (sl 065), freq 012 goto scan_sepline ; scan 128 (sl 066), frequencies sep. goto scan_freqline ; scan 129 (sl 067), freq 013 goto scan_sepline ; scan 130 (sl 068), frequencies sep. goto scan_freqline ; scan 131 (sl 069), freq 014 goto scan_sepline ; scan 132 (sl 070), frequencies sep. goto scan_freqline ; scan 133 (sl 071), freq 015 goto scan_sepline ; scan 134 (sl 072), frequencies sep. goto scan_freqline ; scan 135 (sl 073), freq 016 goto scan_vscaleshort ; scan 136 (sl 074), v.scale short s. goto scan_freqline ; scan 137 (sl 075), freq 017 goto scan_sepline ; scan 138 (sl 076), frequencies sep. goto scan_freqline ; scan 139 (sl 077), freq 018 goto scan_sepline ; scan 140 (sl 078), frequencies sep. goto scan_freqline ; scan 141 (sl 079), freq 019 goto scan_sepline ; scan 142 (sl 080), frequencies sep. goto scan_freqline ; scan 143 (sl 081), freq 020 goto scan_sepline ; scan 144 (sl 082), frequencies sep. goto scan_freqline ; scan 145 (sl 083), freq 021 goto scan_sepline ; scan 146 (sl 084), frequencies sep. goto scan_freqline ; scan 147 (sl 085), freq 022 goto scan_sepline ; scan 148 (sl 086), frequencies sep. goto scan_freqline ; scan 149 (sl 087), freq 023 goto scan_sepline ; scan 150 (sl 088), frequencies sep. goto scan_freqline ; scan 151 (sl 089), freq 024 goto scan_sepline ; scan 152 (sl 090), frequencies sep. goto scan_freqline ; scan 153 (sl 091), freq 025 goto scan_sepline ; scan 154 (sl 092), frequencies sep. goto scan_freqline ; scan 155 (sl 093), freq 026 goto scan_sepline ; scan 156 (sl 094), frequencies sep. goto scan_freqline ; scan 157 (sl 095), freq 027 goto scan_sepline ; scan 158 (sl 096), frequencies sep. goto scan_freqline ; scan 159 (sl 097), freq 028 goto scan_sepline ; scan 160 (sl 098), frequencies sep. goto scan_freqline ; scan 161 (sl 099), freq 029 goto scan_sepline ; scan 162 (sl 100), frequencies sep. goto scan_freqline ; scan 163 (sl 101), freq 030 goto scan_sepline ; scan 164 (sl 102), frequencies sep. goto scan_freqline ; scan 165 (sl 103), freq 031 goto scan_sepline ; scan 166 (sl 104), frequencies sep. goto scan_freqline ; scan 167 (sl 105), freq 032 goto scan_vscaleshort ; scan 168 (sl 106), v.scale short s. goto scan_freqline ; scan 169 (sl 107), freq 033 goto scan_sepline ; scan 170 (sl 108), frequencies sep. goto scan_freqline ; scan 171 (sl 109), freq 034 goto scan_sepline ; scan 172 (sl 110), frequencies sep. goto scan_freqline ; scan 173 (sl 111), freq 035 goto scan_sepline ; scan 174 (sl 112), frequencies sep. goto scan_freqline ; scan 175 (sl 113), freq 036 goto scan_sepline ; scan 176 (sl 114), frequencies sep. goto scan_freqline ; scan 177 (sl 115), freq 037 goto scan_sepline ; scan 178 (sl 116), frequencies sep. goto scan_freqline ; scan 179 (sl 117), freq 038 goto scan_sepline ; scan 180 (sl 118), frequencies sep. goto scan_freqline ; scan 181 (sl 119), freq 039 goto scan_sepline ; scan 182 (sl 120), frequencies sep. goto scan_freqline ; scan 183 (sl 121), freq 040 goto scan_sepline ; scan 184 (sl 122), frequencies sep. goto scan_freqline ; scan 185 (sl 123), freq 041 goto scan_sepline ; scan 186 (sl 124), frequencies sep. goto scan_freqline ; scan 187 (sl 125), freq 042 goto scan_sepline ; scan 188 (sl 126), frequencies sep. goto scan_freqline ; scan 189 (sl 127), freq 043 goto scan_sepline ; scan 190 (sl 128), frequencies sep. goto scan_freqline ; scan 191 (sl 129), freq 044 goto scan_sepline ; scan 192 (sl 130), frequencies sep. goto scan_freqline ; scan 193 (sl 131), freq 045 goto scan_sepline ; scan 194 (sl 132), frequencies sep. goto scan_freqline ; scan 195 (sl 133), freq 046 goto scan_sepline ; scan 196 (sl 134), frequencies sep. goto scan_freqline ; scan 197 (sl 135), freq 047 goto scan_sepline ; scan 198 (sl 136), frequencies sep. goto scan_freqline ; scan 199 (sl 137), freq 048 goto scan_vscaleshort ; scan 200 (sl 138), v.scale short s. goto scan_freqline ; scan 201 (sl 139), freq 049 goto scan_sepline ; scan 202 (sl 140), frequencies sep. goto scan_freqline ; scan 203 (sl 141), freq 050 goto scan_sepline ; scan 204 (sl 142), frequencies sep. goto scan_freqline ; scan 205 (sl 143), freq 051 goto scan_sepline ; scan 206 (sl 144), frequencies sep. goto scan_freqline ; scan 207 (sl 145), freq 052 goto scan_sepline ; scan 208 (sl 146), frequencies sep. goto scan_freqline ; scan 209 (sl 147), freq 053 goto scan_sepline ; scan 210 (sl 148), frequencies sep. goto scan_freqline ; scan 211 (sl 149), freq 054 goto scan_sepline ; scan 212 (sl 150), frequencies sep. goto scan_freqline ; scan 213 (sl 151), freq 055 goto scan_sepline ; scan 214 (sl 152), frequencies sep. goto scan_freqline ; scan 215 (sl 153), freq 056 goto scan_sepline ; scan 216 (sl 154), frequencies sep. goto scan_freqline ; scan 217 (sl 155), freq 057 goto scan_sepline ; scan 218 (sl 156), frequencies sep. goto scan_freqline ; scan 219 (sl 157), freq 058 goto scan_sepline ; scan 220 (sl 158), frequencies sep. goto scan_freqline ; scan 221 (sl 159), freq 059 goto scan_sepline ; scan 222 (sl 160), frequencies sep. goto scan_freqline ; scan 223 (sl 161), freq 060 goto scan_sepline ; scan 224 (sl 162), frequencies sep. goto scan_freqline ; scan 225 (sl 163), freq 061 goto scan_sepline ; scan 226 (sl 164), frequencies sep. goto scan_freqline ; scan 227 (sl 165), freq 062 goto scan_sepline ; scan 228 (sl 166), frequencies sep. goto scan_freqline ; scan 229 (sl 167), freq 063 goto scan_sepline ; scan 230 (sl 168), frequencies sep. goto scan_freqline ; scan 231 (sl 169), freq 064 goto scan_vscaleshort ; scan 232 (sl 170), v.scale short s. goto scan_freqline ; scan 233 (sl 171), freq 065 goto scan_sepline ; scan 234 (sl 172), frequencies sep. goto scan_freqline ; scan 235 (sl 173), freq 066 goto scan_sepline ; scan 236 (sl 174), frequencies sep. goto scan_freqline ; scan 237 (sl 175), freq 067 goto scan_sepline ; scan 238 (sl 176), frequencies sep. goto scan_freqline ; scan 239 (sl 177), freq 068 goto scan_sepline ; scan 240 (sl 178), frequencies sep. goto scan_freqline ; scan 241 (sl 179), freq 069 goto scan_sepline ; scan 242 (sl 180), frequencies sep. goto scan_freqline ; scan 243 (sl 181), freq 070 goto scan_sepline ; scan 244 (sl 182), frequencies sep. goto scan_freqline ; scan 245 (sl 183), freq 071 goto scan_sepline ; scan 246 (sl 184), frequencies sep. goto scan_freqline ; scan 247 (sl 185), freq 072 goto scan_sepline ; scan 248 (sl 186), frequencies sep. goto scan_freqline ; scan 249 (sl 187), freq 073 goto scan_sepline ; scan 250 (sl 188), frequencies sep. goto scan_freqline ; scan 251 (sl 189), freq 074 goto scan_sepline ; scan 252 (sl 190), frequencies sep. goto scan_freqline ; scan 253 (sl 191), freq 075 goto scan_sepline ; scan 254 (sl 192), frequencies sep. goto scan_freqline ; scan 255 (sl 193), freq 076 goto scan_sepline ; scan 256 (sl 194), frequencies sep. goto scan_freqline ; scan 257 (sl 195), freq 077 goto scan_sepline ; scan 258 (sl 196), frequencies sep. goto scan_freqline ; scan 259 (sl 197), freq 078 goto scan_sepline ; scan 260 (sl 198), frequencies sep. goto scan_freqline ; scan 261 (sl 199), freq 079 goto scan_sepline ; scan 262 (sl 200), frequencies sep. goto scan_freqline ; scan 263 (sl 201), freq 080 goto scan_vscalelong ; scan 264 (sl 202), v.scale long s. goto scan_freqline ; scan 265 (sl 203), freq 081 goto scan_sepline ; scan 266 (sl 204), frequencies sep. goto scan_freqline ; scan 267 (sl 205), freq 082 goto scan_sepline ; scan 268 (sl 206), frequencies sep. goto scan_freqline ; scan 269 (sl 207), freq 083 goto scan_sepline ; scan 270 (sl 208), frequencies sep. goto scan_freqline ; scan 271 (sl 209), freq 084 goto scan_sepline ; scan 272 (sl 210), frequencies sep. goto scan_freqline ; scan 273 (sl 211), freq 085 goto scan_sepline ; scan 274 (sl 212), frequencies sep. goto scan_freqline ; scan 275 (sl 213), freq 086 goto scan_sepline ; scan 276 (sl 214), frequencies sep. goto scan_freqline ; scan 277 (sl 215), freq 087 goto scan_sepline ; scan 278 (sl 216), frequencies sep. goto scan_freqline ; scan 279 (sl 217), freq 088 goto scan_sepline ; scan 280 (sl 218), frequencies sep. goto scan_freqline ; scan 281 (sl 219), freq 089 goto scan_sepline ; scan 282 (sl 220), frequencies sep. goto scan_freqline ; scan 283 (sl 221), freq 090 goto scan_sepline ; scan 284 (sl 222), frequencies sep. goto scan_freqline ; scan 285 (sl 223), freq 091 goto scan_sepline ; scan 286 (sl 224), frequencies sep. goto scan_freqline ; scan 287 (sl 225), freq 092 goto scan_sepline ; scan 288 (sl 226), frequencies sep. goto scan_freqline ; scan 289 (sl 227), freq 093 goto scan_sepline ; scan 290 (sl 228), frequencies sep. goto scan_freqline ; scan 291 (sl 229), freq 094 goto scan_sepline ; scan 292 (sl 230), frequencies sep. goto scan_freqline ; scan 293 (sl 231), freq 095 goto scan_sepline ; scan 294 (sl 232), frequencies sep. goto scan_freqline ; scan 295 (sl 233), freq 096 goto scan_vscaleshort ; scan 296 (sl 234), v.scale short s. goto scan_freqline ; scan 297 (sl 235), freq 097 goto scan_sepline ; scan 298 (sl 236), frequencies sep. goto scan_freqline ; scan 299 (sl 237), freq 098 goto scan_sepline ; scan 300 (sl 238), frequencies sep. goto scan_freqline ; scan 301 (sl 239), freq 099 goto scan_sepline ; scan 302 (sl 240), frequencies sep. goto scan_freqline ; scan 303 (sl 241), freq 100 goto scan_sepline ; scan 304 (sl 242), frequencies sep. goto scan_freqline ; scan 305 (sl 243), freq 101 goto scan_sepline ; scan 306 (sl 244), frequencies sep. goto scan_freqline ; scan 307 (sl 245), freq 102 goto scan_sepline ; scan 308 (sl 246), frequencies sep. goto scan_freqline ; scan 309 (sl 247), freq 103 goto scan_sepline ; scan 310 (sl 248), frequencies sep. goto scan_freqline ; scan 311 (sl 249), freq 104 goto scan_sepline ; scan 312 (sl 250), frequencies sep. goto scan_freqline ; scan 313 (sl 251), freq 105 goto scan_sepline ; scan 314 (sl 252), frequencies sep. goto scan_freqline ; scan 315 (sl 253), freq 106 goto scan_sepline ; scan 316 (sl 254), frequencies sep. goto scan_freqline ; scan 317 (sl 255), freq 107 goto scan_sepline ; scan 318 (sl 256), frequencies sep. goto scan_freqline ; scan 319 (sl 257), freq 108 goto scan_sepline ; scan 320 (sl 258), frequencies sep. goto scan_freqline ; scan 321 (sl 259), freq 109 goto scan_sepline ; scan 322 (sl 260), frequencies sep. goto scan_freqline ; scan 323 (sl 261), freq 110 goto scan_sepline ; scan 324 (sl 262), frequencies sep. goto scan_freqline ; scan 325 (sl 263), freq 111 goto scan_sepline ; scan 326 (sl 264), frequencies sep. goto scan_freqline ; scan 327 (sl 265), freq 112 goto scan_vscaleshort ; scan 328 (sl 266), v.scale short s. goto scan_freqline ; scan 329 (sl 267), freq 113 goto scan_sepline ; scan 330 (sl 268), frequencies sep. goto scan_freqline ; scan 331 (sl 269), freq 114 goto scan_sepline ; scan 332 (sl 270), frequencies sep. goto scan_freqline ; scan 333 (sl 271), freq 115 goto scan_sepline ; scan 334 (sl 272), frequencies sep. goto scan_freqline ; scan 335 (sl 273), freq 116 goto scan_sepline ; scan 336 (sl 274), frequencies sep. goto scan_freqline ; scan 337 (sl 275), freq 117 goto scan_sepline ; scan 338 (sl 276), frequencies sep. goto scan_freqline ; scan 339 (sl 277), freq 118 goto scan_sepline ; scan 340 (sl 278), frequencies sep. goto scan_freqline ; scan 341 (sl 279), freq 119 goto scan_sepline ; scan 342 (sl 280), frequencies sep. goto scan_freqline ; scan 343 (sl 281), freq 120 goto scan_sepline ; scan 344 (sl 282), frequencies sep. goto scan_freqline ; scan 345 (sl 283), freq 121 goto scan_sepline ; scan 346 (sl 284), frequencies sep. goto scan_freqline ; scan 347 (sl 285), freq 122 goto scan_sepline ; scan 348 (sl 286), frequencies sep. goto scan_freqline ; scan 349 (sl 287), freq 123 goto scan_sepline ; scan 350 (sl 288), frequencies sep. goto scan_freqline ; scan 351 (sl 289), freq 124 goto scan_sepline ; scan 352 (sl 290), frequencies sep. goto scan_freqline ; scan 353 (sl 291), freq 125 goto scan_sepline ; scan 354 (sl 292), frequencies sep. goto scan_freqline ; scan 355 (sl 293), freq 126 goto scan_sepline ; scan 356 (sl 294), frequencies sep. goto scan_freqline ; scan 357 (sl 295), freq 127 goto scan_sepline ; scan 358 (sl 296), frequencies sep. goto scan_empty ; scan 359 (sl 297), empty line goto scan_empty ; scan 360 (sl 298), empty line goto scan_empty ; scan 361 (sl 299), empty line goto scan_empty ; scan 362 (sl 300), empty line goto scan_empty ; scan 363 (sl 301), empty line goto scan_empty ; scan 364 (sl 302), empty line goto scan_empty ; scan 365 (sl 303), empty line goto scan_empty ; scan 366 (sl 304), empty line goto scan_empty ; scan 367 (sl 305), empty line goto scan_empty ; scan 368 (sl 306), empty line goto scan_empty ; scan 369 (sl 307), empty line goto scan_empty ; scan 370 (sl 308), empty line goto scan_empty ; scan 371 (sl 309), empty line goto scan_empty ; scan 372 (sl 310), empty line goto scan_empty ; scan 373 (sl 311), empty line goto scan_empty ; scan 374 (sl 312), empty line goto scan_empty ; scan 375 (sl 313), empty line goto scan_empty ; scan 376 (sl 314), empty line goto scan_empty ; scan 377 (sl 315), empty line goto scan_empty ; scan 378 (sl 316), empty line goto scan_empty ; scan 379 (sl 317), empty line goto scan_empty ; scan 380 (sl 318), empty line goto scan_empty ; scan 381 (sl 319), empty line goto scan_empty ; scan 382 (sl 320), empty line goto scan_empty ; scan 383 (sl 321), empty line goto scan_empty ; scan 384 (sl 322), empty line goto scan_empty ; scan 385 (sl 323), empty line goto scan_empty ; scan 386 (sl 324), empty line goto scan_titlempty ; scan 387 (sl 325), empty title goto scan_titlempty ; scan 388 (sl 326), empty title goto scan_titlempty ; scan 389 (sl 327), empty title goto scan_titlempty ; scan 390 (sl 328), empty title goto scan_titlempty ; scan 391 (sl 329), empty title goto scan_titlempty ; scan 392 (sl 330), empty title goto scan_title0 ; scan 393 (sl 331), title line 0 goto scan_title0 ; scan 394 (sl 332), title line 0 goto scan_title1 ; scan 395 (sl 333), title line 1 goto scan_title1 ; scan 396 (sl 334), title line 1 goto scan_title2 ; scan 397 (sl 335), title line 2 goto scan_title2 ; scan 398 (sl 336), title line 2 goto scan_title3 ; scan 399 (sl 337), title line 3 goto scan_title3 ; scan 400 (sl 338), title line 3 goto scan_title4 ; scan 401 (sl 339), title line 4 goto scan_title4 ; scan 402 (sl 340), title line 4 goto scan_title5 ; scan 403 (sl 341), title line 5 goto scan_title5 ; scan 404 (sl 342), title line 5 goto scan_title6 ; scan 405 (sl 343), title line 6 goto scan_title6 ; scan 406 (sl 344), title line 6 goto scan_titlempty ; scan 407 (sl 345), empty title goto scan_titlempty ; scan 408 (sl 346), empty title goto scan_titlempty ; scan 409 (sl 347), empty title goto scan_titlempty ; scan 410 (sl 348), empty title goto scan_titlempty ; scan 411 (sl 349), empty title goto scan_blanking ; scan 412, vertical blanking goto scan_blanking ; scan 413, vertical blanking goto scan_blanking ; scan 414, vertical blanking goto scan_blanking ; scan 415, vertical blanking goto scan_blanking ; scan 416, vertical blanking goto scan_blanking ; scan 417, vertical blanking goto scan_blanking ; scan 418, vertical blanking goto scan_blanking ; scan 419, vertical blanking goto scan_blanking ; scan 420, vertical blanking goto scan_blanking ; scan 421, vertical blanking goto scan_blanking ; scan 422, vertical blanking goto scan_blanking ; scan 423, vertical blanking goto scan_blanking ; scan 424, vertical blanking goto scan_blanking ; scan 425, vertical blanking goto scan_blanking ; scan 426, vertical blanking goto scan_blanking ; scan 427, vertical blanking goto scan_blanking ; scan 428, vertical blanking goto scan_blanking ; scan 429, vertical blanking goto scan_blanking ; scan 430, vertical blanking goto scan_blanking ; scan 431, vertical blanking goto scan_blanking ; scan 432, vertical blanking goto scan_blanking ; scan 433, vertical blanking goto scan_blanking ; scan 434, vertical blanking goto scan_blanking ; scan 435, vertical blanking goto scan_blanking ; scan 436, vertical blanking goto scan_blanking ; scan 437, vertical blanking goto scan_blanking ; scan 438, vertical blanking goto scan_blanking ; scan 439, vertical blanking goto scan_blanking ; scan 440, vertical blanking goto scan_blanking ; scan 441, vertical blanking goto scan_blanking ; scan 442, vertical blanking goto scan_blanking ; scan 443, vertical blanking goto scan_blanking ; scan 444, vertical blanking goto scan_blanking ; scan 445, vertical blanking goto scan_blanking ; scan 446, vertical blanking goto scan_blanking ; scan 447, vertical blanking goto scan_blanking ; scan 448, vertical blanking goto scan_rstscanl ; scan 449, reset scan_line ;---------------------------------------------------------------------------- ; Soft generation of a vertical blanking line ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_blanking goto resume_irq ; Nothing to do as video already off ! ;---------------------------------------------------------------------------- ; Soft generation of a vertical blanking line with switch on of Vsynch ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_vsynch_on movlb 1 bcf PORTC,6 ; RC6=0 (Vsynch active) incf frame_num,F ; increment frame number goto resume_irq ;---------------------------------------------------------------------------- ; Soft generation of a vertical blanking line with switch off of Vsynch ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_vsynch_off movlb 1 bsf PORTC,6 ; RC6=1 (Vsynch inactive) goto resume_irq ;---------------------------------------------------------------------------- ; Soft generation of a blank screen line (background color) ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_empty movlb 0 movlw BKG_COLOR movwf PORTB ; set background color goto resume_irq ;---------------------------------------------------------------------------- ; Soft generation of a frequency line ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_freqline movlb 0 movlw BKG_COLOR movwf PORTB ; set background color movlw D'103' ; calculate frequency number subwf scan_line+1,W ; (=(scan_line-103)/2) movwf tmpi bcf ALUSTA,C rrcf tmpi,W dispbufrd ; read display buffer value (8 cycles) andlw B'01111111' ; be sure it is <128 movwf tmpi ; and store it in tmpi sublw low endfreqline ; calculate jump address movwf tmpi2+1 ; (endfreqline-freq value) movlw high endfreqline ; store msb in PCLATH and lsb in tmpi2+1 movwf tmpi2 clrf WREG,W subwfb tmpi2,F movfp tmpi2,PCLATH movlw BKG_COLOR movwf tmpcolor movlw SLINE_COLOR movwf PORTB ; draw vertical line movfp tmpcolor,PORTB ; and return to background color clrf WREG,W cpfsgt tmpi ; if value 0 goto resume_irq ; return movlw FREQ_COLOR ; else movwf PORTB ; draw frequency line movfp tmpi2+1,PCL ; and jump to precalculated address nop nop start_wait128 nop nop ; 128 nop's nop ; in order to have a cycle per cycle nop ; delay, a jump is done to the nop ; precalculated nop in this list ! nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop endfreqline movlw BKG_COLOR movwf PORTB ; and return to background color goto resume_irq ;---------------------------------------------------------------------------- ; Soft generation of a separating line between 2 frequency lines ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_sepline movlb 0 movlw BKG_COLOR movwf PORTB ; set background color nop nop nop ; serie of nop's in order to nop ; be sure that the vertical nop ; line will be aligned with ; the one for frequency lines ! nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop movlw BKG_COLOR movwf tmpcolor movlw SLINE_COLOR movwf PORTB ; draw vertical line movfp tmpcolor,PORTB ; and return to background color goto resume_irq ;---------------------------------------------------------------------------- ; Soft generation of a separating line with a "short" scale indicator ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_vscaleshort movlb 0 movlw BKG_COLOR movwf PORTB ; set background color nop nop nop ; serie of nop's in order to nop ; be sure that the vertical nop ; line will be aligned with ; the one for frequency lines ! nop nop nop nop nop nop nop nop nop nop nop nop nop movlw SHORTS_COLOR movwf PORTB ; draw the small indicator nop movlw BKG_COLOR movwf tmpcolor movwf PORTB ; return to background color movlw SLINE_COLOR movwf PORTB ; draw vertical line movfp tmpcolor,PORTB ; and return to background color goto resume_irq ;---------------------------------------------------------------------------- ; Soft generation of a separating line with a "long" scale indicator ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_vscalelong movlb 0 movlw BKG_COLOR movwf PORTB ; set background color nop nop nop ; serie of nop's in order to nop ; be sure that the vertical nop ; line will be aligned with ; the one for frequency lines ! nop nop nop nop nop nop nop nop nop nop nop movlw LONGS_COLOR movwf PORTB ; draw the long indicator nop nop nop movlw BKG_COLOR movwf tmpcolor movwf PORTB ; return to background color movlw SLINE_COLOR movwf PORTB ; draw vertical line movfp tmpcolor,PORTB ; and return to background color goto resume_irq ;---------------------------------------------------------------------------- ; Soft generation of the horizontal scale "long" steps ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_hscalelong movlb 0 movlw BKG_COLOR movwf PORTB ; set background color movwf tmpi2 ; save color for background movlw LONGS_COLOR movwf tmpi ; save color for long steps drawing movlw BKG_COLOR movwf tmpi+1 ; save color for short steps drawing movlb 0 btfsc PORTB,7 ; log mode ? goto scale_lin_m ; if not, draw lin scale goto scale_log_m ; else draw log scale scale_lin_m nop ; time correction for btfsc scale_lin_m2 nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop movfp tmpi,PORTB ;col 0 -> long movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 10 movfp tmpi2,PORTB movfp tmpi+1,PORTB ;-> short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col20 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col30 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 40 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 50 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi,PORTB ;col 60->long movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 70 movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 80 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 90 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 100 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 110 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi,PORTB ;col 120->long movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 127 goto resume_irq scale_log_m nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop movfp tmpi,PORTB ;col 0->long movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 10 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col20 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB ;col30 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi,PORTB ;col 40->long movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 50 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 60 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 70 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi,PORTB ;col 80->long movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 90 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 100 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 110 movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi+1,PORTB ;->short movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi,PORTB ;col 120->long movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB movfp tmpi2,PORTB ;col 127 goto resume_irq ;---------------------------------------------------------------------------- ; Soft generation of the horizontal scale "short" steps ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_hscaleshort movlb 0 movlw BKG_COLOR movwf PORTB ; set background color movwf tmpi2 ; save color for background movlw LONGS_COLOR movwf tmpi ; save color for long steps drawing movlw SHORTS_COLOR movwf tmpi+1 ; save color for short steps drawing movlb 0 btfsc PORTB,7 ; log mode ? goto scale_lin_m ; if not, draw lin scale goto scale_log_m ; else draw log scale ;---------------------------------------------------------------------------- ; Soft generation of the horizontal scale plain line ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_hscaleline movlb 0 movlw BKG_COLOR movwf PORTB ; set background color nop nop nop ; serie of nop's in order to nop ; be sure that the vertical nop ; line will be aligned with ; the one for frequency lines ! nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop movlw SLINE_COLOR movwf PORTB ; draw vertical line goto start_wait128 ; and wait for end of active line ;---------------------------------------------------------------------------- ; Soft generation of a blank screen line (background title color) ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_titlempty movlb 0 movlw BKGTITLE_COLOR movwf PORTB ; set background color goto resume_irq ;---------------------------------------------------------------------------- ; Soft generation of the title lines ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- ; Title content : ; * **** ***** *** * *** ***** ***** *** ***** **** * * * * * ; *** * * * * * * * * * * * * * * * * * * ** ** *** ; ***** * * * * * * * * * * * * * * * * * ***** ; ******* **** * * *** ***** *** * * **** * * * * ******* ; ********* * * * * * * * * * * * * * * ********* ; *********** * * * * * * * * * * * * * * * * * *********** ; ************* * ***** *** *** * ***** *** * * * *** * * ************* ; ; Hold sign content : ; ; * * * * ; * * * * ; * ***** * ; * * * * ; * * * * ; ; The following routines display each line of the previous strings, scan line ; per scan line. No other way to do cycle per cycle video generation (of course ; it's possible to implement a character set map, but not useful in this case) ; ; Of course the following routines where generated automaticaly ! (seems like a ; compiler job, no ?) ; Generation of title0 scan_title0 movlb 0 movlw BKGTITLE_COLOR movwf PORTB ;set background color movlw TITLE_COLOR ;store title color movwf tmpi+1 ;in tmpi+1 movlw BKGTITLE_COLOR ;and background color movwf tmpi ;in tmpi movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB ;reset to background color goto resume_irq ;and return ; Generation of title1 scan_title1 movlb 0 movlw BKGTITLE_COLOR movwf PORTB ;set background color movlw TITLE_COLOR ;store title color movwf tmpi+1 ;in tmpi+1 movlw BKGTITLE_COLOR ;and background color movwf tmpi ;in tmpi movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB ;reset to background color movlb 0 btfsc PORTB,6 ;mode hold ? goto resume_irq ;if not, return btfsc frame_num,5 ;blinking test goto resume_irq ;if off return movlw HOLD_COLOR ;store hold color movwf tmpi+1 ;in tmpi+1 movfp tmpi,PORTB ;and display "hold" sign movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB goto resume_irq ;and return ; Generation of title2 scan_title2 movlb 0 movlw BKGTITLE_COLOR movwf PORTB ;set background color movlw TITLE_COLOR ;store title color movwf tmpi+1 ;in tmpi+1 movlw BKGTITLE_COLOR ;and background color movwf tmpi ;in tmpi movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB ;reset to background color movlb 0 btfsc PORTB,6 ;mode hold ? goto resume_irq ;if not, return btfsc frame_num,5 ;blinking test goto resume_irq ;if off return movlw HOLD_COLOR ;store hold color movwf tmpi+1 ;in tmpi+1 movfp tmpi,PORTB ;and display "hold" sign movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB goto resume_irq ;and return ; Generation of title3 scan_title3 movlb 0 movlw BKGTITLE_COLOR movwf PORTB ;set background color movlw TITLE_COLOR ;store title color movwf tmpi+1 ;in tmpi+1 movlw BKGTITLE_COLOR ;and background color movwf tmpi ;in tmpi movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB ;reset to background color movlb 0 btfsc PORTB,6 ;mode hold ? goto resume_irq ;if not, return btfsc frame_num,5 ;blinking test goto resume_irq ;if off return movlw HOLD_COLOR ;store hold color movwf tmpi+1 ;in tmpi+1 movfp tmpi,PORTB ;and display "hold" sign movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi+1,PORTB movfp tmpi+1,PORTB movfp tmpi+1,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB goto resume_irq ;and return ; Generation of title4 scan_title4 movlb 0 movlw BKGTITLE_COLOR movwf PORTB ;set background color movlw TITLE_COLOR ;store title color movwf tmpi+1 ;in tmpi+1 movlw BKGTITLE_COLOR ;and background color movwf tmpi ;in tmpi movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB ;reset to background color movlb 0 btfsc PORTB,6 ;mode hold ? goto resume_irq ;if not, return btfsc frame_num,5 ;blinking test goto resume_irq ;if off return movlw HOLD_COLOR ;store hold color movwf tmpi+1 ;in tmpi+1 movfp tmpi,PORTB ;and display "hold" sign movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB goto resume_irq ;and return ; Generation of title5 scan_title5 movlb 0 movlw BKGTITLE_COLOR movwf PORTB ;set background color movlw TITLE_COLOR ;store title color movwf tmpi+1 ;in tmpi+1 movlw BKGTITLE_COLOR ;and background color movwf tmpi ;in tmpi movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB ;reset to background color movlb 0 btfsc PORTB,6 ;mode hold ? goto resume_irq ;if not, return btfsc frame_num,5 ;blinking test goto resume_irq ;if off return movlw HOLD_COLOR ;store hold color movwf tmpi+1 ;in tmpi+1 movfp tmpi,PORTB ;and display "hold" sign movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB movfp tmpi,PORTB movfp tmpi,PORTB goto resume_irq ;and return ; Generation of title6 scan_title6 movlb 0 movlw BKGTITLE_COLOR movwf PORTB ;set background color movlw TITLE_COLOR ;store title color movwf tmpi+1 ;in tmpi+1 movlw BKGTITLE_COLOR ;and background color movwf tmpi ;in tmpi movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi,PORTB movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi+1,PORTB ;Pixel on movfp tmpi,PORTB ;reset to background color goto resume_irq ;and return ;---------------------------------------------------------------------------- ; Soft generation of a vertical blanking line with scan_line reset ; ; Warning : all scan_X routines should execute in less than 169 instructions ;---------------------------------------------------------------------------- scan_rstscanl clrf scan_line,F ; reset scanline (will be incremented clrf scan_line+1,F ; to 1 at next interrupt) goto resume_irq ;============================================================================ ; - END OF FILE - ;============================================================================