Здравейте! Имам няколко стари разработки на програми за мониторинг на FM предаватели. Тези програми са правени за една фирма, отдавна престанала да произвежда предаватели, а и вече и тя не съществува. Самите предаватели (20-тина броя) най-вероятно са претопени като скрап. Тук ще ви представя една за мониторинг на 30W трансмитер (по-скоро възбудител за мощно стъпало), която чрез избор на оператора може да измерва и показва следните параметри: мощност (падаща и обратна) към антената (мощния усилвател), честота, напрежение и ток на изходното стъпало, аудио сигнала L и R. Индикацията е стандартен двуредов LCD индикатор (LCD MODULE VSTM-1602B например) като се използва четири шинно прехвърляне на данните. Честотата не се измерва, а се изчислява по позициите на задаващите суитчове в синтезатора (използван е фабричен италиански синтезатор). За измерване на сигналите P, U и I се използват аналоговите входове на PIC. Мощността се измерва като напрежителен сигнал от насочен отклонител (реализиран като пасивни линии около изходната писта на печатната платка и съответни товарни резистори и диоди). По интересна е визуализацията на аудио сигнала като бар ленти, работещи в реално време - точно както са в модерните аудиосистеми с LCD индикатори. Публикувам ASM файл с учебна цел, така, че и начинаещи да могат да го разберат и да ползват фрагменти, които им допадат за нови разработки. Всъщност, "стари" програми няма, има нови процесори, нови езици, но принципите на програмирането си остават същите. Разбира се, стилът на програмиране зависи от програмиста, но този, който сега се учи, е добре да се запознае с различни стилове за да "отбере" онова, което му допада най-много.
Тъй като едва ли някой ще повтори програмата едно към едно, не привеждам схемата (която не съм разработвал аз и безвъзвратно съм загубил, все пак това е от 2005г!)
Ако има интерес, мога да представя програма за мониторинг на 1KW мощен усилвател, съставен от две стъпала по 500W, като там се контролират двете стъпала поотделно, както и общите мощности, подавани към фидера.
Имам и програми за управление ва несложни машинарии (нарязващи, преси и др.). За тях има по-пълни описания със схеми. За съжаление, нито от предавателите, нито от машинариите има образци за демонстрации, тъй като всичко е заминало за скрап.
 | | |
