cosine.c

TI的DSP C55X的应用程序

/*
        cosine.c - table lookup cosine function
                input: angle (0 - 0x7fff) or (0 - 360 degree)
                output: return cos(angle) in Q15 format
*/

int cos_tab[1024]={
0x7fff, 0x7ffe, 0x7ffc, 0x7ff9, 0x7ff5, 0x7fef, 0x7fe8, 0x7fe0, 0x7fd7,
0x7fcd, 0x7fc1, 0x7fb4, 0x7fa6, 0x7f96, 0x7f86, 0x7f74, 0x7f61, 0x7f4c,
0x7f37, 0x7f20, 0x7f08, 0x7eef, 0x7ed4, 0x7eb9, 0x7e9c, 0x7e7e, 0x7e5e,
0x7e3e, 0x7e1c, 0x7df9, 0x7dd5, 0x7daf, 0x7d89, 0x7d61, 0x7d38, 0x7d0e,
0x7ce2, 0x7cb6, 0x7c88, 0x7c59, 0x7c28, 0x7bf7, 0x7bc4, 0x7b91, 0x7b5b,
0x7b25, 0x7aee, 0x7ab5, 0x7a7b, 0x7a41, 0x7a04, 0x79c7, 0x7989, 0x7949,
0x7908, 0x78c6, 0x7883, 0x783f, 0x77f9, 0x77b3, 0x776b, 0x7722, 0x76d8,
0x768c, 0x7640, 0x75f3, 0x75a4, 0x7554, 0x7503, 0x74b1, 0x745e, 0x740a,
0x73b4, 0x735e, 0x7306, 0x72ad, 0x7254, 0x71f9, 0x719d, 0x713f, 0x70e1,
0x7082, 0x7021, 0x6fc0, 0x6f5d, 0x6efa, 0x6e95, 0x6e2f, 0x6dc8, 0x6d61,
0x6cf8, 0x6c8e, 0x6c23, 0x6bb6, 0x6b49, 0x6adb, 0x6a6c, 0x69fc, 0x698a,
0x6918, 0x68a5, 0x6831, 0x67bb, 0x6745, 0x66ce, 0x6656, 0x65dc, 0x6562,
0x64e7, 0x646b, 0x63ed, 0x636f, 0x62f0, 0x6270, 0x61ef, 0x616d, 0x60ea,
0x6067, 0x5fe2, 0x5f5c, 0x5ed6, 0x5e4e, 0x5dc6, 0x5d3d, 0x5cb2, 0x5c27,
0x5b9b, 0x5b0e, 0x5a81, 0x59f2, 0x5963, 0x58d2, 0x5841, 0x57af, 0x571c,
0x5688, 0x55f4, 0x555e, 0x54c8, 0x5431, 0x5399, 0x5301, 0x5267, 0x51cd,
0x5132, 0x5096, 0x4ffa, 0x4f5c, 0x4ebe, 0x4e1f, 0x4d80, 0x4cdf, 0x4c3e,
0x4b9c, 0x4afa, 0x4a56, 0x49b2, 0x490d, 0x4868, 0x47c2, 0x471b, 0x4674,
0x45cb, 0x4522, 0x4479, 0x43cf, 0x4324, 0x4278, 0x41cc, 0x411f, 0x4072,
0x3fc4, 0x3f15, 0x3e66, 0x3db6, 0x3d06, 0x3c55, 0x3ba3, 0x3af1, 0x3a3e,
0x398b, 0x38d7, 0x3823, 0x376e, 0x36b8, 0x3602, 0x354c, 0x3495, 0x33dd,
0x3325, 0x326c, 0x31b3, 0x30fa, 0x3040, 0x2f85, 0x2eca, 0x2e0f, 0x2d53,
0x2c97, 0x2bda, 0x2b1d, 0x2a60, 0x29a2, 0x28e3, 0x2825, 0x2766, 0x26a6,
0x25e6, 0x2526, 0x2465, 0x23a5, 0x22e3, 0x2222, 0x2160, 0x209d, 0x1fdb,
0x1f18, 0x1e55, 0x1d91, 0x1cce, 0x1c09, 0x1b45, 0x1a81, 0x19bc, 0x18f7,
0x1831, 0x176c, 0x16a6, 0x15e0, 0x151a, 0x1453, 0x138d, 0x12c6, 0x11ff,
0x1138, 0x1071, 0xfa9, 0xee1, 0xe1a, 0xd52, 0xc8a, 0xbc2, 0xaf9,
0xa31, 0x968, 0x8a0, 0x7d7, 0x70f, 0x646, 0x57d, 0x4b4, 0x3eb,
0x322, 0x259, 0x190, 0xc7, 0xffff, 0xff36, 0xfe6d, 0xfda4, 0xfcdb,
0xfc12, 0xfb49, 0xfa80, 0xf9b7, 0xf8ee, 0xf826, 0xf75d, 0xf694, 0xf5cc,
0xf504, 0xf43b, 0xf373, 0xf2ab, 0xf1e3, 0xf11b, 0xf054, 0xef8c, 0xeec5,
0xedfe, 0xed37, 0xec70, 0xeba9, 0xeae3, 0xea1d, 0xe957, 0xe891, 0xe7cc,
0xe706, 0xe641, 0xe57c, 0xe4b8, 0xe3f3, 0xe32f, 0xe26c, 0xe1a8, 0xe0e5,
0xe022, 0xdf60, 0xde9d, 0xdddb, 0xdd1a, 0xdc58, 0xdb98, 0xdad7, 0xda17,
0xd957, 0xd897, 0xd7d8, 0xd71a, 0xd65b, 0xd59d, 0xd4e0, 0xd423, 0xd366,
0xd2aa, 0xd1ee, 0xd133, 0xd078, 0xcfbd, 0xcf03, 0xce4a, 0xcd91, 0xccd8,
0xcc20, 0xcb69, 0xcab2, 0xc9fb, 0xc945, 0xc88f, 0xc7db, 0xc726, 0xc672,
0xc5bf, 0xc50c, 0xc45a, 0xc3a8, 0xc2f7, 0xc247, 0xc197, 0xc0e8, 0xc039,
0xbf8b, 0xbede, 0xbe31, 0xbd85, 0xbcd9, 0xbc2f, 0xbb84, 0xbadb, 0xba32,
0xb98a, 0xb8e2, 0xb83c, 0xb795, 0xb6f0, 0xb64b, 0xb5a7, 0xb504, 0xb461,
0xb3bf, 0xb31e, 0xb27e, 0xb1de, 0xb13f, 0xb0a1, 0xb004, 0xaf67, 0xaecc,
0xae31, 0xad96, 0xacfd, 0xac64, 0xabcc, 0xab35, 0xaa9f, 0xaa0a, 0xa975,
0xa8e2, 0xa84f, 0xa7bd, 0xa72b, 0xa69b, 0xa60c, 0xa57d, 0xa4ef, 0xa462,
0xa3d7, 0xa34b, 0xa2c1, 0xa238, 0xa1b0, 0xa128, 0xa0a2, 0xa01c, 0x9f97,
0x9f13, 0x9e91, 0x9e0f, 0x9d8e, 0x9d0e, 0x9c8f, 0x9c11, 0x9b93, 0x9b17,
0x9a9c, 0x9a22, 0x99a9, 0x9930, 0x98b9, 0x9843, 0x97ce, 0x9759, 0x96e6,
0x9674, 0x9603, 0x9592, 0x9523, 0x94b5, 0x9448, 0x93dc, 0x9371, 0x9307,
0x929e, 0x9236, 0x91cf, 0x9169, 0x9105, 0x90a1, 0x903f, 0x8fdd, 0x8f7d,
0x8f1d, 0x8ebf, 0x8e62, 0x8e06, 0x8dab, 0x8d51, 0x8cf8, 0x8ca1, 0x8c4a,
0x8bf5, 0x8ba1, 0x8b4e, 0x8afb, 0x8aab, 0x8a5b, 0x8a0c, 0x89bf, 0x8972,
0x8927, 0x88dd, 0x8894, 0x884c, 0x8806, 0x87c0, 0x877c, 0x8739, 0x86f7,
0x86b6, 0x8676, 0x8638, 0x85fb, 0x85bf, 0x8584, 0x854a, 0x8511, 0x84da,
0x84a4, 0x846f, 0x843b, 0x8408, 0x83d7, 0x83a7, 0x8378, 0x834a, 0x831d,
0x82f2, 0x82c7, 0x829e, 0x8277, 0x8250, 0x822b, 0x8206, 0x81e3, 0x81c2,
0x81a1, 0x8182, 0x8164, 0x8147, 0x812b, 0x8111, 0x80f8, 0x80e0, 0x80c9,
0x80b3, 0x809f, 0x808c, 0x807a, 0x8069, 0x805a, 0x804c, 0x803f, 0x8033,
0x8029, 0x8020, 0x8018, 0x8011, 0x800b, 0x8007, 0x8004, 0x8002, 0x8001,
0x8002, 0x8004, 0x8007, 0x800b, 0x8011, 0x8018, 0x8020, 0x8029, 0x8034,
0x803f, 0x804c, 0x805b, 0x806a, 0x807b, 0x808c, 0x80a0, 0x80b4, 0x80ca,
0x80e0, 0x80f8, 0x8112, 0x812c, 0x8148, 0x8165, 0x8183, 0x81a2, 0x81c3,
0x81e4, 0x8207, 0x822c, 0x8251, 0x8278, 0x82a0, 0x82c9, 0x82f3, 0x831e,
0x834b, 0x8379, 0x83a8, 0x83d8, 0x840a, 0x843c, 0x8470, 0x84a5, 0x84dc,
0x8513, 0x854c, 0x8585, 0x85c0, 0x85fd, 0x863a, 0x8678, 0x86b8, 0x86f9,
0x873b, 0x877e, 0x87c2, 0x8808, 0x884f, 0x8896, 0x88df, 0x8929, 0x8975,
0x89c1, 0x8a0f, 0x8a5d, 0x8aad, 0x8afe, 0x8b50, 0x8ba3, 0x8bf8, 0x8c4d,
0x8ca4, 0x8cfb, 0x8d54, 0x8dae, 0x8e09, 0x8e65, 0x8ec2, 0x8f20, 0x8f80,
0x8fe0, 0x9042, 0x90a4, 0x9108, 0x916d, 0x91d2, 0x9239, 0x92a1, 0x930a,
0x9374, 0x93df, 0x944b, 0x94b8, 0x9527, 0x9596, 0x9606, 0x9677, 0x96ea,
0x975d, 0x97d1, 0x9846, 0x98bd, 0x9934, 0x99ac, 0x9a26, 0x9aa0, 0x9b1b,
0x9b97, 0x9c14, 0x9c93, 0x9d12, 0x9d92, 0x9e13, 0x9e95, 0x9f18, 0x9f9b,
0xa020, 0xa0a6, 0xa12c, 0xa1b4, 0xa23c, 0xa2c6, 0xa350, 0xa3db, 0xa467,
0xa4f4, 0xa582, 0xa610, 0xa6a0, 0xa730, 0xa7c1, 0xa853, 0xa8e6, 0xa97a,
0xaa0e, 0xaaa4, 0xab3a, 0xabd1, 0xac69, 0xad02, 0xad9b, 0xae35, 0xaed0,
0xaf6c, 0xb009, 0xb0a6, 0xb144, 0xb1e3, 0xb283, 0xb323, 0xb3c4, 0xb466,
0xb509, 0xb5ac, 0xb650, 0xb6f5, 0xb79b, 0xb841, 0xb8e8, 0xb98f, 0xba37,
0xbae0, 0xbb8a, 0xbc34, 0xbcdf, 0xbd8a, 0xbe36, 0xbee3, 0xbf91, 0xc03f,
0xc0ed, 0xc19d, 0xc24c, 0xc2fd, 0xc3ae, 0xc460, 0xc512, 0xc5c5, 0xc678,
0xc72c, 0xc7e0, 0xc895, 0xc94b, 0xca01, 0xcab7, 0xcb6e, 0xcc26, 0xccde,
0xcd97, 0xce50, 0xcf09, 0xcfc3, 0xd07e, 0xd138, 0xd1f4, 0xd2b0, 0xd36c,
0xd429, 0xd4e6, 0xd5a3, 0xd661, 0xd720, 0xd7de, 0xd89d, 0xd95d, 0xda1d,
0xdadd, 0xdb9e, 0xdc5e, 0xdd20, 0xdde1, 0xdea3, 0xdf66, 0xe028, 0xe0eb,
0xe1ae, 0xe272, 0xe336, 0xe3fa, 0xe4be, 0xe582, 0xe647, 0xe70c, 0xe7d2,
0xe897, 0xe95d, 0xea23, 0xeae9, 0xebb0, 0xec76, 0xed3d, 0xee04, 0xeecb,
0xef93, 0xf05a, 0xf122, 0xf1e9, 0xf2b1, 0xf379, 0xf442, 0xf50a, 0xf5d2,
0xf69b, 0xf763, 0xf82c, 0xf8f5, 0xf9bd, 0xfa86, 0xfb4f, 0xfc18, 0xfce1,
0xfdaa, 0xfe73, 0xff3c, 0x4, 0xcd, 0x196, 0x25f, 0x328, 0x3f1,
0x4ba, 0x583, 0x64c, 0x715, 0x7de, 0x8a6, 0x96f, 0xa37, 0xb00,
0xbc8, 0xc90, 0xd58, 0xe20, 0xee8, 0xfaf, 0x1077, 0x113e, 0x1205,
0x12cc, 0x1393, 0x145a, 0x1520, 0x15e6, 0x16ac, 0x1772, 0x1838, 0x18fd,
0x19c2, 0x1a87, 0x1b4b, 0x1c10, 0x1cd4, 0x1d97, 0x1e5b, 0x1f1e, 0x1fe1,
0x20a3, 0x2166, 0x2228, 0x22e9, 0x23ab, 0x246b, 0x252c, 0x25ec, 0x26ac,
0x276c, 0x282b, 0x28e9, 0x29a8, 0x2a66, 0x2b23, 0x2be0, 0x2c9d, 0x2d59,
0x2e15, 0x2ed0, 0x2f8b, 0x3046, 0x3100, 0x31b9, 0x3272, 0x332b, 0x33e3,
0x349a, 0x3551, 0x3608, 0x36be, 0x3773, 0x3828, 0x38dd, 0x3991, 0x3a44,
0x3af7, 0x3ba9, 0x3c5a, 0x3d0b, 0x3dbc, 0x3e6c, 0x3f1b, 0x3fc9, 0x4077,
0x4125, 0x41d2, 0x427e, 0x4329, 0x43d4, 0x447e, 0x4528, 0x45d1, 0x4679,
0x4720, 0x47c7, 0x486d, 0x4913, 0x49b7, 0x4a5b, 0x4aff, 0x4ba1, 0x4c43,
0x4ce4, 0x4d85, 0x4e24, 0x4ec3, 0x4f61, 0x4ffe, 0x509b, 0x5137, 0x51d2,
0x526c, 0x5305, 0x539e, 0x5436, 0x54cd, 0x5563, 0x55f9, 0x568d, 0x5721,
0x57b4, 0x5846, 0x58d7, 0x5967, 0x59f7, 0x5a85, 0x5b13, 0x5ba0, 0x5c2c,
0x5cb7, 0x5d41, 0x5dca, 0x5e53, 0x5eda, 0x5f61, 0x5fe6, 0x606b, 0x60ef,
0x6171, 0x61f3, 0x6274, 0x62f4, 0x6373, 0x63f1, 0x646f, 0x64eb, 0x6566,
0x65e0, 0x6659, 0x66d2, 0x6749, 0x67bf, 0x6834, 0x68a9, 0x691c, 0x698e,
0x69ff, 0x6a6f, 0x6adf, 0x6b4d, 0x6bba, 0x6c26, 0x6c91, 0x6cfb, 0x6d64,
0x6dcc, 0x6e32, 0x6e98, 0x6efd, 0x6f60, 0x6fc3, 0x7024, 0x7085, 0x70e4,
0x7142, 0x719f, 0x71fb, 0x7256, 0x72b0, 0x7309, 0x7361, 0x73b7, 0x740c,
0x7461, 0x74b4, 0x7506, 0x7557, 0x75a6, 0x75f5, 0x7643, 0x768f, 0x76da,
0x7724, 0x776d, 0x77b5, 0x77fb, 0x7841, 0x7885, 0x78c8, 0x790a, 0x794b,
0x798b, 0x79c9, 0x7a06, 0x7a42, 0x7a7d, 0x7ab7, 0x7af0, 0x7b27, 0x7b5d,
0x7b92, 0x7bc6, 0x7bf9, 0x7c2a, 0x7c5a, 0x7c89, 0x7cb7, 0x7ce4, 0x7d0f,
0x7d39, 0x7d62, 0x7d8a, 0x7db1, 0x7dd6, 0x7dfa, 0x7e1d, 0x7e3f, 0x7e5f,
0x7e7f, 0x7e9d, 0x7eba, 0x7ed5, 0x7ef0, 0x7f09, 0x7f21, 0x7f38, 0x7f4d,
0x7f61, 0x7f74, 0x7f86, 0x7f97, 0x7fa6, 0x7fb4, 0x7fc1, 0x7fcd, 0x7fd7,
0x7fe1, 0x7fe9, 0x7fef, 0x7ff5, 0x7ff9, 0x7ffc, 0x7ffe };


int cosine(int);


int cosine(int angle)
{
    int index;
    index = (angle>>5)&0x7ff;   /* Form table index */
    return (cos_tab[index]);    /* Return cos(angle) */
    
}