sinus.c

at91rm9200 的rom程序

//*--------------------------------------------------------------------------------------
//* Function Name       : sinus.c
//* Object              : Sinus table
//* Input Parameters    :
//* Output Parameters   :
//*--------------------------------------------------------------------------------------

//* sinus table : 256 values for 180 degres
const short AT91C_SINUS180_TAB[256] =
{
	0x0000, 0x0192, 0x0324, 0x04B6,
	0x0648, 0x07D9, 0x096A, 0x0AFB,
	0x0C8C, 0x0E1C, 0x0FAB, 0x113A,
	0x12C8, 0x1455, 0x15E2, 0x176E,
	0x18F9, 0x1A82, 0x1C0B, 0x1D93,
	0x1F1A, 0x209F, 0x2223, 0x23A6,
	0x2528, 0x26A8, 0x2826, 0x29A3,
	0x2B1F, 0x2C99, 0x2E11, 0x2F87,
	0x30FB, 0x326E, 0x33DF, 0x354D,
	0x36BA, 0x3824, 0x398C, 0x3AF2,
	0x3C56, 0x3DB8, 0x3F17, 0x4073,
	0x41CE, 0x4325, 0x447A, 0x45CD,
	0x471C, 0x4869, 0x49B4, 0x4AFB,
	0x4C3F, 0x4D81, 0x4EBF, 0x4FFB,
	0x5133, 0x5268, 0x539B, 0x54C9,
	0x55F5, 0x571D, 0x5842, 0x5964,
	0x5A82, 0x5B9C, 0x5CB3, 0x5DC7,
	0x5ED7, 0x5FE3, 0x60EB, 0x61F0,
	0x62F1, 0x63EE, 0x64E8, 0x65DD,
	0x66CF, 0x67BC, 0x68A6, 0x698B,
	0x6A6D, 0x6B4A, 0x6C23, 0x6CF8,
	0x6DC9, 0x6E96, 0x6F5E, 0x7022,
	0x70E2, 0x719D, 0x7254, 0x7307,
	0x73B5, 0x745F, 0x7504, 0x75A5,
	0x7641, 0x76D8, 0x776B, 0x77FA,
	0x7884, 0x7909, 0x7989, 0x7A05,
	0x7A7C, 0x7AEE, 0x7B5C, 0x7BC5,
	0x7C29, 0x7C88, 0x7CE3, 0x7D39,
	0x7D89, 0x7DD5, 0x7E1D, 0x7E5F,
	0x7E9C, 0x7ED5, 0x7F09, 0x7F37,
	0x7F61, 0x7F86, 0x7FA6, 0x7FC1,
	0x7FD8, 0x7FE9, 0x7FF5, 0x7FFD,
	0x7FFF, 0x7FFD, 0x7FF5, 0x7FE9,
	0x7FD8, 0x7FC1, 0x7FA6, 0x7F86,
	0x7F61, 0x7F37, 0x7F09, 0x7ED5,
	0x7E9C, 0x7E5F, 0x7E1D, 0x7DD5,
	0x7D89, 0x7D39, 0x7CE3, 0x7C88,
	0x7C29, 0x7BC5, 0x7B5C, 0x7AEE,
	0x7A7C, 0x7A05, 0x7989, 0x7909,
	0x7884, 0x77FA, 0x776B, 0x76D8,
	0x7641, 0x75A5, 0x7504, 0x745F,
	0x73B5, 0x7307, 0x7254, 0x719D,
	0x70E2, 0x7022, 0x6F5E, 0x6E96,
	0x6DC9, 0x6CF8, 0x6C23, 0x6B4A,
	0x6A6D, 0x698B, 0x68A6, 0x67BC,
	0x66CF, 0x65DD, 0x64E8, 0x63EE,
	0x62F1, 0x61F0, 0x60EB, 0x5FE3,
	0x5ED7, 0x5DC7, 0x5CB3, 0x5B9C,
	0x5A82, 0x5964, 0x5842, 0x571D,
	0x55F5, 0x54C9, 0x539B, 0x5268,
	0x5133, 0x4FFB, 0x4EBF, 0x4D81,
	0x4C3F, 0x4AFB, 0x49B4, 0x4869,
	0x471C, 0x45CD, 0x447A, 0x4325,
	0x41CE, 0x4073, 0x3F17, 0x3DB8,
	0x3C56, 0x3AF2, 0x398C, 0x3824,
	0x36BA, 0x354D, 0x33DF, 0x326E,
	0x30FB, 0x2F87, 0x2E11, 0x2C99,
	0x2B1F, 0x29A3, 0x2826, 0x26A8,
	0x2528, 0x23A6, 0x2223, 0x209F,
	0x1F1A, 0x1D93, 0x1C0B, 0x1A82,
	0x18F9, 0x176E, 0x15E2, 0x1455,
	0x12C8, 0x113A, 0x0FAB, 0x0E1C,
	0x0C8C, 0x0AFB, 0x096A, 0x07D9,
	0x0648, 0x04B6, 0x0324, 0x0192,
};



//*----------------------------------------------------------------------------
//* Function Name       : AT91F_Sinus
//* Object              : return Sine step
//* Input Parameters    : <step> int
//*                       
//* Output Parameters   : Sine of angle
//*----------------------------------------------------------------------------
short AT91F_Sinus(int step)
{
	if (step <= 255)
		return(AT91C_SINUS180_TAB[step]);
	else
		return(-AT91C_SINUS180_TAB[step % 256]);
}