| Код: include <p16f877.inc> ; ; ;TU30_217.asm ;EXPRESS ; ;Signal bits EN EQU 0 ; LCD Enable control line RW EQU 1 ; LCD Read/write control line RS EQU 2 ; LCD Register-Select control line EX EQU 4 ; External fault PK EQU 5 ; Offset 50KHz UL EQU 6 ; Unlock UP EQU 7 ; Key up ; ;Flags bits FK EQU 0 ; Key push FO EQU 1 ; Over message position FZ EQU 2 ; First zero ; ;Ports assigments LCD_PORT EQU PORTB ; LCD data&control lines interface EX_CON EQU PORTC ; FREQ_H EQU PORTC ; FREQ_L EQU PORTD ; ; ;Variables DELAY_1 EQU 0x20 ; DELAY_2 EQU 0x21 ; CHAR_F EQU 0x22 ; COMMAND_F EQU 0x23 ; H_BYTE EQU 0x24 ; High byte of the 16 bit result L_BYTE EQU 0x25 ; Low byte of the 16 bit result COUNT_B EQU 0x26 ; loop counter B R0 EQU 0x27 ; R1 EQU 0x28 ; RAM for output BCD R2 EQU 0x29 ; TEMP_F EQU 0x2A ; ACCaLO EQU 0x2B ; ACCaHI EQU 0x2C ; ACCbLO EQU 0x2D ; ACCbHI EQU 0x2E ; ACCcLO EQU 0x2F ; ACCcHI EQU 0x30 ; ACCdLO EQU 0x31 ; ACCdHI EQU 0x32 ; K_COUNT EQU 0x33 ; PAUSE_1 EQU 0x34 ; PAUSE_2 EQU 0x35 ; PAUSE_3 EQU 0x36 ; FLAGS EQU 0x37 ; POS EQU 0x38 ; DEV_BYTE EQU 0x39 ; COUNT_C EQU 0x3A ; COUNT_D EQU 0x3B ; MPY_F EQU 0x3C ; DEV_SKIP EQU 0x3D ; ; ;Constants DisplayON EQU 0x00C ; DdramADDR EQU 0x080 ; ; ; org 0 goto Start ; org 4 goto Start ; ; Start ; call INIT ; call ExtFault ; call Unlock ; main call Route ; goto main ; ; ; ;*******************************************************************************; ; ; - Used in LCDINIT subroutine ; - Required delay factor must be in W ;************************************ a 500uS delay @ 4MHz X-tal ; X500MKS MOVWF DELAY_2 ; DLOOPB MOVLW 0x0A5 ; MOVWF DELAY_1 ; DLOOPA DECFSZ DELAY_1,f ; GOTO DLOOPA ; DECFSZ DELAY_2,f ; GOTO DLOOPB ; RETURN ; ; INIT CALL PAUSE2S ; CALL SETLCD ; CALL LCDCLEAR ; BSF STATUS, RP0 ; Bank 1 BCF STATUS, RP1 ; MOVLW B'11111111' ; MOVWF PORTA ; inputs MOVWF PORTC ; inputs MOVWF PORTD ; inputs BCF STATUS, RP0 ; Bank 0 CLRF FLAGS ; call CountInit ; CALL ADCINIT ; RETURN ; ; ADCINIT BSF STATUS,RP0 ; MOVLW B'10000000' ; Result is right justified MOVWF ADCON0 ; select ch0-ch7 as analog inputs BCF STATUS,RP0 ; RETURN ; ; PAUSE05S MOVWF TEMP_F ; MOVLW 0x01 ; MOVWF PAUSE_3 ; LOOPP_3 MOVLW 0xFF ; MOVWF PAUSE_2 ; LOOPP_2 CLRWDT ; MOVLW 0xFF ; MOVWF PAUSE_1 ; LOOPP_1 DECFSZ PAUSE_1,f ; GOTO LOOPP_1 ; DECFSZ PAUSE_2,f ; GOTO LOOPP_2 ; DECFSZ PAUSE_3,f ; GOTO LOOPP_3 ; MOVF TEMP_F,w ; RETURN ; ; PAUSE2S MOVWF TEMP_F ; MOVLW 0x04 ; MOVWF PAUSE_3 ; LOOPP_6 MOVLW 0xFF ; MOVWF PAUSE_2 ; LOOPP_5 CLRWDT ; MOVLW 0xFF ; MOVWF PAUSE_1 ; LOOPP_4 DECFSZ PAUSE_1,f ; GOTO LOOPP_4 ; DECFSZ PAUSE_2,f ; GOTO LOOPP_5 ; DECFSZ PAUSE_3,f ; GOTO LOOPP_6 ; MOVF TEMP_F,w ; RETURN ; ; ; Test LCD busy flag (DB7 from HD44780) ; LCDBUSY BSF STATUS,RP0 ; Select Register page 1 MOVLW 0xF0 ; Set PORTB for input MOVWF LCD_PORT ; BCF STATUS,RP0 ; Select Register page 0 BCF LCD_PORT, RS ; Set LCD for command mode BSF LCD_PORT, RW ; Setup to read busy flag BSF LCD_PORT, EN ; LCD E-line High MOVF LCD_PORT, w ; Read busy flag + DDram address BCF LCD_PORT, EN ; LCD E-line Low ANDLW 0xF0 ; Check Busy flag, High = Busy MOVWF TEMP_F ; BSF LCD_PORT, EN ; LCD E-line High SWAPF LCD_PORT, w ; Read busy flag + DDram address BCF LCD_PORT, EN ; LCD E-line Low ANDLW 0x0F ; Check Busy flag, High = Busy IORWF TEMP_F, w ; ANDLW 0x80 ; BTFSS STATUS, Z ; GOTO LCDBUSY ; BCF LCD_PORT, RW ; BSF STATUS, RP0 ; Select Register page 1 CLRF LCD_PORT ; Set PORTB for output BCF STATUS, RP0 ; Select Register page 0 RETURN ; ; SETLCD BSF STATUS, RP0 ; Select Register BANK 1 BCF STATUS, RP1 ; CLRF LCD_PORT ; Set LCD_PORT as outputs BCF STATUS, RP0 ; Select Register BANK 0 CLRF LCD_PORT ; All LCD_PORT output should Low. ; CALL LCDINIT ; MOVLW 0x028 ; CALL LCDCMD ; MOVLW DisplayON ; CALL LCDCMD ; CALL LCDCLEAR ; MOVLW 0x02 ; CALL LCDEMODE ; MOVLW DdramADDR ; CALL LCDCMD ; RETURN ; ; ; - Send character to LCD ; - Required character must be in W ; LCDDATA MOVWF CHAR_F ; Save character from W in CHAR_F CALL LCDBUSY ; Wait for LCD to be ready MOVF CHAR_F,w ; Get character from CHAR_F ANDLW 0xF0 ; MOVWF LCD_PORT ; Send upper half-byte to LCD BSF LCD_PORT, RS ; Set LCD in data mode CALL LCDCLK ; SWAPF CHAR_F,w ; ANDLW 0xF0 ; MOVWF LCD_PORT ; Send lower half-byte to LCD BSF LCD_PORT, RS ; Set LCD in data mode CALL LCDCLK ; Send character to LCD BCF LCD_PORT, RS ; RETURN ; ; ; - Sends command to LCD ; - Required command must be in W ; LCDCMD MOVWF COMMAND_F ; Save command from W in COMMAND_F CALL LCDBUSY ; Wait for LCD to be ready MOVF COMMAND_F,w ; Get character/data from COMMAND_F ANDLW 0xF0 ; MOVWF LCD_PORT ; Send upper half-byte to LCD CALL LCDCLK ; SWAPF COMMAND_F,w ; ANDLW 0xF0 ; MOVWF LCD_PORT ; Send lower half-byte to LCD CALL LCDCLK ; Send character/data to LCD RETURN ; ; LCDCLK NOP ; BSF LCD_PORT, EN ; Set E-line High NOP ; BCF LCD_PORT, EN ; Set E-line Low NOP ; RETURN ; ; LCDINIT MOVLW D'30' ; Power-up delay CALL X500MKS ; 30 * 0.5 = 15mS MOVLW B'00110000' ; Set 8-bit interface MOVWF LCD_PORT ; CALL LCDCLK ; MOVLW D'10' ; CALL X500MKS ; 10 * 0.5 = 5mS CALL LCDCLK ; MOVLW D'1' ; CALL X500MKS ; 1 * 0.5 = 0.5mS CALL LCDCLK ; MOVLW B'00100000' ; Set 4-bit interface MOVWF LCD_PORT ; CALL LCDCLK ; RETURN ; ; LCDCLEAR MOVLW 0x001 ; CALL LCDCMD ; RETURN ; ; LCDHOME MOVLW 0x002 ; CALL LCDCMD ; RETURN ; ; ; - Set entry mode of the LCD ; - Required entry mode must be set in W ; b0 : 0 = no display shift, 1 = display shift ; b1 : 0 = auto-decrement, 1 = auto-increment ; b2 - b7 : don't care ; LCDEMODE ANDLW 0x003 ; Strip upper bits IORLW 0x004 ; Function set CALL LCDCMD ; RETURN ; ; ; - Set display control ; - Required entry mode must be set in W ; b0 : 0 = cursor blink off, 1 = cursor blink on ; b1 : 0 = cursor off, 1 = cursor on ; b2 - b7 : don't care ; LCDDMODE ANDLW 0x007 ; Strip upper bits IORLW 0x008 ; Function set CALL LCDCMD ; RETURN ; ; ; Set the Display-Data-RAM address. ; DDRAM data is read/written after this setting ; - Required entry mode must be set in W ; b0 - b6 : required DDRAM address ; b7 : don't care ; LCDSDDA IORLW 0x080 ; CALL LCDCMD ; RETURN ; ; ; Set the Character-Generator-RAM address. ; DDRAM data is read/written after this setting ; - Required entry mode must be set in W ; b0 - b5 : required CGRAM address ; b6 - b7 : don't care ; LCDSCGA ANDLW 0x03F ; IORLW 0x040 ; CALL LCDCMD ; RETURN ; ; GETVAL BCF STATUS,RP0 ; CLRF ADRESH ; clear result register ADRESH. BSF STATUS,RP0 ; CLRF ADRESH ; clear result register ADRESL. BCF STATUS,RP0 ; MOVLW D'20' ; CALL X500MKS ; setup time >= 10uS. BSF ADCON0,2 ; start new conversion loopE BTFSC ADCON0,2 ; a/d done? GOTO loopE ; no then keep checking GOTO READRES ; yes then update new value. ; READRES BSF STATUS,RP0 ; MOVF ADRESH,w ; get a/d value BCF STATUS,RP0 ; MOVWF L_BYTE ; MOVF ADRESH,w ; get a/d value MOVWF H_BYTE ; RETURN ; ; GETPO CALL GETVAL ; CALL CHCKOVRLD ; call Calc ; CALL B2BCD ; RETURN ; ; Calc movf H_BYTE,w ; movwf ACCbHI ; movf L_BYTE,w ; movwf ACCbLO ; clrf ACCaHI ; movlw D'150' ; movwf ACCaLO ; call D_add ; movf ACCbHI,w ; movwf ACCaHI ; movf ACCbLO,w ; movwf ACCaLO ; call D_mpy ; movf ACCbLO,w ; movwf ACCbHI ; movf ACCcHI,w ; movwf ACCbLO ; clrf ACCaHI ; movlw D'3' ; movwf ACCaLO ; call DIV ; movf ACCbLO,w ; movwf L_BYTE ; movf ACCbHI,w ; movwf H_BYTE ; call MPL2 ; movf H_BYTE,w ; iorlw 0x00 ; btfsc STATUS,Z ; call subcalc ; return ; ; subcalc movf L_BYTE,w ; sublw 0x63 ; btfsc STATUS,C ; call READRES ; return ; ; GETRF CALL GETVAL ; CALL CHCKOVRLD ; call Calc ; CALL B2BCD ; RETURN ; ; GETDV CALL GETVAL ; CALL CHCKOVRLD ; CALL B2BCD ; RETURN ; ; GETLC CALL GETVAL ; CALL CHCKOVRLD ; RETURN ; ; GETRC CALL GETVAL ; CALL CHCKOVRLD ; RETURN ; ; GETU1 CALL GETVAL ; CALL CHCKOVRLD ; call MPL2 ; CALL B2BCD ; RETURN ; ; GETU2 CALL GETVAL ; CALL CHCKOVRLD ; call MPL2 ; CALL B2BCD ; RETURN ; ; GETU3 CALL GETVAL ; CALL CHCKOVRLD ; call CalcU3 ; CALL B2BCD ; RETURN ; ; CalcU3 movf L_BYTE,w ; movwf ACCbLO ; movf H_BYTE,w ; movwf ACCbHI ; movlw .5 ; movwf ACCaLO ; clrf ACCaHI ; call D_mpy ; movf ACCcHI,w ; movwf H_BYTE ; movf ACCcLO,w ; movwf L_BYTE ; return ; ; GETFQ call ReadFQ ; movf R0,w ; iorlw 0x00 ; movlw 0x00 ; btfsc STATUS,Z ; movlw 0x10 ; addwf R0,f ; movlw 0x00 ; btfsc EX_CON,PK ; movlw 0x50 ; movwf R2 ; return ; ; ReadFQ movf FREQ_L,w ; movwf R1 ; movf FREQ_H,w ; andlw 0x0F ; movwf R0 ; return ; CHCKOVRLD BCF STATUS,Z ; MOVF L_BYTE,W ; SUBLW 0xFF ; BTFSC STATUS,Z ; GOTO CHK2 ; RETURN ; ; CHK2 BCF STATUS,Z ; MOVF H_BYTE,W ; SUBLW 0x03 ; BTFSC STATUS,Z ; GOTO OVRMESS ; RETURN ; ; OVRMESS MOVLW 0x00 ; btfss FLAGS,FO ; MOVLW 0x40 ; CALL LCDSDDA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 'O' ; CALL LCDDATA ; MOVLW 'U' ; CALL LCDDATA ; MOVLW 'T' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 'O' ; CALL LCDDATA ; MOVLW 'F' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 'R' ; CALL LCDDATA ; MOVLW 'A' ; CALL LCDDATA ; MOVLW 'N' ; CALL LCDDATA ; MOVLW 'G' ; CALL LCDDATA ; MOVLW 'E' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 0x00 ; btfss FLAGS,FO ; MOVLW 0x40 ; CALL LCDSDDA ; CALL PAUSE05S ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; CALL PAUSE05S ; goto Route ; ; B2BCD bcf STATUS,0 ; clear the carry bit movlw D'16' ; movwf COUNT_B ; clrf R0 ; clrf R1 ; clrf R2 ; loop16 rlf L_BYTE, F ; rlf H_BYTE, F ; rlf R2, F ; rlf R1, F ; rlf R0, F ; ; decfsz COUNT_B, F ; goto adjDEC ; RETURN ; ; adjDEC movlw R2 ; movwf FSR ; call adjBCD ; ; movlw R1 ; movwf FSR ; call adjBCD ; ; movlw R0 ; movwf FSR ; call adjBCD ; ; goto loop16 ; ; adjBCD movlw 3 ; addwf 0,W ; movwf TEMP_F ; btfsc TEMP_F,3 ; test if result > 7 movwf 0 ; movlw 30 ; addwf 0,W ; movwf TEMP_F ; btfsc TEMP_F,7 ; test if result > 7 movwf 0 ; save as MSD RETLW 0 ; ; LCDBCDH CLRF TEMP_F ; MOVWF TEMP_F ; SWAPF TEMP_F,w ; CALL LCDBCDL ; RETURN ; ; LCDBCDL ANDLW 0x0F ; ADDLW 0x30 ; RETURN ; ; DIV2 RRF H_BYTE,f ; RRF L_BYTE,f ; RETURN ; ; MPL2 RLF L_BYTE,f ; RLF H_BYTE,f ; RETURN ; ; ; DIV movlw D'16' ; for 16 shifts movwf TEMP_F ; movf ACCbHI,W ; move ACCb to ACCd movwf ACCdHI ; movf ACCbLO,W ; movwf ACCdLO ; clrf ACCbHI ; clrf ACCbLO ; clrf ACCcHI ; clrf ACCcLO ; ; dloop bcf STATUS,C ; rlf ACCdLO, F ; rlf ACCdHI, F ; rlf ACCcLO, F ; rlf ACCcHI, F ; movf ACCaHI,W ; subwf ACCcHI,W ; check if a>c btfss STATUS,Z ; goto nochk ; movf ACCaLO,W ; subwf ACCcLO,W ; if msb equal then check lsb nochk btfss STATUS,C ; carry set if c>a goto nogo ; movf ACCaLO,W ; c-a into c subwf ACCcLO, F ; btfss STATUS,C ; decf ACCcHI, F ; movf ACCaHI,W ; subwf ACCcHI, F ; bsf STATUS,C ; shift a 1 into b (result) nogo rlf ACCbLO, F ; rlf ACCbHI, F ; decfsz TEMP_F, F ; loop untill all bits checked goto dloop ; RETURN ; ; FIRSTZERO CLRF TEMP_F ; BSF FLAGS,FZ ; MOVWF TEMP_F ; ANDLW 0x0F ; BCF STATUS,Z ; IORLW 0x00 ; BTFSS STATUS,Z ; CALL PFZ ; RETURN ; ; PFZ MOVF TEMP_F,w ; CALL LCDDATA ; BCF FLAGS,FZ ; RETURN ; ; SECONDZERO CLRF TEMP_F ; MOVWF TEMP_F ; ANDLW 0x0F ; BCF STATUS,Z ; IORLW 0x00 ; BTFSC FLAGS,FZ ; BTFSS STATUS,Z ; CALL SCZ ; RETURN ; ; SCZ MOVF TEMP_F,w ; CALL LCDDATA ; RETURN ; ; Route movf K_COUNT,w ; sublw 0x00 ; btfsc STATUS,Z ; goto POUT ; movf K_COUNT,w ; sublw 0x01 ; btfsc STATUS,Z ; goto DEVIA ; movf K_COUNT,w ; sublw 0x02 ; btfsc STATUS,Z ; goto AUDIO ; movf K_COUNT,w ; sublw 0x03 ; btfsc STATUS,Z ; goto VOLT12 ; movf K_COUNT,w ; sublw 0x04 ; btfsc STATUS,Z ; goto VOLT3 ; movf K_COUNT,w ; sublw 0x05 ; btfsc STATUS,Z ; goto FREQ ; call CountInit ; return ; ; CountInit clrf K_COUNT ; return ; ; NEXT incf K_COUNT,f ; goto Route ; ; POUT call PrintP ; call DisplayP ; return ; ; DEVIA call PrintDV ; call DisplayDV ; return ; ; AUDIO call PrintAF ; call DisplayAF ; return ; ; VOLT12 call PrintU12 ; call DisplayU12 ; return ; ; VOLT3 call PrintU3 ; call DisplayU3 ; return ; ; FREQ call PrintFQ ; call DisplayFQ ; return ; ; DEBONCE movlw .20 ; call X500MKS ; btfss EX_CON,UP ; btfss FLAGS,FK ; retlw H'00' ; bcf FLAGS,FK ; retlw H'FF' ; ; Modul movwf POS ; btfsc POS,0 ; goto NEXT ; return ; ; ModulFQ movwf POS ; btfsc POS,0 ; goto Route ; return ; ; TKeyPO CLRWDT ; call ExtFault ; call Unlock ; btfsc EX_CON,UP ; goto ShutPO ; call DEBONCE ; call Modul ; goto DisplayP ; ; ShutPO bsf FLAGS,FK ; goto DisplayP ; ; TKeyDV CLRWDT ; call ExtFault ; call Unlock ; btfsc EX_CON,UP ; goto ShutDV ; call DEBONCE ; call Modul ; goto DisplayDV ; ; ShutDV bsf FLAGS,FK ; goto DisplayDV ; ; TKeyLC CLRWDT ; call ExtFault ; call Unlock ; btfsc EX_CON,UP ; goto ShutLC ; call DEBONCE ; call Modul ; goto DisplayAF ; ; ShutLC bsf FLAGS,FK ; goto DisplayAF ; ; TKeyRC CLRWDT ; call ExtFault ; call Unlock ; btfsc EX_CON,UP ; goto ShutRC ; call DEBONCE ; call Modul ; goto DisplayAF ; ; ShutRC bsf FLAGS,FK ; goto DisplayAF ; ; TKeyU1 CLRWDT ; call ExtFault ; call Unlock ; btfsc EX_CON,UP ; goto ShutU1 ; call DEBONCE ; call Modul ; goto DisplayU12 ; ; ShutU1 bsf FLAGS,FK ; goto DisplayU12 ; ; TKeyU2 CLRWDT ; call ExtFault ; call Unlock ; btfsc EX_CON,UP ; goto ShutU2 ; call DEBONCE ; call Modul ; goto DisplayU12 ; ; ShutU2 bsf FLAGS,FK ; goto DisplayU12 ; ; TKeyU3 CLRWDT ; call ExtFault ; call Unlock ; btfsc EX_CON,UP ; goto ShutU3 ; call DEBONCE ; call Modul ; goto DisplayU3 ; ; ShutU3 bsf FLAGS,FK ; goto DisplayU3 ; ; TKeyFQ CLRWDT ; call ExtFault ; call Unlock ; btfsc EX_CON,UP ; goto ShutFQ ; call DEBONCE ; call CountInit ; call ModulFQ ; goto DisplayFQ ; ; ShutFQ bsf FLAGS,FK ; goto DisplayFQ ; ; ExtFault btfsc EX_CON,EX ; goto ServEF ; return ; ; Unlock btfss EX_CON,UL ; call ServUL ; return ; ServEF call PrintEF ; call PAUSE05S ; btfsc EX_CON,EX ; goto ServEF ; call CountInit ; goto main ; ; ServUL call ExtFault ; call PrintUL ; call PAUSE05S ; btfss EX_CON,UL ; goto ServUL ; call StartFREQ ; call CountInit ; goto main ; ; PrintEF call LCDCLEAR ; movlw 0x01 ; CALL LCDSDDA ; movlw 'E' ; call LCDDATA ; movlw 'X' ; call LCDDATA ; movlw 'T' ; call LCDDATA ; movlw 'E' ; call LCDDATA ; movlw 'R' ; call LCDDATA ; movlw 'N' ; call LCDDATA ; movlw 'A' ; call LCDDATA ; movlw 'L' ; call LCDDATA ; movlw ' ' ; call LCDDATA ; movlw 'F' ; call LCDDATA ; movlw 'A' ; call LCDDATA ; movlw 'U' ; call LCDDATA ; movlw 'L' ; call LCDDATA ; movlw 'T' ; call LCDDATA ; movlw 0x43 ; CALL LCDSDDA ; movlw 'T' ; call LCDDATA ; movlw 'U' ; call LCDDATA ; movlw 'R' ; call LCDDATA ; movlw 'N' ; call LCDDATA ; movlw ' ' ; call LCDDATA ; movlw 'O' ; call LCDDATA ; movlw 'F' ; call LCDDATA ; movlw 'F' ; call LCDDATA ; movlw '!' ; call LCDDATA ; call PAUSE2S ; return ; PrintUL call LCDCLEAR ; movlw 0x02 ; CALL LCDSDDA ; movlw 'P' ; call LCDDATA ; movlw 'L' ; call LCDDATA ; movlw 'L' ; call LCDDATA ; movlw ' ' ; call LCDDATA ; movlw 'U' ; call LCDDATA ; movlw 'N' ; call LCDDATA ; movlw 'L' ; call LCDDATA ; movlw 'O' ; call LCDDATA ; movlw 'C' ; call LCDDATA ; movlw 'K' ; call LCDDATA ; movlw 'E' ; call LCDDATA ; movlw 'D' ; call LCDDATA ; movlw 0x42 ; CALL LCDSDDA ; movlw 'P' ; call LCDDATA ; movlw 'L' ; call LCDDATA ; movlw 'E' ; call LCDDATA ; movlw 'A' ; call LCDDATA ; movlw 'S' ; call LCDDATA ; movlw 'E' ; call LCDDATA ; movlw ' ' ; call LCDDATA ; movlw 'W' ; call LCDDATA ; movlw 'A' ; call LCDDATA ; movlw 'I' ; call LCDDATA ; movlw 'T' ; call LCDDATA ; movlw '!' ; call LCDDATA ; call PAUSE2S ; return ; PrintP CALL LCDCLEAR ; MOVLW 'P' ; CALL LCDDATA ; MOVLW 'o' ; CALL LCDDATA ; MOVLW 'u' ; CALL LCDDATA ; MOVLW 't' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW '=' ; CALL LCDDATA ; MOVLW ' ' ; movlw 0x40 ; CALL LCDSDDA ; MOVLW 'P' ; CALL LCDDATA ; MOVLW 'r' ; CALL LCDDATA ; MOVLW 'e' ; CALL LCDDATA ; MOVLW 'f' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW '=' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; RETURN ; ; DisplayP BCF STATUS,RP1 ; BCF STATUS,RP0 ; MOVLW B'10000001' ; RC, A/D is ON, Channel 1 is selected MOVWF ADCON0 ; BSF ADCON0, GO ; Start A/D convertion bsf FLAGS,FO ; movlw 0x07 ; CALL LCDSDDA ; CALL GETPO ; MOVF R0,w ; CALL LCDBCDL ; CALL FIRSTZERO ; MOVF R1,w ; CALL LCDBCDH ; CALL SECONDZERO ; MOVF R1,w ; CALL LCDBCDL ; CALL LCDDATA ; ; MOVLW '.' ; ; CALL LCDDATA ; ; MOVF R2,w ; ; CALL LCDBCDH ; ; CALL LCDDATA ; ; MOVF R2,w ; ; CALL LCDBCDL ; ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 'W' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; BCF STATUS,RP1 ; BCF STATUS,RP0 ; MOVLW B'10001001' ; RC, A/D is ON, Channel 1 is selected MOVWF ADCON0 ; BSF ADCON0, GO ; Start A/D convertion bcf FLAGS,FO ; movlw 0x47 ; CALL LCDSDDA ; CALL GETRF ; MOVF R0,w ; CALL LCDBCDL ; CALL FIRSTZERO ; MOVF R1,w ; CALL LCDBCDH ; CALL SECONDZERO ; MOVF R1,w ; CALL LCDBCDL ; CALL LCDDATA ; MOVLW '.' ; CALL LCDDATA ; MOVF R2,w ; CALL LCDBCDH ; CALL LCDDATA ; ; MOVF R2,w ; ; CALL LCDBCDL ; ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 'W' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; CALL PAUSE05S ; CALL TKeyPO ; RETURN ; PrintDV CALL LCDCLEAR ; MOVLW 'D' ; CALL LCDDATA ; MOVLW 'E' ; CALL LCDDATA ; MOVLW 'V' ; CALL LCDDATA ; MOVLW 'I' ; CALL LCDDATA ; MOVLW 'A' ; CALL LCDDATA ; MOVLW 'T' ; CALL LCDDATA ; MOVLW 'I' ; CALL LCDDATA ; MOVLW 'O' ; CALL LCDDATA ; MOVLW 'N' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; RETURN ; ; DisplayDV bcf FLAGS,FO ; BCF STATUS,RP1 ; BCF STATUS,RP0 ; MOVLW B'10010001' ; RC, A/D is ON, Channel 1 is selected MOVWF ADCON0 ; BSF ADCON0, GO ; Start A/D convertion call GETVAL ; decfsz DEV_SKIP,f ; goto label ; call DevDig ; label movlw 0x40 ; call LCDSDDA ; call BarGraf ; call TKeyDV ; return ; ; DevDig movlw .10 ; movwf DEV_SKIP ; movlw 0x0A ; CALL LCDSDDA ; CALL GETDV ; MOVF R1,w ; CALL LCDBCDH ; CALL FIRSTZERO ; MOVF R1,w ; CALL LCDBCDL ; CALL SECONDZERO ; MOVF R2,w ; CALL LCDBCDH ; CALL LCDDATA ; MOVLW 'k' ; CALL LCDDATA ; MOVLW 'H' ; CALL LCDDATA ; MOVLW 'z' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; Return ; ; PrintAF CALL LCDCLEAR ; MOVLW 'L' ; CALL LCDDATA ; movlw 0x40 ; CALL LCDSDDA ; MOVLW 'R' ; CALL LCDDATA ; RETURN ; ; DisplayAF BCF STATUS,RP1 ; BCF STATUS,RP0 ; MOVLW B'10011001' ; RC, A/D is ON, Channel 1 is selected MOVWF ADCON0 ; BSF ADCON0, GO ; Start A/D convertion bsf FLAGS,FO ; movlw 0x01 ; call LCDSDDA ; call GETLC ; call BarGraf ; BCF STATUS,RP1 ; BCF STATUS,RP0 ; MOVLW B'10100001' ; RC, A/D is ON, Channel 1 is selected MOVWF ADCON0 ; BSF ADCON0, GO ; Start A/D convertion bcf FLAGS,FO ; movlw 0x41 ; call LCDSDDA ; call GETRC ; call BarGraf ; call TKeyLC ; RETURN ; PrintU12 CALL LCDCLEAR ; MOVLW 'U' ; CALL LCDDATA ; MOVLW '1' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW '=' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; movlw 0x40 ; CALL LCDSDDA ; MOVLW 'U' ; CALL LCDDATA ; MOVLW '2' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW '=' ; CALL LCDDATA ; MOVLW '-' ; CALL LCDDATA ; return ; ; DisplayU12 BCF STATUS,RP1 ; BCF STATUS,RP0 ; MOVLW B'10101001' ; RC, A/D is ON, Channel 0 is selected MOVWF ADCON0 ; BSF ADCON0, GO ; Start A/D convertion bsf FLAGS,FO ; MOVLW 0x05 ; CALL LCDSDDA ; CALL GETU1 ; MOVF R1,w ; CALL LCDBCDH ; CALL FIRSTZERO ; MOVF R1,w ; CALL LCDBCDL ; CALL LCDDATA ; MOVLW '.' ; CALL LCDDATA ; MOVF R2,w ; CALL LCDBCDH ; CALL LCDDATA ; MOVF R2,w ; CALL LCDBCDL ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 'V' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; BCF STATUS,RP1 ; BCF STATUS,RP0 ; MOVLW B'10110001' ; RC, A/D is ON, Channel 0 is selected MOVWF ADCON0 ; BSF ADCON0, GO ; Start A/D convertion bcf FLAGS,FO ; MOVLW 0x45 ; CALL LCDSDDA ; CALL GETU2 ; MOVF R1,w ; CALL LCDBCDH ; CALL FIRSTZERO ; MOVF R1,w ; CALL LCDBCDL ; CALL LCDDATA ; MOVLW '.' ; CALL LCDDATA ; MOVF R2,w ; CALL LCDBCDH ; CALL LCDDATA ; MOVF R2,w ; CALL LCDBCDL ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 'V' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; CALL PAUSE05S ; CALL TKeyU1 ; RETURN ; PrintU3 CALL LCDCLEAR ; MOVLW 'U' ; CALL LCDDATA ; MOVLW '3' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW '=' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; return ; ; DisplayU3 bcf FLAGS,FO ; BCF STATUS,RP1 ; BCF STATUS,RP0 ; MOVLW B'10111001' ; RC, A/D is ON, Channel 0 is selected MOVWF ADCON0 ; BSF ADCON0, GO ; Start A/D convertion MOVLW 0x05 ; CALL LCDSDDA ; CALL GETU3 ; MOVF R1,w ; CALL LCDBCDH ; CALL FIRSTZERO ; MOVF R1,w ; CALL LCDBCDL ; CALL LCDDATA ; MOVLW '.' ; CALL LCDDATA ; MOVF R2,w ; CALL LCDBCDH ; CALL LCDDATA ; MOVF R2,w ; CALL LCDBCDL ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 'V' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; CALL PAUSE05S ; CALL TKeyU3 ; RETURN ; ; PrintFQ CALL LCDCLEAR ; movlw 0x04 ; CALL LCDSDDA ; MOVLW 'E' ; CALL LCDDATA ; MOVLW 'X' ; CALL LCDDATA ; MOVLW 'P' ; CALL LCDDATA ; MOVLW 'R' ; CALL LCDDATA ; MOVLW 'E' ; CALL LCDDATA ; MOVLW 'S' ; CALL LCDDATA ; MOVLW 'S' ; CALL LCDDATA ; return ; ; DisplayFQ MOVLW 0x43 ; CALL LCDSDDA ; CALL GETFQ ; movf R0,w ; call LCDBCDH ; CALL FIRSTZERO ; movf R0,w ; call LCDBCDL ; CALL LCDDATA ; MOVF R1,w ; CALL LCDBCDL ; CALL LCDDATA ; MOVLW '.' ; CALL LCDDATA ; MOVF R1,w ; CALL LCDBCDH ; CALL LCDDATA ; MOVF R2,w ; CALL LCDBCDH ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 'M' ; CALL LCDDATA ; MOVLW 'H' ; CALL LCDDATA ; MOVLW 'z' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; CALL PAUSE05S ; CALL TKeyFQ ; RETURN ; StartFREQ call PrintFQ ; MOVLW 0x43 ; CALL LCDSDDA ; CALL GETFQ ; movf R0,w ; call LCDBCDH ; CALL FIRSTZERO ; movf R0,w ; call LCDBCDL ; CALL LCDDATA ; MOVF R1,w ; CALL LCDBCDL ; CALL LCDDATA ; MOVLW '.' ; CALL LCDDATA ; MOVF R1,w ; CALL LCDBCDH ; CALL LCDDATA ; MOVF R2,w ; CALL LCDBCDH ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; MOVLW 'M' ; CALL LCDDATA ; MOVLW 'H' ; CALL LCDDATA ; MOVLW 'z' ; CALL LCDDATA ; MOVLW ' ' ; CALL LCDDATA ; CALL PAUSE2S ; CALL PAUSE2S ; RETURN ; BarGraf movlw 0x0F ; movwf COUNT_C ; movlw 0xFF ; movwf COUNT_D ; call READRES ; call DIV2 ; call DIV2 ; swapf L_BYTE,w ; andlw 0x0F ; movwf DEV_BYTE ; nextBar incf COUNT_D,f ; movf DEV_BYTE,w ; subwf COUNT_D,w ; btfss STATUS,C ; goto OverTest ; goto PrintSpace ; Noname decfsz COUNT_C,f ; goto nextBar ; return ; ; OverTest movf COUNT_D,w ; sublw 0x09 ; btfss STATUS,C ; goto PrintOver ; goto PrintBar ; ; PrintSpace movlw ' ' ; call LCDDATA ; goto Noname ; ; PrintBar movlw 0xDB ; call LCDDATA ; goto Noname ; ; PrintOver movlw 0xFF call LCDDATA ; goto Noname ; ; D_add movf ACCaLO,W ; Addition ( ACCb + ACCa -> ACCb ) addwf ACCbLO, F ; add lsb btfsc STATUS,C ; add in carry incf ACCbHI, F ; movf ACCaHI,W ; addwf ACCbHI, F ; add msb retlw 0 ; ; setmpy movlw D'16' ; for 16 shifts movwf MPY_F ; movf ACCbHI,W ;move ACCb to ACCd movwf ACCdHI ; movf ACCbLO,W ; movwf ACCdLO ; clrf ACCbHI ; clrf ACCbLO ; clrf ACCcHI ; clrf ACCcLO ; retlw 0 ; ; D_mpy ;results in ACCb(16 msb's) and ACCc(16 lsb's) call setmpy ; mloop rrf ACCdHI, F ;rotate d right rrf ACCdLO, F ; btfsc STATUS,C ;need to add? call D_add ; rrf ACCbHI, F ; rrf ACCbLO, F ; rrf ACCcHI, F ; rrf ACCcLO, F ; decfsz MPY_F, F ;loop until all bits checked goto mloop ; retlw 0 ; ; end | |
| | |