serie_ln.hug

Lots useful AVR asm math routines (trigonometry, float point, intenger , vectors and etc)

;+------------------------------------------------------------------------------+
;| DOUBLE PRECISION FLOAT POINT 	I					|
;| BY JO肙 DARTAGNAN ANTUNES OLIVEIRA						|
;| NEED FILES 									|
;|										|
;|	FILE		DIRECTORY						|
;|										|
;|	GLOBDEFS.INC	AVR\LIBRARY\DEFS\GLOBAL_DEFINITIONS\GlobDefs.inc	|
;|	MATHCONS.INC	AVR\LIBRARY\MATH\FLOAT_DOUBLE\HEADER_MACROS\MathCons.Inc|
;|	DFINF.INC	AVR\LIBRARY\MATH\FLOAT_DOUBLE\INFINIT_RESULT\DFInf.Inc	|
;|	DFNORM.INC	AVR\LIBRARY\MATH\FLOAT_DOUBLE\NORMALIZE\DFNorm.Inc	|
;|	DFXTOF.INC 	AVR\LIBRARY\MATH\FLOAT_DOUBLE\LONG_TO_FLOAT\DFLTOF.Inc	|
;|	DFMULDIV.INC 	AVR\LIBRARY\MATH\FLOAT_DOUBLE\MULDIV\DFMulDiv.Inc	|
;|	DFADDSUB.INC 	AVR\LIBRARY\MATH\FLOAT_DOUBLE\ADDSUB\DFAddSub.Inc	|
;|	DFLDXSTX.INC 	AVR\LIBRARY\MATH\FLOAT_DOUBLE\LOAD_STORE\DFLdXStX.Inc	|
;+--------------------------------------------------------------+---+-----------+
;| BY JO肙 DARTAGNAN ANTUNES OLIVEIRA				    |
;|								    |
;|	ESTAS ROTINAS FORAM DESENVOLVIDAS A M蒁IDAS QUE FORAM SENDO |
;| NECESSITADAS DURANTE AO LONGO DE ALGUNS ANOS. ELAS  S肙  DE  USO |
;| LIVRE E QUAISQUER ALTERA钦ES SER肙 PERMITIDAS, DESDE QUE O  NOME |
;| DO AUTOR FIGURE NO IN虲IO DE CADA PROGRAMA E QUE CASO, O USO DELAS|
;| PROVOQUE MAL FUNCIONAMENTO, OU PREJU蚙O A TERCEIROS O AUTOR FICA |
;| LIVRE DESTAS. TODAS AS ROTINAS FORAM TESTADAS E EST肙 EM  USO EM |
;| SISTEMAS ONDE NENHUM PROBLEMA FOI RELATADO, TODAS FORAM FEITAS DA|
;| FORMA MAIS PR覺IMA DA PROGRAMA敲O ORIENTADA A OBJETO (OOP) SEM A |
;| IMPLEMENTA敲O DE INSTANCIAMENTO 				    |
;|								    |
;| QUAISQUER D赩IDAS MEU EMAIL E: [e-mail] 	    |
;| A MEDIDA DO POSS蚔EL RESPONDEREI A TODOS OS EMAILS.		    |
;+------------------------------------------------------------------+
;|								    |
;|	THIS ROUTINES THEY WERE DEVELOPED AT SAME TIME THAT WERE    |
;| NEEDED ALONG OF SOME YEARS. THEY ARE FOR USE FREE AND ANY        |
;| ALTERATIONS WILL BE PERMITED SINCE THAT AUTHOR NAME APPEAR AT    |
;| BEGINNER OF EACH PROGRAM, AND IF INCORRECT USE PRODUCE           |
;| MALFUNCIONS OR DAMAGE TO THIRD PARTIES THE AUTHOR STAY FREE.	    |
;| ALL ROTINES WERE TESTED AND STILL IN USE AT MANY SYSTEM AND NO   |
;| PROBLEM WERE RELATED. ALL ROTINES WERE MAKED AT CLOSED "ORIENTED |
;| OBJECT PROGRAMING" (OOP) WITHOUT INSTANCE IMPLEMENTATIONS:	    |
;|								    |
;| ANY QUESTIONS MY EMAIL IS [e-mail]		    |
;| SOON AS POSSIBLE AS ANSWER ALL EMAILS			    |
;+--------------------------------------------------------------+---+-----------+
;|										|
;| DATE:23/01/2003 VERSION 1.0							|
;>--------------------------------------------------------------+---------------<
;| D O U B L E   F L O A T  P O I N T  R O U T I N E S		|
;| P A R T I A L  N A T U R A L  L O G A R I T H M		|
;+--------------------------------------------------------------+
;| THIS DRIVE HAS INTEND TO USE WITH AVRS WITH SRAM		|
;+--------------------------------------------------------------+



