PIC Microcontoller Math Method

16 bit Square Root successive approximation method

Andy David says:

I've added a 16-bit square root routine (again for the 17c43) that uses successive approximation to find the square root, the binary restoring method I'm fairly sure would be quicker. This is the only 16-bit sqrt routine I have specifically for the 17cxx PICs, I've only included it as the original poster requested a 16-bit routine. If you really want speed speed speed, I'd rewrite the 32-bit routine to be 16-bit.

Standard disclaimer applies

;==========================================================================
; SQRT16
;
; Calculates the square root of a sixteen bit number by successive
; approximation.
;
;
; Input in ACCaHI:ACCaLO
;
; Output in ACCbHI
;
; Also uses ACCbLO and ACCcHI.
;
;--------------------------------------------------------------------------

SQRT16:
	movlw 0x80 ;
	movpf WREG,ACCbLO ; set up walking tester bit.

	clrf ACCbHI,w ;

	movlw 0x08 ;
	movpf WREG,ACCcHI ;

tstest:	movfp ACCbLO,WREG ; set bit for testing.
	iorwf ACCbHI,WREG ;
	movpf WREG,ACCbHI ;

	mulwf ACCbHI ; square the current estimate.

	movfp ACCaLO,WREG ; compare PRODH:PRODL with ACCaHI:ACCaLO
	subwf PRODL,WREG ;
	movfp ACCaHI,WREG ;
	subwfb PRODH,WREG ;

	btfss ALUSTA,C ; If the result is <= input,
	goto nxtbit ; ... keep this bit set.

	movfp ACCbLO,WREG ; Result was > input, so reset
	xorwf ACCbHI,f ; ... bit to zero.

nxtbit:	rrncf ACCbLO,f ; rotate tester bit right.

	decfsz ACCcHI,f ;
	goto tstest ;

	return