;******************************************************************* ; ; Inductance & Capacitance Meter ; ;******************************************************************* ; ; LC002 - THIS ONE WORKS FINE WITH A WELL BEHAVED DISPLAY ; ; Deleted CpyBin subroutine and one call to it ; ; Modified B2_BCD to take its input directly from ; ; Modified "oscillator test" so it copies F3 to ; ; Fixed Get_Lcal so it gets the correct number ; ; Minor adjustment to MS100 timing to correct frequency display ; ; Check for oscillator too slow when measuring L or C. ; ; ;******************************************************************* ; ; LC003 - Optimised / Modified to handle "bad" displays ; ; Removed duplicated code in DATS subroutine ; ; Added code to fix crook display (select by jumper on B4 - 10) ; ; Optimised L & C formatting code ; ; Optimised "Display" subroutine ; ; Cleaned up LCDINIT ; ; ;******************************************************************* ; ; LC004 - Deleted timer Interrupt Service Routine ; ; Modified way oscillator "out of range" condition is detected ; ; ;******************************************************************* ; ; LC628 - LC004 code ported to 16F628 by Egbert Jarings PA0EJH. ; Mem starts now at 0x20 ; InitIO modified , 628 PortA start's up in Analog Mode ; So changed to Digital Mode (CMCON) ; ; Display's "Calibrating" to fill up dead Display time ; when first Powerd Up. ; ; Changed pmsg Routine, EEADR trick wont work with 628, ; PCL was always 0x00 so restart occurs. EEADR is now EAD. ; ; Also changed EEADR in FP routine to EAD ; ; Bad Display isn't bad at all, its a Hitachi HD44780, as ; 80% of all Display's are. Adress as 2 Lines x 8 Char. ; So LCDINIT modified for 2 x 8 Display's. (0x28 added) ; ;******************************************************************* ; ; CPU configuration ; ; It was a 16F84, HS?? oscillator, ; watchdog timer off, power-up timer on processor 16f628 include ; __config _HS_OSC & _PWRTE_ON & _WDT_OFF ; 16f84 __CONFIG _CP_OFF & _WDT_OFF & _PWRTE_ON & _XT_OSC & _BODEN_ON & _LVP_OFF ;******************************************************************* ; ; GENERAL MATH LIBRARY DEFINITIONS ; ; ; define assembler constants B0 equ 0 B1 equ 1 B2 equ 2 B3 equ 3 B4 equ 4 B5 equ 5 B6 equ 6 B7 equ 7 MSB equ 7 LSB equ 0 ; STATUS bit definitions #define _C STATUS,0 #define _Z STATUS,2 ;******************************************************************* ; ; FIXED POINT SPECIFIC DEFINITIONS ; ; remainder storage ; REMB3 equ 0x20 REMB2 equ 0x21 REMB1 equ 0x22 REMB0 equ 0x23 ; most significant byte of remainder ; ; general register variables ; SIGN equ 0x29 ; save location for sign in MSB TEMPB3 equ 0x30 TEMPB2 equ 0x31 TEMPB1 equ 0x32 TEMPB0 equ 0x33 TEMP equ 0x33 ; temporary storage LOOPCOUNT equ 0x34 ; loop counter ; ; binary operation arguments & rest of FP stack ; AARGB4 equ 0x23 AARGB3 equ 0x24 AARGB2 equ 0x25 AARGB1 equ 0x26 AARGB0 equ 0x27 AARG equ 0x27 ; most significant byte of argument A AEXP equ 0x28 ; 8 bit biased exponent for argument A EXP equ 0x28 ; 8 bit biased exponent BARGB2 equ 0x2c BARGB1 equ 0x2d BARGB0 equ 0x2e BARG equ 0x2e ; most significant byte of argument B BEXP equ 0x2f ; 8 bit biased exponent for argument B CARGB1 equ 0x35 CARGB0 equ 0x36 CARG equ 0x37 ; most significant byte of argument C CEXP equ 0x38 ; 8 bit biased exponent for argument C ;******************************************************************* ; ; FLOATING POINT SPECIFIC DEFINITIONS ; ; literal constants ; EXPBIAS equ D'127' ; ; floating point library exception flags ; FPFLAGS equ 0x2a ; floating point library exception flags IOV equ 0 ; bit0 = integer overflow flag FOV equ 1 ; bit1 = floating point overflow flag FUN equ 2 ; bit2 = floating point underflow flag FDZ equ 3 ; bit3 = floating point divide by zero flag NAN equ 4 ; bit4 = not-a-number exception flag DOM equ 5 ; bit5 = domain error exception flag RND equ 6 ; bit6 = floating point rounding flag, 0 = truncation ; 1 = unbiased rounding to nearest LSB SAT equ 7 ; bit7 = floating point saturate flag, 0 = terminate on ; exception without saturation, 1 = terminate on ; exception with saturation to appropriate value #define ENA PORTA,0x02 ; Display "E" #define RS PORTA,0x03 ; Display "RS" #define relay PORTA,0x01 ; 0 = energise relay #define FIXIT PORTB,0x04 ; Pin 10, 0 = "fix bad display" ; Floating 1 = "good display" #define setup PORTB,0x06 ; Pin 12, 0 = "Setup" #define functn PORTB,0x07 ; Pin 13, 0 = "Inductor" ;#define OvrRng FLAGS,0x04 ; Now unused #define BANKSEL STATUS,RP0 #define beq bz ; Motorola syntax branches #define BEQ bz #define BNE bnz #define bne bnz #define BCC bnc #define bcc bnc #define BCS bc #define bcs bc #define BRA goto #define bra goto ;******************************************************************* ; ; file register declarations: use only registers in bank0 ; bank 0 file registers begin at 0x0c in the 16F84 ; ;******************************************************************* ; FP uses memory 0x20 to 0x38 inclusive cblock 0x3a COUNT ; Bin to BCD convert (bit count) cnt ; (BCD BYTES) COUNT1 ; Used by delay routines ; and "prescaler flush" COUNT2 ; Timing (100ms) CHR F1:2 F2:2 F3:2 bcd:4 ; BCD, MSD first FLAGS TabStop ; Used to fix bad? displays. TabTemp EAD ; Used to overcome EEADR error endc ;********************************************************** ; ; Begin Executable Stuff(tm) ; org 0 GO clrwdt ; 0 << Reset call InitIO ; 1 INITIALISE PORTS clrf PORTA ; 2 goto START ; 3 ;********************************************************** ; ; Text Strings (stored in RETLWs) ; ovr dt " Over Range ",0 Unit1 dt " nF",0 Unit2 dt " pF",0 Unit3 dt " mH",0 Unit4 dt " uH",0 Cintro dt " C = ",0 Lintro dt " L = ",0 Calibr dt " Calibrating ",0 ;********************************************************** ; ; Main Program ; START bsf relay ; de-energise relay CLRF PORTB CALL LCDINIT ; INITIALIZE LCD MODULE cmdloop call HOME btfsc setup ; Doing initial oscillator test? goto Chk4Z ; ; Measure & display osc freq for initial setup ; call Measure ; Measure Local Osc Freq. btfss INTCON,T0IF ; Set = Counter overflow? goto Do_Disp MOVLW ovr ; Over-range message call pmsg goto cmdloop Do_Disp clrf AARGB0 ; Copy to 24 bit number movf F3,W ; in AARGB0, 1, 2 movwf AARGB1 ; for display movf F3+1,W movwf AARGB2 call Display goto cmdloop ; ; "Zero" the meter. ; Chk4Z call Measure ; Dummy Run MOVLW Calibr ; Display's " Calibrating " call pmsg call MS300 call Measure ; Get freq in F3 movf F3,W ; Copy to F1 movwf F1 movf F3+1,W movwf F1+1 bcf relay ; Add standard capacitor ************* call MS200 call Measure movf F3,W ; Copy to F2 movwf F2 movf F3+1,W movwf F2+1 bsf relay ; Remove standard capacitor call MS200 ; ; Now we resume our regular pogrom ; M_F3 call HOME call Measure ; Measure F3 & leave it there movf F3,w ; test for "too low" frequency beq OORange btfss INTCON,T0IF ; test for "too high" frequency goto OK2GO OORange MOVLW ovr ; Over/Under range message call pmsg goto M_F3 ; ; Precompute major bracketed terms cos ; we need 'em both for all calculations ; OK2GO call F1_F2 call F1_F3 ; ; See what mode we are in ; btfss functn ; 0=Inductor goto Do_Ind ; ; OK, we've been told it's a capacitor ; Do_Cap movlw Cintro ; C = call pmsg call C_calc call C_disp goto M_F3 ; ; Now, they reckon it's a @#$*! inductor ; Do_Ind movlw Lintro ; L = call pmsg call L_calc call L_disp goto M_F3 ;********************************************************** ; ; Print String addressed by W ; Note: Strings are in program space ; pmsg movwf EAD ;EEADR ; Temp for pointer pm1 movf EAD,W ; Get current pointer call pmsub andlw 0xff ; Test returned value beq pm_end ; NULL = All done call DATS incf EAD,F goto pm1 pmsub movwf PCL ; Goto W nop ; Just in case pm_end return ;********************************************************** ; ; Delay for 2ms (untrimmed) ; MS2 MOVLW 0xFD ; DELAY 2ms MOVWF COUNT1 MOVLW 0x66 MOVWF COUNT2 goto L3 ;********************************************************** ; ; Delay for about 200ms or 300ms (untrimmed) ; MS300 call MS100 MS200 call MS100 ;********************************************************** ; ; Delay for about 100ms ; MS100 MOVLW 0x7e ; Count up MOVWF COUNT1 ; to roll-over MOVLW 0x20 ; was 0x19, then 0x25, then 1f MOVWF COUNT2 L3 INCFSZ COUNT2,F GOTO L3 INCFSZ COUNT1,F GOTO L3 RETLW 0 ;********************************************************** ; ; Put a BCD nybble to display ; PutNyb ANDLW 0x0F ; MASK OFF OTHER PACKED BCD DIGIT ADDLW 0x30 ; Convert BIN to ASCII ;********************************************************** ; ; Put a byte to display ; DATS decf TabStop,F ; Used for display of 9th Char bne DAT1 ; Not yet movwf TabTemp ; Save character btfss FIXIT ; Check if we got a 2x8 on 1 line. CALL LINE2 ; Skip this if 1x16 movf TabTemp,W ; Restore character DAT1 BSF RS ; SELECT DATA REGISTER CM MOVWF CHR ; STORE CHAR TO DISPLAY SWAPF CHR,W ; SWAP UPPER AND LOWER NIBBLES (4 BIT MODE) call PB_dly MOVF CHR,W ; GET CHAR AGAIN ;********************************************************** ; ; Put 4 bits to LCD & wait (untrimmed) ; PB_dly ANDLW 0x0F ; MASK OFF UPPER 4 BITS MOVWF PORTB ; SEND DATA TO DISPLAY BSF ENA ; ENA HIGH NOP BCF ENA ; ENA LOW ; goto D200us ; Fall into DELAY subroutine ;********************************************************** ; ; Delay for 200us (untrimmed) ; D200us MOVLW 0x42 ; DELAY 200us MOVWF COUNT1 NXT5 DECFSZ COUNT1,F GOTO NXT5 RETLW 0 ;****************************************************************** ; ; Convert 24-bit binary number at into a bcd number ; at . Uses Mike Keitz's procedure for handling bcd ; adjust; Modified Microchip AN526 for 24-bits. ; B2_BCD b2bcd movlw .24 ; 24-bits movwf COUNT ; make cycle counter clrf bcd+0 ; clear result area clrf bcd+1 clrf bcd+2 clrf bcd+3 b2bcd2 movlw bcd ; make pointer movwf FSR movlw .4 movwf cnt ; Mike's routine: b2bcd3 movlw 0x33 addwf INDF,f ; add to both nybbles btfsc INDF,3 ; test if low result > 7 andlw 0xf0 ; low result >7 so take the 3 out btfsc INDF,7 ; test if high result > 7 andlw 0x0f ; high result > 7 so ok subwf INDF,f ; any results <= 7, subtract back incf FSR,f ; point to next decfsz cnt,f goto b2bcd3 rlf AARGB2,f ; get another bit rlf AARGB1,f rlf AARGB0,f rlf bcd+3,f ; put it into bcd rlf bcd+2,f rlf bcd+1,f rlf bcd+0,f decfsz COUNT,f ; all done? goto b2bcd2 ; no, loop return ; yes ;*********** INITIALISE LCD MODULE 4 BIT MODE *********************** LCDINIT CALL MS100 ; WAIT FOR LCD MODULE HARDWARE RESET BCF RS ; REGISTER SELECT LOW BCF ENA ; ENABLE LINE LOW MOVLW 0x03 ; 1 call PB_dly CALL MS100 ; WAIT FOR DISPLAY TO CATCH UP MOVLW 0x03 ; 2 call PB_dly MOVLW 0x03 ; 3 call PB_dly MOVLW 0x02 ; Fn set 4 bits call PB_dly MOVLW 0x28 ; DISPLAY 2 Line , 5x7 Dot's CALL ST200us ; New in LC005 version MOVLW 0x0C ; 0x0C DISPLAY ON CALL ST200us MOVLW 0x06 ; 0x06 ENTRY MODE SET CALL ST200us MOVLW 0x01 ; 0x01 CLEAR DISPLAY CALL Home2 ; RETLW 0 ; goto CLEAR ; Fall into CLEAR ;************ CLEAR DISPLAY *************************** CLEAR MOVLW 0x01 ; CLEAR DISPLAY goto Home2 ; LONGER DELAY NEEDED WHEN CLEARING DISPLAY ;*********** MOVE TO HOME ***************************** HOME movlw 0x09 ; Count characters movwf TabStop ; before tickling display. MOVLW 0x02 ; HOME DISPLAY Home2 CALL STROBE goto MS2 ;********************************************************** ; ; SENDS DATA TO LCD DISPLAY MODULE (4 BIT MODE) ; STROBE BCF RS ; SELECT COMMAND REGISTER GOTO CM ;************ MOVE TO START OF LINE 2 ***************** LINE2 MOVLW 0xC0 ; ADDRESS FOR SECOND LINE OF DISPLAY ; was 0xC0 ST200us CALL STROBE goto D200us ;******************************************************************** ; Initialise Input & Output devices ;******************************************************************** InitIO BSF CMCON, CM0 ; BSF CMCON, CM1 ; Set Comp to digital I/O BSF CMCON, CM2 ; bsf BANKSEL ; Select Bank1 movlw 0x37 ; Option register movwf OPTION_REG ; Port B weak pull-up enabled ; INTDEG Don't care ; Count RA4/T0CKI ; Count on falling edge ; Prescale Timer/counter ; divide Timer/counter by 256 ; PORTA:- movlw 0x10 ; initialise data direction ; 1 = input ; 0 = output ; ; PORTA has 5 pins 4 3 2 1 0 ; 0x10 = 0 0 0 1 0 0 0 0 ; movwf TRISA ; PORTA<0> = CLAMP count input ; PORTA<1> = Relay. 0 = energise ; PORTA<2> = LCD "E" ; PORTA<3> = LCD "RS" ; PORTA<4> = Count Input ; PORTA<5:7> = not implemented in 16F84 ; ; clrf TRISB ; PORTB:- ; bcf BANKSEL ; initialise data direction ; clrf PORTB ; PORTB has 8 pins ; bsf BANKSEL ; port pin 7 6 5 4 3 2 1 0 movlw 0xf0 ; 0xf0 = 1 1 1 1 0 0 0 0 ; movwf TRISB ; PORTB<0> = LCD "DB4" ; PORTB<1> = "DB5" ; PORTB<2> = "DB6" ; PORTB<3> = "DB7" ; PORTB<4> = Input ; PORTB<5> = Input ; PORTB<6> = Input ; PORTB<7> = Input bcf BANKSEL ; Re-select Bank0 return ;********************************************************** ; ; Measure Frequency. Stash in "F3 and F3+1" ; Measure bcf INTCON,T0IF ; Declare "Not yet Over-range" CLRF TMR0 ; RESET INTERNAL COUNT (INCLUDING PRESCALER) ; See page 27 Section 6.0 bsf PORTA,0 ; Part of Osc gating CLRF F3 ; Ready to receive 16 bit number CLRF F3+1 ; OPEN GATE bsf BANKSEL ; Select Bank1 ; PORTA:- movlw 0x11 ; initialise data direction ; 1 = input ; 0 = output ; PORTA has 5 pins 4 3 2 1 0 ; 0x10 = 0 0 0 1 0 0 0 1 movwf TRISA ; PORTA<0> = ; PORTA<1> = ; PORTA<2> = LCD "E" ; PORTA<3> = LCD "RS" ; PORTA<4> = Input ; PORTA<5:7> = not implemented in 16F84 ; bcf BANKSEL ; Re-select Bank0 CALL MS100 ; 100MS DELAY ; CLOSE GATE (COUNT COMPLETE) ; bsf BANKSEL ; Select Bank1 ; PORTA:- movlw 0x10 ; initialise data direction ; 1 = input ; 0 = output ; PORTA has 5 pins 4 3 2 1 0 ; 0x10 = 0 0 0 1 0 0 0 0 movwf TRISA ; PORTA<0> = ; PORTA<1> = ; PORTA<2> = LCD "E" ; PORTA<3> = LCD "RS" ; PORTA<4> = Input ; PORTA<5:7> = not implemented in 16F84 bcf BANKSEL ; Re-select Bank0 MOVF TMR0,W ; GET HIGH BYTE MOVWF F3 ; Copy to Big end of 16 bit result ; The 311 "outputting" a 1 'cos we've forced it high ; so T0CKI=1. PSC1 bsf BANKSEL ; Select Bank1 bsf OPTION_REG,T0SE ; Clock the prescaler nop bcf OPTION_REG,T0SE bcf BANKSEL ; Re-select Bank0 DECF F3+1,F ; Decrement the counter movf TMR0,W ; Has TMR0 changed? xorwf F3,W ; if unchanged, XOR -> 0 beq PSC1 return ; F3 : F3+1 now holds 16 bit result ;********************************************************** ; ; Display contents of AARGB0,1,2 on LCD ; First convert to BCD, Then ASCII (nybble at a time) ; Display CALL B2_BCD ; CONVERT COUNT TO BCD call Swap0 ; GET NEXT DIGIT call Move0 ; GET OTHER BCD DIGIT call Swap1 call Move1 call Swap2 call Move2 call Swap3 goto Move3 ; includes return ;********************************************************** ; ; Formatted display of BCD work area for Capacitor ; C_disp F_C1 MOVF bcd+0,W ANDLW 0x0F beq F_C2 CALL PutNyb call Swap1 call Move1 CALL DoDP ; Print DP call Swap2 goto F_C3U ;-------------------------------------------------- F_C2 swapf bcd+1,W ANDLW 0x0F beq F_C3 CALL PutNyb call Move1 CALL DoDP ; Print DP call Swap2 call Move2 goto F_C3U ; print nF. includes RETURN ;-------------------------------------------------- F_C3 MOVF bcd+1,W ANDLW 0x0F beq F_C4 CALL PutNyb CALL DoDP ; Print DP call Swap2 call Move2 call Swap3 F_C3U movlw Unit1 ; nF goto pmsg ; includes RETURN ;-------------------------------------------------- F_C4 SWAPF bcd+2,W ; Digit1 == 0 ? ANDLW 0x0F bne NoB1_C MOVLW 0x20 ; YES PRINT A SPACE call DATS MOVF bcd+2,W ; Digit2 == 0 ? ANDLW 0x0F bne NoB2_C MOVLW 0x20 ; YES PRINT A SPACE call DATS bra NoB3_C NoB1_C call Swap2 ; 1 NoB2_C call Move2 ; 2 NoB3_C call Swap3 ; 3 CALL DoDP ; Print DP call Move3 ; 4 movlw Unit2 ; pF goto pmsg ; includes RETURN ;********************************************************** ; ; Formatted display of BCD work area for Inductor ; L_disp F_L1 MOVF bcd+0,W ANDLW 0x0F beq F_L2 CALL PutNyb call Swap1 CALL DoDP ; Print DP call Move1 call Swap2 goto F_L2U ; Print mH. includes RETURN ;-------------------------------------------------- F_L2 swapf bcd+1,W ANDLW 0x0F beq F_L3 CALL PutNyb CALL DoDP ; Print DP call Move1 call Swap2 call Move2 F_L2U movlw Unit3 ; mH goto pmsg ; includes RETURN ;-------------------------------------------------- F_L3 MOVF bcd+1,W ANDLW 0x0F beq F_L4 CALL PutNyb call Swap2 call Move2 CALL DoDP ; Print DP call Swap3 goto F_L4U ; Print uH. includes RETURN ;-------------------------------------------------- F_L4 SWAPF bcd+2,W ; Digit1 == 0 ? ANDLW 0x0F bne NoB1_L MOVLW 0x20 ; YES PRINT A SPACE call DATS goto NoB2_L NoB1_L call Swap2 ; 1 NoB2_L call Move2 ; 2 CALL DoDP ; Print DP call Swap3 ; 3 call Move3 ; 4 F_L4U movlw Unit4 ; uH goto pmsg ; includes RETURN ;-------------------------------------------------- ; ; Common subroutine for formatted output ; DoDP MOVLW '.' ; Print DP goto DATS ; Return from DATS Swap0 SWAPF bcd+0,W ; GET NEXT DIGIT goto PutNyb ; DISPLAY IT Move0 MOVF bcd+0,W ; GET OTHER BCD DIGIT goto PutNyb Swap1 SWAPF bcd+1,W goto PutNyb Move1 MOVF bcd+1,W goto PutNyb Swap2 SWAPF bcd+2,W goto PutNyb Move2 MOVF bcd+2,W goto PutNyb Swap3 SWAPF bcd+3,W goto PutNyb Move3 MOVF bcd+3,W goto PutNyb ;******************************************************************** ; ; Stack operations ; ;******************************************************************** ;add call FPA24 ; goto S_fix subtract call FPS24 goto S_fix divide call FPD24 goto S_fix multiply call FPM24 ; goto S_fix ; ; Fix stack after add, subtract, divide & multiply ; S_fix MOVF CARGB1,W ; C -> B MOVWF BARGB1 MOVF CARGB0,W MOVWF BARGB0 MOVF CEXP,W MOVWF BEXP return ; ; Push stack (duplicates TOS) ; S_push MOVF BARGB1,W ; B -> C MOVWF CARGB1 MOVF BARGB0,W MOVWF CARGB0 MOVF BEXP,W MOVWF CEXP MOVF AARGB1,W ; A -> B MOVWF BARGB1 MOVF AARGB0,W MOVWF BARGB0 MOVF AEXP,W MOVWF BEXP return ; ; Swap A and B ; S_swap MOVF AARGB1,W ; A -> EEADR (temp) MOVWF EAD MOVF BARGB1,W ; B -> A MOVWF AARGB1 MOVF EAD,W ; EEADR (temp) -> B MOVWF BARGB1 ;-------------------------------------------------- MOVF AARGB0,W ; A -> EEADR (temp) MOVWF EAD MOVF BARGB0,W ; B -> A MOVWF AARGB0 MOVF EAD,W ; EEADR (temp) -> B MOVWF BARGB0 ;-------------------------------------------------- MOVF AEXP,W ; A -> EEADR (temp) MOVWF EAD MOVF BEXP,W ; B -> A MOVWF AEXP MOVF EAD,W ; EEADR (temp) -> B MOVWF BEXP return ;******************************************************************** ; ; Calculate Unknown Capacitance OR inductance ; ; Output: 24 bit positive integer (scaled) ; right justified in AARGB0, AARGB1, AARGB2 ; also as BCD in bcd:bcd+1:bcd+2:bcd+3 ; ;******************************************************************** C_calc call divide call Get_Ccal ; Times 10,000 ( = 1000.0pF) call multiply goto PorM ; includes return ;-------------------------------------------------------------------- L_calc call multiply call Get_Lcal ; Precomputed 1/(Ccal*4*PI*PI) call multiply L_divF1 call Get_F1 ; Divide by F1^2 call S_push call multiply call S_swap call divide ; ; Handle space or - in front of FP number ; PorM btfss AARGB0,7 ; test sign goto Pplus Pminus movlw 0x2d ; minus goto PMdisp Pplus movlw 0x20 ; plus PMdisp call DATS ; print it bcf AARGB0,7 ; make plus anyway ; ; Format as raw BCD string in bcd:bcd+1:bcd+2:bcd+3 ; call INT2424 ; To INT in AARGB0 etc. goto B2_BCD ; includes return ;******************************************************************** ; ; Calculate (F1/F3)^2-1, leave result on stack ; ;******************************************************************** F1_F3 call Get_F3 goto F1_F1 ;******************************************************************** ; ; Calculate (F1/F2)^2-1, leave result on stack ; ;******************************************************************** F1_F2 call Get_F2 F1_F1 call Get_F1 call divide ; F1/Fx call S_push call multiply ; (F1/Fx)^2 call Get_One call S_swap goto subtract ; (F1/Fx)^2-1 ; includes return ;******************************************************************** ; Fetch assorted things used for the calculation ; of Unknown L and C ; ;******************************************************************** Get_Lcal call S_push ; make room first movlw 0xAB ; 2.53303e+13 movwf AEXP ; Create FP version of movlw 0x38 ; Precomputed 1/(Ccal*4*PI*PI) movwf AARGB0 ; times any needed movlw 0x4D ; fiddle factor (1/100) goto B1_2_stak Get_Ccal call S_push ; make room first movlw 0x8c ; 10,000 movwf AEXP ; Create FP version of movlw 0x1C ; Precomputed Ccal movwf AARGB0 ; times any needed movlw 0x40 ; fiddle factor B1_2_stak movwf AARGB1 return Get_One call S_push ; make room first clrf AEXP ; Create a binary 1 clrf AARGB0 clrf AARGB1 movlw 0x01 goto LSB2stak Get_F1 movlw F1 ; Includes stack push goto W2stak Get_F2 movlw F2 ; Includes stack push goto W2stak Get_F3 movlw F3 ; Includes stack push ; goto W2stak ;******************************************************************** ; Copy 16 bit number, pointed to by W, to stack ; and convert to FP (positive value only) ; via a 24 bit number in AARGB0,1,2 ;******************************************************************** W2stak movwf FSR call S_push ; make room first clrf AEXP clrf AARGB0 movf INDF,W ; Big Byte first movwf AARGB1 incf FSR,F ; then little byte movf INDF,W LSB2stak movwf AARGB2 goto FLO2424 ; 24 bit int -> 24 bit FP ;******************************************************************** INCLUDE END