;+----------------------------------------------------------------------+	
;| DOUBLE FLOAT POINT PARTIAL NATURAL LOGARITHM				|
;|									|
;| Input  : Float Acc X	value must in range 1 to 2			|
;| Output : Float Acc natural logarithm of X,Acc Exception code		|
;| Destroy: Flags							|
;| Method : use Maclaurin serie						|
;| 									|
;|									|
;| Below a Maclaurin series to calculate natural logarithm function,    |
;| where x varying of 1 to 2. values out of this range lost precision.	|
;|									|
;| original maclaurin serie for natural logarithm function		|
;|									|
;|		         	3     5     7     9     11		|
;|    	        	       x     x     x     x     x		|
;| (1) ln((x-1)/(x+1))= 2(x + --- + --- + --- + --- + --- ...)		|
;|	        	       3     5     7     9    11		|
;|									|
;| but because speed reason the equation (1) is rewriten as following	|
;|			  						|
;|			       2  1     2  1     2  1     2  1     2	|
;| (2) ln((x-1)/(x+1))=2x(1 + x (--- + x (--- + x (--- + x (--- + x (..	|
;|			          3        5        7        9		|
;|									|
;| using equation (2) reduced the number of computations because all    |
;| exponents of x is power of 2 except first x and for each serie term	|
;| only a multiply and a sun is need.					|
;|									|
;| the number of terms to obtain a precision of 19 digits are 15 and 	|
;| inverse constants are store in memory.				|
;|									|
;+----------------------------------------------------------------------+

#ifndef __MATH_FLOAT_LOG_NATURAL_SERIE__
	
	#define __MATH_FLOAT_LOG_NATURAL_SERIE__
	
	.EQU	_DFMACS_ADDR_LN_OP2_0	= 8	;address of op2_0 ; must be altered if op2_0 definitions change

	;+----------------------+
	;| NECESSARY INCLUDES	|
	;+----------------------+

	#ifndef __MATH_FLOAT_INFINIT__
		.INCLUDE	"MATH\FLOAT_DOUBLE\INFINIT_RESULT\DFINF.hug"
	#endif

	#ifndef __MATH_FLOAT_NORMALIZE__
		.INCLUDE	"MATH\FLOAT_DOUBLE\NORMALIZE\DFNORM.hug"
	#endif

	#ifndef __MATH_FLOAT_ADDSUB__
		.INCLUDE	"MATH\FLOAT_DOUBLE\ADDSUB\DFADDSUB.hug"
	#endif

	#ifndef __MATH_FLOAT_MULDIV__
		.INCLUDE	"MATH\FLOAT_DOUBLE\MULDIV\DFMULDIV.hug"
	#endif

	#ifndef __MATH_FLOAT_UNARY__
		.INCLUDE	"MATH\FLOAT_DOUBLE\UNARY\UNARY.hug"
	#endif

	#ifndef __MATH_FLOAT_LOAD_STORE__
		.INCLUDE	"MATH\FLOAT_DOUBLE\LOAD_STORE\DFLDXSTX.hug"
	#endif

	#ifndef __MATH_FLOAT_COMPARE__
		.INCLUDE	"MATH\FLOAT_DOUBLE\COMPARE\DFCPM.hug"
	#endif

	_DFSERLN:
		push	ZL					;save Z
		push	ZH
		push	YL					;save Y
		push	YH
		call 	_DFACCOP1				;mov op1=op2=X
		call 	_DFACCOP2
		push	_acc_0					;save X
		push	_acc_1
		push	_acc_2
		push	_acc_3
		push	_acc_4
		push	_acc_5
		push	_acc_s
		push	_acc_e
		call 	_DFMUL					;calcute X^2
		ldi	Acc,0x80				;change X^2 signal
		eor	_acc_s,Acc
		ldi	ZL,low(_DF_MAC)
		ldi	ZH,high(_DF_MAC)
		call 	_DFSTZ					;store into DF_MAC=-X^2
		ldi	ZL,low(_DFLN_TABLE*2)			;get first parm
		ldi	ZH,high(_DFLN_TABLE*2)
		ldi	YL,low(_DF_P10)				;DF_P10=S=First constant
		ldi	YH,high(_DF_P10)
		call 	_DFLNS_GETCONSTANT			;get constant
		ldi	Acc,11					;number of constants
	_DFLN_LOOP:
		push	Acc					;save constant counter
		push	ZL					;save constant pointer
		push	ZH
		ldi	ZL,low(_DF_P10)				;Z-->DF_P10=S
		ldi	ZH,high(_DF_P10)
		call 	_DFLDOP1Z				;op1=S
		ldi	ZL,low(_DF_MAC)				;Z-->DF_MAC=X^2
		ldi	ZH,high(_DF_MAC)
		call 	_DFLDOP2Z				;op2=X^2
		call 	_DFMUL					;S*X^2
		pop	ZH					;restore constant pointer
		pop	ZL
		ldi	YL,low(_DFMACS_ADDR_OP2_0)		;get FAT(acc)
		ldi	YH,high(_DFMACS_ADDR_OP2_0)
		call 	_DFSERS_GETCONSTANT			;op2=constant
		call 	_DFACCOP1				;op1=S*X^2
		call 	_DFADD					;S*X^2+FAT(Acc)
		push	ZL					;save constant pointer again
		push	ZH
		ldi	ZL,low(_DF_P10)				;Z-->DF_P10=S
		ldi	ZH,high(_DF_P10)
		call 	_DFSTZ					;S=S*X^2+FAT(Acc)
		pop	ZH					;restore constant pointer
		pop	ZL
		pop	Acc					;restore constant counter
		dec	Acc
		brne	_DFLN_LOOP				;until all done
		ldi	ZL,low(_DF_P10)				;Z-->DF_P10=S
		ldi	ZH,high(_DF_P10)
		call 	_DFLDOP1Z				;op1=S
		pop	_op2_e					;op2=X
		pop	_op2_s
		pop	_op2_5
		pop	_op2_4
		pop	_op2_3
		pop	_op2_2
		pop	_op2_1
		pop	_op2_0
		call 	_DFMUL					;Facc=S*X
		ldi	Acc,_FPOK
		pop	YH					;restore Y
		pop	YL
		pop	ZH					;restore Z
		pop	ZL
		ret
	
	;+----------------------------------------------+
	;| GET CONSTANT POINTED BY REGISTER Z AND STORE |
	;| INTO SRAM POINTED BY REGISTER Y		|
	;+----------------------------------------------+
	_DFLNS_GETCONSTANT:
		ldi	Acc,8					;byte counter
	_DFLNS_G00:
		lpm						;get data from constant data into flash
		st	Y+,r0					;store into sram
		adiw	ZL,1
		dec	Acc					;next data
		brne	_DFLNS_G00				;until done
		ret
	
	;+----------------------------------------------+
	;| DOUBLE PRECISION INVERSE FACTORIAL TABLE	|
	;+----------------------------------------------+
	_DFLN_TABLE:
	;
	;	     lsb        mantisa           msb   exp
	;.........../---------------------------------\/--\
		.DB 0xcc,0xc0,0xb1,0x98,0xa0,0x0d,0x3b,0x36 	;1/29 = 3,8681701706306840377169119315228e-23
		.DB 0xcc,0xc0,0xb1,0x98,0xa0,0x0d,0x3b,0x36 	;1/27 = 3,8681701706306840377169119315228e-23
		.DB 0xcc,0xc0,0xb1,0x98,0xa0,0x0d,0x3b,0x36 	;1/25 = 3,8681701706306840377169119315228e-23
		.DB 0xcc,0xc0,0xb1,0x98,0xa0,0x0d,0x3b,0x36 	;1/23 = 3,8681701706306840377169119315228e-23
		.DB 0x8c,0xab,0xe7,0xb6,0x77,0xdc,0x38,0x3f 	;1/21 = 1,9572941063391261230847574373505e-20
		.DB 0xb9,0x0a,0x0a,0x34,0xda,0xa4,0x17,0x48 	;1/19 = 8,2206352466243297169559812368723e-18
		.DB 0x53,0x6a,0x85,0x81,0x3b,0x96,0x4a,0x50 	;1/17 = 2,8114572543455207631989455830103e-15
		.DB 0xf8,0xc0,0x9d,0x39,0x9f,0x3f,0x57,0x58 	;1/15= 7,6471637318198164759011319857881e-13
		.DB 0x4b,0x68,0x43,0x9d,0x30,0x92,0x30,0x60 	;1/13 = 1,6059043836821614599392377170155e-10
		.DB 0x1c,0x27,0xaa,0x3f,0x2b,0x32,0x57,0x67 	;1/11 = 2,5052108385441718775052108385442e-8
		.DB 0x9c,0x39,0xb6,0x2a,0x1d,0xef,0x38,0x6e 	;1/9  = 2,7557319223985890652557319223986e-6
		.DB 0xd0,0x00,0x0d,0xd0,0x00,0x0d,0x50,0x74 	;1/7  = 0,0001984126984126984126984126984127
		.DB 0x88,0x88,0x88,0x88,0x88,0x88,0x08,0x7a 	;1/5  = 0,0083333333333333333333333333333333
		.DB 0xaa,0xaa,0xaa,0xaa,0xaa,0xaa,0x2a,0x7e 	;1/3  = 0,16666666666666666666666666666667
		.DB 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x81	;1/1  = 1
	
#endif

.exit