|
|
@@ -0,0 +1,113 @@
|
|
|
+#include "math/fix_math.h"
|
|
|
+
|
|
|
+/* Auto gen by my tools, and use matlab to desing a FIR filter-(MC100/Simulink/Fir_angle.m) */
|
|
|
+/* Matlib Command: Fir=Fir_angle; angle_off=filter(Fir.Numerator, 1, angle_in); */
|
|
|
+/* angle_in is the data, by plot MC_tools */
|
|
|
+/* Use angle_out=single(angle_off) convert double to float */
|
|
|
+
|
|
|
+#define FIR_PHASE_SHIFT 277
|
|
|
+const static s16q10_t _encoder_off_map[] = {
|
|
|
+10578,10567,10558,10548,10539,10531,10522,10515,10507,10500,10494,10487,10482,10476,10471,10467,
|
|
|
+10462,10459,10455,10452,10450,10448,10446,10444,10443,10443,10443,10443,10443,10444,10446,10447,10449,10452,10455,10458,
|
|
|
+10462,10465,10470,10475,10480,10485,10491,10497,10504,10511,10518,10526,10534,10542,10550,10559,10569,10578,10588,10599,
|
|
|
+10609,10620,10632,10643,10655,10668,10680,10693,10707,10720,10734,10748,10763,10778,10793,10808,10824,10840,10856,10873,
|
|
|
+10889,10906,10924,10942,10960,10978,10996,11015,11034,11054,11073,11093,11114,11134,11155,11176,11197,11218,11240,11262,
|
|
|
+11284,11307,11329,11352,11376,11399,11423,11447,11471,11495,11520,11545,11570,11595,11621,11647,11673,11699,11726,11752,
|
|
|
+11779,11806,11834,11861,11889,11917,11946,11974,12003,12032,12061,12090,12120,12149,12179,12209,12239,12270,12301,12332,
|
|
|
+12363,12394,12425,12457,12489,12521,12553,12585,12618,12651,12684,12717,12750,12783,12817,12851,12885,12919,12953,12987,
|
|
|
+13022,13056,13091,13126,13161,13196,13232,13267,13303,13339,13374,13410,13446,13483,13519,13555,13592,13628,13665,13702,
|
|
|
+13739,13776,13813,13850,13887,13924,13962,13999,14036,14074,14111,14149,14186,14224,14261,14299,14337,14374,14412,14449,
|
|
|
+14487,14525,14562,14600,14637,14675,14712,14750,14787,14824,14861,14899,14936,14973,15010,15046,15083,15120,15156,15192,
|
|
|
+15229,15265,15301,15337,15372,15408,15443,15478,15513,15548,15583,15617,15651,15685,15719,15753,15786,15819,15852,15885,
|
|
|
+15917,15949,15981,16013,16044,16075,16106,16136,16166,16196,16226,16255,16284,16312,16340,16368,16396,16423,16450,16476,
|
|
|
+16502,16528,16553,16578,16602,16626,16650,16673,16696,16718,16740,16761,16782,16803,16823,16843,16862,16881,16899,16917,
|
|
|
+16934,16951,16968,16984,16999,17014,17028,17042,17056,17068,17081,17093,17104,17115,17125,17135,17144,17153,17161,17169,
|
|
|
+17176,17182,17188,17194,17198,17203,17207,17210,17213,17215,17216,17217,17218,17218,17217,17216,17214,17212,17209,17206,
|
|
|
+17202,17198,17192,17187,17181,17174,17167,17159,17151,17142,17133,17123,17112,17101,17089,17077,17065,17052,17038,17024,
|
|
|
+17009,16994,16978,16962,16945,16928,16911,16892,16874,16854,16835,16815,16794,16773,16751,16729,16707,16684,16661,16637,
|
|
|
+16612,16588,16563,16537,16511,16485,16458,16431,16404,16376,16347,16319,16290,16260,16230,16200,16170,16139,16108,16076,
|
|
|
+16044,16012,15979,15947,15914,15880,15847,15813,15778,15744,15709,15674,15639,15603,15567,15531,15495,15459,15422,15385,
|
|
|
+15348,15311,15273,15235,15197,15159,15121,15083,15044,15006,14967,14928,14889,14850,14811,14771,14732,14692,14652,14613,
|
|
|
+14573,14533,14493,14453,14413,14372,14332,14292,14252,14212,14171,14131,14091,14050,14010,13970,13929,13889,13849,13809,
|
|
|
+13769,13728,13688,13648,13608,13569,13529,13489,13449,13410,13370,13331,13292,13253,13214,13175,13136,13098,13059,13021,
|
|
|
+12983,12945,12907,12870,12832,12795,12758,12721,12684,12648,12611,12575,12539,12504,12468,12433,12398,12364,12329,12295,
|
|
|
+12261,12228,12194,12161,12128,12096,12063,12031,12000,11968,11937,11907,11876,11846,11816,11787,11758,11729,11701,11673,
|
|
|
+11645,11618,11591,11564,11538,11512,11487,11462,11437,11413,11389,11365,11342,11320,11298,11276,11254,11233,11213,11193,
|
|
|
+11173,11154,11135,11117,11099,11081,11064,11048,11032,11016,11001,10986,10972,10958,10945,10932,10920,10908,10896,10886,
|
|
|
+10875,10865,10856,10847,10838,10830,10823,10816,10809,10803,10798,10793,10788,10784,10780,10777,10775,10773,10771,10770,
|
|
|
+10770,10770,10770,10771,10772,10774,10776,10779,10783,10786,10791,10795,10801,10806,10812,10819,10826,10834,10842,10850,
|
|
|
+10859,10869,10879,10889,10900,10911,10922,10934,10947,10960,10973,10987,11001,11016,11031,11046,11062,11078,11095,11112,
|
|
|
+11129,11147,11165,11184,11203,11222,11241,11261,11282,11302,11323,11345,11366,11388,11410,11433,11455,11479,11502,11526,
|
|
|
+11550,11574,11598,11623,11648,11674,11699,11725,11751,11777,11804,11830,11857,11884,11911,11939,11966,11994,12022,12050,
|
|
|
+12078,12107,12135,12164,12193,12222,12251,12280,12310,12339,12368,12398,12428,12457,12487,12517,12547,12577,12607,12637,
|
|
|
+12667,12697,12727,12757,12787,12817,12848,12878,12908,12938,12968,12998,13028,13058,13088,13117,13147,13177,13206,13236,
|
|
|
+13265,13295,13324,13353,13382,13411,13440,13469,13497,13526,13554,13582,13610,13638,13666,13693,13721,13748,13775,13802,
|
|
|
+13828,13855,13881,13907,13933,13959,13985,14010,14035,14060,14085,14109,14133,14157,14181,14205,14228,14251,14274,14297,
|
|
|
+14319,14341,14363,14385,14406,14427,14448,14469,14489,14509,14529,14548,14568,14587,14605,14624,14642,14660,14678,14695,
|
|
|
+14712,14729,14745,14762,14778,14793,14809,14824,14839,14853,14868,14882,14895,14909,14922,14935,14947,14960,14972,14984,
|
|
|
+14995,15006,15017,15028,15038,15048,15058,15067,15077,15086,15094,15103,15111,15119,15126,15133,15140,15147,15154,15160,
|
|
|
+15166,15171,15177,15182,15187,15191,15195,15199,15203,15207,15210,15213,15215,15218,15220,15222,15223,15225,15226,15227,
|
|
|
+15227,15228,15227,15227,15227,15226,15225,15224,15222,15220,15218,15216,15213,15210,15207,15203,15200,15196,15192,15187,
|
|
|
+15182,15177,15172,15166,15161,15154,15148,15141,15134,15127,15120,15112,15104,15096,15087,15078,15069,15060,15050,15040,
|
|
|
+15030,15019,15009,14998,14986,14975,14963,14951,14938,14925,14912,14899,14885,14872,14857,14843,14828,14813,14798,14782,
|
|
|
+14766,14750,14734,14717,14700,14683,14665,14647,14629,14611,14592,14573,14553,14534,14514,14494,14474,14453,14432,14411,
|
|
|
+14389,14367,14345,14323,14300,14278,14254,14231,14207,14184,14159,14135,14110,14085,14060,14035,14009,13984,13957,13931,
|
|
|
+13905,13878,13851,13824,13796,13769,13741,13713,13685,13656,13628,13599,13570,13541,13512,13482,13453,13423,13393,13363,
|
|
|
+13333,13302,13272,13241,13211,13180,13149,13118,13087,13056,13025,12993,12962,12930,12899,12867,12836,12804,12772,12741,
|
|
|
+12709,12677,12646,12614,12582,12551,12519,12487,12456,12424,12393,12361,12330,12298,12267,12236,12205,12174,12143,12112,
|
|
|
+12082,12051,12021,11990,11960,11930,11901,11871,11841,11812,11783,11754,11725,11697,11668,11640,11612,11584,11557,11530,
|
|
|
+11503,11476,11449,11423,11397,11372,11346,11321,11296,11272,11247,11223,11199,11176,11153,11130,11108,11086,11064,11042,
|
|
|
+11021,11000,10980,10960,10940,10920,10901,10883,10865,10847,10829,10812,10795,10778,10762,10747,10731,10716,10702,10687,
|
|
|
+10674,10660,10647,10635,10622,10611,10599,10588,10578,10567,10558,10548,10539,10531,10522,10515,10507,10500,10494,10487,
|
|
|
+10482,10476,10471,10467,10462,10459,10455,10452,10450,10448,10446,10444,10443,10443,10443,10443,10443,10444,10446,10447,
|
|
|
+10449,10452,10455,10458,10462,10465,10470,10475,10480,10485,10491,10497,10504,10511,10518,10526,10534,10542,10550,10559,
|
|
|
+10569,10578,10588,10599,10609,10620,10632,10643,10655,10668,10680,10693,10707,10720,10734,10748,10763,10778,10793,10808,
|
|
|
+10824,10840,10856,10873,10889,10906,10924,10942,10960,10978,10996,11015,11034,11054,11073,11093,11114,11134,11155,11176,
|
|
|
+11197,11218,11240,11262,11284,11307,11329,11352,11376,11399,11423,11447,11471,11495,11520,11545,11570,11595,11621,11647,
|
|
|
+11673,11699,11726,11752,11779,11806,11834,11861,11889,11917,11946,11974,12003,12032,12061,12090,12120,12149,12179,12209,
|
|
|
+12239,12270,12301,12332,12363,12394,12425,12457,12489,12521,12553,12585,12618,12651,12684,12717,12750,12783,12817,12851,
|
|
|
+12885,12919,12953,12987,13022,13056,13091,13126,13161,13196,13232,13267,13303,13339,13374,13410,13446,13483,13519,13555,
|
|
|
+13592,13628,13665,13702,13739,13776,13813,13850,13887,13924,13962,13999,14036,14074,14111,14149,14186,14224,14261,14299,
|
|
|
+14337,14374,14412,14449,14487,14525,14562,14600,14637,14675,14712,14750,14787,14824,14861,14899,14936,14973,15010,15046,
|
|
|
+15083,15120,15156,15192,15229,15265,15301,15337,15372,15408,15443,15478,15513,15548,15583,15617,15651,15685,15719,15753,
|
|
|
+15786,15819,15852,15885,15917,15949,15981,16013,16044,16075,16106,16136,16166,16196,16226,16255,16284,16312,16340,16368,
|
|
|
+16396,16423,16450,16476,16502,16528,16553,16578,16602,16626,16650,16673,16696,16718,16740,16761,16782,16803,16823,16843,
|
|
|
+16862,16881,16899,16917,16934,16951,16968,16984,16999,17014,17028,17042,17056,17068,17081,17093,17104,17115,17125,17135,
|
|
|
+17144,17153,17161,17169,17176,17182,17188,17194,17198,17203,17207,17210,17213,17215,17216,17217,17218,17218,17217,17216,
|
|
|
+17214,17212,17209,17206,17202,17198,17192,17187,17181,17174,17167,17159,17151,17142,17133,17123,17112,17101,17089,17077,
|
|
|
+17065,17052,17038,17024,17009,16994,16978,16962,16945,16928,16911,16892,16874,16854,16835,16815,16794,16773,16751,16729,
|
|
|
+16707,16684,16661,16637,16612,16588,16563,16537,16511,16485,16458,16431,16404,16376,16347,16319,16290,16260,16230,16200,
|
|
|
+16170,16139,16108,16076,16044,16012,15979,15947,15914,15880,15847,15813,15778,15744,15709,15674,15639,15603,15567,15531,
|
|
|
+15495,15459,15422,15385,15348,15311,15273,15235,15197,15159,15121,15083,15044,15006,14967,14928,14889,14850,14811,14771,
|
|
|
+14732,14692,14652,14613,14573,14533,14493,14453,14413,14372,14332,14292,14252,14212,14171,14131,14091,14050,14010,13970,
|
|
|
+13929,13889,13849,13809,13769,13728,13688,13648,13608,13569,13529,13489,13449,13410,13370,13331,13292,13253,13214,13175,
|
|
|
+13136,13098,13059,13021,12983,12945,12907,12870,12832,12795,12758,12721,12684,12648,12611,12575,12539,12504,12468,12433,
|
|
|
+12398,12364,12329,12295,12261,12228,12194,12161,12128,12096,12063,12031,12000,11968,11937,11907,11876,11846,11816,11787,
|
|
|
+11758,11729,11701,11673,11645,11618,11591,11564,11538,11512,11487,11462,11437,11413,11389,11365,11342,11320,11298,11276,
|
|
|
+11254,11233,11213,11193,11173,11154,11135,11117,11099,11081,11064,11048,11032,11016,11001,10986,10972,10958,10945,10932,
|
|
|
+10920,10908,10896,10886,10875,10865,10856,10847,10838,10830,10823,10816,10809,10803,10798,10793,10788,10784,10780,10777,
|
|
|
+10775,10773,10771,10770,10770,10770,10770,10771,10772,10774,10776,10779,10783,10786,10791,10795,10801,10806,10812,10819,
|
|
|
+10826,10834,10842,10850,10859,10869,10879,10889,10900,10911,10922,10934,10947,10960,10973,10987,11001,11016,11031,11046,
|
|
|
+11062,11078,11095,11112,11129,11147,11165,11184,11203,11222,11241,11261,11282,11302,11323,11345,11366,11388,11410,11433,
|
|
|
+11455,11479,11502,11526,11550,11574,11598,11623,11648,11674,11699,11725,11751,11777,11804,11830,11857,11884,11911,11939,
|
|
|
+11966,11994,12022,12050,12078,12107,12135,12164,12193,12222,12251,12280,12310,12339,12368,12398,12428,12457,12487,12517,
|
|
|
+12547,12577,12607,12637,12667,12697,12727,12757,12787,12817,12848,12878,12908,12938,12968,12998,13028,13058,13088,13117,
|
|
|
+13147,13177,13206,13236,13265,13295,13324,13353,13382,13411,13440,13469,13497,13526,13554,13582,13610,13638,13666,13693,
|
|
|
+13721,13748,13775,13802,13828,13855,13881,13907,13933,13959,13985,14010,14035,14060,14085,14109,14133,14157,14181,14205,
|
|
|
+14228,14251,14274,14297,14319,14341,14363,14385,14406,14427,14448,14469,14489,14509,14529,14548,14568,14587,14605,14624,
|
|
|
+14642,14660,14678,14695,14712,14729,14745,14762,14778,14793,14809,14824,14839,14853,14868,14882,14895,14909,14922,14935,
|
|
|
+14947,14960,14972,14984,14995,15006,15017,15028,15038,15048,15058,15067,15077,15086,15094,15103,15111,15119,15126,15133,
|
|
|
+15140,15147,15154,15160,15166,15171,15177,15182,15187,15191,15195,15199,15203,15207,15210,15213,15215,15218,15220,15222,
|
|
|
+15223,15225,15226,15227,15227,15228,15227,15227,15227,15226,15225,15224,15222,15220,15218,15216,15213,15210,15207,15203,
|
|
|
+15200,15196,15192,15187,15182,15177,15172,15166,15161,15154,15148,15141,15134,15127,15120,15112,15104,15096,15087,15078,
|
|
|
+15069,15060,15050,15040,15030,15019,15009,14998,14986,14975,14963,14951,14938,14925,14912,14899,14885,14872,14857,14843,
|
|
|
+14828,14813,14798,14782,14766,14750,14734,14717,14700,14683,14665,14647,14629,14611,14592,14573,14553,14534,14514,14494,
|
|
|
+14474,14453,14432,14411,14389,14367,14345,14323,14300,14278,14254,14231,14207,14184,14159,14135,14110,14085,14060,14035,
|
|
|
+14009,13984,13957,13931,13905,13878,13851,13824,13796,13769,13741,13713,13685,13656,13628,13599,13570,13541,13512,13482,
|
|
|
+13453,13423,13393,13363,13333,13302,13272,13241,13211,13180,13149,13118,13087,13056,13025,12993,12962,12930,12899,12867,
|
|
|
+12836,12804,12772,12741,12709,12677,12646,12614,12582,12551,12519,12487,12456,12424,12393,12361,12330,12298,12267,12236,
|
|
|
+12205,12174,12143,12112,12082,12051,12021,11990,11960,11930,11901,11871,11841,11812,11783,11754,11725,11697,11668,11640,
|
|
|
+11612,11584,11557,11530,11503,11476,11449,11423,11397,11372,11346,11321,11296,11272,11247,11223,11199,11176,11153,11130,
|
|
|
+11108,11086,11064,11042,11021,11000,10980,10960,10940,10920,10901,10883,10865,10847,10829,10812,10795,10778,10762,10747,
|
|
|
+10731,10716,10702,10687,10674,10660,10647,10635,10622,10611,10599,10588,
|
|
|
+};
|