/* * This file is part of the libopencm3 project. * * Copyright (C) 2010 Piotr Esden-Tempski * * This library is free software: you can redistribute it and/or modify * it under the terms of the GNU Lesser General Public License as published by * the Free Software Foundation, either version 3 of the License, or * (at your option) any later version. * * This library is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU Lesser General Public License for more details. * * You should have received a copy of the GNU Lesser General Public License * along with this library. If not, see . */ #include #include #include // #define COMPARE // #define MOVING_FADE #define KITT #ifdef COMPARE #define GAMMA_LINEAR #define GAMMA_1_3 #define GAMMA_2_5 #define GAMMA_3_0 #endif #ifdef MOVING_FADE #define GAMMA_2_2 #define GAMMA_TABLE gamma_table_2_2 #endif #ifdef KITT #define GAMMA_2_5 #define GAMMA_TABLE gamma_table_2_5 #endif /* * Gamma correction table * * The nonlinear tables are calculating with the function: * Iout = Iin ** gamma */ #ifdef GAMMA_LINEAR static const u16 gamma_table_linear[] = { 1, 4, 9, 17, 26, 37, 51, 67, 84, 104, 126, 149, 175, 203, 233, 265, 299, 334, 372, 412, 454, 499, 545, 593, 643, 695, 749, 805, 864, 924, 986, 1050, 1116, 1185, 1255, 1327, 1402, 1478, 1556, 1637, 1719, 1803, 1890, 1978, 2068, 2161, 2255, 2352, 2450, 2550, 2653, 2757, 2864, 2972, 3082, 3195, 3309, 3426, 3544, 3664, 3787, 3911, 4038, 4166, 4296, 4429, 4563, 4700, 4838, 4978, 5121, 5265, 5411, 5560, 5710, 5862, 6017, 6173, 6331, 6492, 6654, 6818, 6985, 7153, 7323, 7495, 7670, 7846, 8024, 8204, 8387, 8571, 8757, 8945, 9135, 9327, 9521, 9718, 9916, 10116, 10318, 10522, 10728, 10936, 11146, 11358, 11572, 11788, 12006, 12226, 12448, 12672, 12897, 13125, 13355, 13587, 13821, 14057, 14294, 14534, 14776, 15020, 15265, 15513, 15763, 16014, 16268, 16524, 16781, 17041, 17302, 17566, 17831, 18099, 18368, 18640, 18913, 19189, 19466, 19745, 20027, 20310, 20595, 20883, 21172, 21463, 21756, 22051, 22349, 22648, 22949, 23252, 23557, 23864, 24173, 24484, 24797, 25112, 25429, 25748, 26069, 26391, 26716, 27043, 27372, 27702, 28035, 28370, 28707, 29045, 29386, 29728, 30073, 30419, 30768, 31118, 31471, 31825, 32182, 32540, 32900, 33263, 33627, 33993, 34361, 34731, 35104, 35478, 35854, 36232, 36612, 36994, 37378, 37764, 38152, 38542, 38933, 39327, 39723, 40121, 40521, 40922, 41326, 41732, 42139, 42549, 42960, 43374, 43789, 44207, 44626, 45048, 45471, 45896, 46324, 46753, 47184, 47617, 48052, 48490, 48929, 49370, 49813, 50258, 50705, 51154, 51604, 52057, 52512, 52969, 53428, 53888, 54351, 54816, 55282, 55751, 56222, 56694, 57169, 57645, 58123, 58604, 59086, 59570, 60057, 60545, 61035, 61527, 62021, 62517, 63016, 63516, 64018, 64521, 65027, 65535, }; #endif #ifdef GAMMA_1_3 static const u16 gamma_table_1_3[] = { /* Gamma 1.3 */ 0, 49, 120, 203, 296, 395, 501, 612, 728, 848, 973, 1101, 1233, 1368, 1506, 1648, 1792, 1939, 2088, 2241, 2395, 2552, 2711, 2872, 3036, 3201, 3369, 3538, 3709, 3882, 4057, 4234, 4412, 4592, 4774, 4957, 5142, 5329, 5517, 5706, 5897, 6090, 6283, 6479, 6675, 6873, 7072, 7273, 7475, 7678, 7882, 8088, 8294, 8502, 8711, 8922, 9133, 9346, 9559, 9774, 9990, 10207, 10425, 10644, 10864, 11086, 11308, 11531, 11755, 11981, 12207, 12434, 12662, 12891, 13121, 13352, 13584, 13817, 14051, 14285, 14521, 14757, 14994, 15233, 15472, 15712, 15952, 16194, 16436, 16679, 16923, 17168, 17414, 17660, 17908, 18156, 18405, 18654, 18905, 19156, 19408, 19660, 19914, 20168, 20423, 20679, 20935, 21192, 21450, 21708, 21968, 22228, 22488, 22750, 23012, 23275, 23538, 23802, 24067, 24332, 24599, 24865, 25133, 25401, 25670, 25939, 26209, 26480, 26751, 27023, 27296, 27569, 27843, 28118, 28393, 28669, 28945, 29222, 29500, 29778, 30057, 30336, 30616, 30897, 31178, 31460, 31742, 32025, 32308, 32592, 32877, 33162, 33448, 33734, 34021, 34309, 34597, 34885, 35175, 35464, 35754, 36045, 36337, 36628, 36921, 37214, 37507, 37801, 38096, 38391, 38686, 38982, 39279, 39576, 39874, 40172, 40471, 40770, 41070, 41370, 41670, 41972, 42273, 42576, 42878, 43181, 43485, 43789, 44094, 44399, 44705, 45011, 45317, 45625, 45932, 46240, 46549, 46858, 47167, 47477, 47787, 48098, 48409, 48721, 49034, 49346, 49659, 49973, 50287, 50602, 50917, 51232, 51548, 51864, 52181, 52498, 52816, 53134, 53452, 53771, 54091, 54411, 54731, 55052, 55373, 55694, 56016, 56339, 56662, 56985, 57309, 57633, 57957, 58282, 58608, 58933, 59260, 59586, 59913, 60241, 60569, 60897, 61226, 61555, 61884, 62214, 62545, 62875, 63206, 63538, 63870, 64202, 64535, 64868, 65201, 65535, }; #endif #ifdef GAMMA_2_2 static const u16 gamma_table_2_2[] = { 0, 0, 2, 4, 7, 11, 17, 24, 32, 42, 53, 65, 79, 94, 111, 129, 148, 169, 192, 216, 242, 270, 299, 330, 362, 396, 432, 469, 508, 549, 591, 635, 681, 729, 779, 830, 883, 938, 995, 1053, 1113, 1175, 1239, 1305, 1373, 1443, 1514, 1587, 1663, 1740, 1819, 1900, 1983, 2068, 2155, 2243, 2334, 2427, 2521, 2618, 2717, 2817, 2920, 3024, 3131, 3240, 3350, 3463, 3578, 3694, 3813, 3934, 4057, 4182, 4309, 4438, 4570, 4703, 4838, 4976, 5115, 5257, 5401, 5547, 5695, 5845, 5998, 6152, 6309, 6468, 6629, 6792, 6957, 7124, 7294, 7466, 7640, 7816, 7994, 8175, 8358, 8543, 8730, 8919, 9111, 9305, 9501, 9699, 9900, 10102, 10307, 10515, 10724, 10936, 11150, 11366, 11585, 11806, 12029, 12254, 12482, 12712, 12944, 13179, 13416, 13655, 13896, 14140, 14386, 14635, 14885, 15138, 15394, 15652, 15912, 16174, 16439, 16706, 16975, 17247, 17521, 17798, 18077, 18358, 18642, 18928, 19216, 19507, 19800, 20095, 20393, 20694, 20996, 21301, 21609, 21919, 22231, 22546, 22863, 23182, 23504, 23829, 24156, 24485, 24817, 25151, 25487, 25826, 26168, 26512, 26858, 27207, 27558, 27912, 28268, 28627, 28988, 29351, 29717, 30086, 30457, 30830, 31206, 31585, 31966, 32349, 32735, 33124, 33514, 33908, 34304, 34702, 35103, 35507, 35913, 36321, 36732, 37146, 37562, 37981, 38402, 38825, 39252, 39680, 40112, 40546, 40982, 41421, 41862, 42306, 42753, 43202, 43654, 44108, 44565, 45025, 45487, 45951, 46418, 46888, 47360, 47835, 48313, 48793, 49275, 49761, 50249, 50739, 51232, 51728, 52226, 52727, 53230, 53736, 54245, 54756, 55270, 55787, 56306, 56828, 57352, 57879, 58409, 58941, 59476, 60014, 60554, 61097, 61642, 62190, 62741, 63295, 63851, 64410, 64971, 65535, }; #endif #ifdef GAMMA_2_5 static const u16 gamma_table_2_5[] = { /* gamma = 2.5 */ 0, 0, 0, 1, 2, 4, 6, 8, 11, 15, 20, 25, 31, 38, 46, 55, 65, 75, 87, 99, 113, 128, 143, 160, 178, 197, 218, 239, 262, 286, 311, 338, 366, 395, 425, 457, 491, 526, 562, 599, 639, 679, 722, 765, 811, 857, 906, 956, 1007, 1061, 1116, 1172, 1231, 1291, 1352, 1416, 1481, 1548, 1617, 1688, 1760, 1834, 1910, 1988, 2068, 2150, 2233, 2319, 2407, 2496, 2587, 2681, 2776, 2874, 2973, 3075, 3178, 3284, 3391, 3501, 3613, 3727, 3843, 3961, 4082, 4204, 4329, 4456, 4585, 4716, 4850, 4986, 5124, 5264, 5407, 5552, 5699, 5849, 6001, 6155, 6311, 6470, 6632, 6795, 6962, 7130, 7301, 7475, 7650, 7829, 8009, 8193, 8379, 8567, 8758, 8951, 9147, 9345, 9546, 9750, 9956, 10165, 10376, 10590, 10806, 11025, 11247, 11472, 11699, 11929, 12161, 12397, 12634, 12875, 13119, 13365, 13614, 13865, 14120, 14377, 14637, 14899, 15165, 15433, 15705, 15979, 16256, 16535, 16818, 17104, 17392, 17683, 17978, 18275, 18575, 18878, 19184, 19493, 19805, 20119, 20437, 20758, 21082, 21409, 21739, 22072, 22407, 22746, 23089, 23434, 23782, 24133, 24487, 24845, 25206, 25569, 25936, 26306, 26679, 27055, 27435, 27818, 28203, 28592, 28985, 29380, 29779, 30181, 30586, 30994, 31406, 31820, 32239, 32660, 33085, 33513, 33944, 34379, 34817, 35258, 35702, 36150, 36602, 37056, 37514, 37976, 38441, 38909, 39380, 39856, 40334, 40816, 41301, 41790, 42282, 42778, 43277, 43780, 44286, 44795, 45308, 45825, 46345, 46869, 47396, 47927, 48461, 48999, 49540, 50085, 50634, 51186, 51742, 52301, 52864, 53431, 54001, 54575, 55153, 55734, 56318, 56907, 57499, 58095, 58695, 59298, 59905, 60515, 61130, 61748, 62370, 62995, 63624, 64258, 64894, 65535, }; #endif #ifdef GAMMA_3_0 static const u16 gamma_table_3_0[] = { /* gamma = 3.0 */ 0, 0, 0, 0, 0, 0, 1, 1, 2, 3, 4, 5, 7, 9, 11, 13, 16, 19, 23, 27, 32, 37, 42, 48, 55, 62, 69, 78, 87, 96, 107, 118, 130, 142, 155, 169, 184, 200, 217, 234, 253, 272, 293, 314, 337, 360, 385, 410, 437, 465, 494, 524, 556, 588, 622, 658, 694, 732, 771, 812, 854, 897, 942, 988, 1036, 1085, 1136, 1189, 1243, 1298, 1356, 1415, 1475, 1538, 1602, 1667, 1735, 1804, 1876, 1949, 2024, 2100, 2179, 2260, 2343, 2427, 2514, 2603, 2693, 2786, 2881, 2978, 3078, 3179, 3283, 3389, 3497, 3607, 3720, 3835, 3952, 4072, 4194, 4319, 4446, 4575, 4707, 4842, 4979, 5118, 5261, 5405, 5553, 5703, 5856, 6011, 6169, 6330, 6494, 6660, 6830, 7002, 7177, 7355, 7536, 7719, 7906, 8096, 8289, 8484, 8683, 8885, 9090, 9298, 9510, 9724, 9942, 10163, 10387, 10614, 10845, 11079, 11317, 11557, 11802, 12049, 12300, 12555, 12813, 13074, 13339, 13608, 13880, 14156, 14435, 14718, 15005, 15295, 15589, 15887, 16189, 16494, 16803, 17117, 17433, 17754, 18079, 18408, 18740, 19077, 19418, 19762, 20111, 20464, 20821, 21182, 21547, 21917, 22290, 22668, 23050, 23436, 23827, 24222, 24621, 25025, 25433, 25845, 26262, 26683, 27109, 27539, 27974, 28413, 28857, 29306, 29759, 30217, 30680, 31147, 31619, 32095, 32577, 33063, 33554, 34050, 34551, 35056, 35567, 36082, 36602, 37128, 37658, 38194, 38734, 39280, 39830, 40386, 40947, 41513, 42084, 42661, 43243, 43830, 44422, 45019, 45622, 46231, 46844, 47463, 48088, 48718, 49353, 49994, 50641, 51293, 51950, 52614, 53282, 53957, 54637, 55323, 56014, 56712, 57415, 58123, 58838, 59558, 60285, 61017, 61755, 62499, 63249, 64005, 64767, 65535, }; #endif void clock_setup(void) { rcc_clock_setup_in_hse_8mhz_out_72mhz(); /* Enable TIM3 clock. */ rcc_peripheral_enable_clock(&RCC_APB1ENR, RCC_APB1ENR_TIM3EN); /* Enable GPIOC, Alternate Function clocks. */ rcc_peripheral_enable_clock(&RCC_APB2ENR, RCC_APB2ENR_IOPAEN | RCC_APB2ENR_IOPBEN | RCC_APB2ENR_AFIOEN); } void gpio_setup(void) { /* * Set GPIO6 and 7 (in GPIO port A) to * 'output alternate function push-pull'. */ gpio_set_mode(GPIOA, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO_TIM3_CH1 | GPIO_TIM3_CH2); /* * Set GPIO0 and 1 (in GPIO port B) to * 'output alternate function push-pull'. */ gpio_set_mode(GPIOB, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO_TIM3_CH3 | GPIO_TIM3_CH4); } void tim_setup(void) { /* Clock division and mode */ TIM3_CR1 = TIM_CR1_CKD_CK_INT | TIM_CR1_CMS_EDGE; /* Period */ TIM3_ARR = 65535; /* Prescaler */ TIM3_PSC = 0; TIM3_EGR = TIM_EGR_UG; /* ---- */ /* Output compare 1 mode and preload */ TIM3_CCMR1 |= TIM_CCMR1_OC1M_PWM1 | TIM_CCMR1_OC1PE; /* Polarity and state */ TIM3_CCER |= TIM_CCER_CC1P | TIM_CCER_CC1E; //TIM3_CCER |= TIM_CCER_CC1E; /* Capture compare value */ TIM3_CCR1 = 0; /* ---- */ /* Output compare 2 mode and preload */ TIM3_CCMR1 |= TIM_CCMR1_OC2M_PWM1 | TIM_CCMR1_OC2PE; /* Polarity and state */ TIM3_CCER |= TIM_CCER_CC2P | TIM_CCER_CC2E; //TIM3_CCER |= TIM_CCER_CC2E; /* Capture compare value */ TIM3_CCR2 = 0; /* ---- */ /* Output compare 3 mode and preload */ TIM3_CCMR2 |= TIM_CCMR2_OC3M_PWM1 | TIM_CCMR2_OC3PE; /* Polarity and state */ TIM3_CCER |= TIM_CCER_CC3P | TIM_CCER_CC3E; //TIM3_CCER |= TIM_CCER_CC3E; /* Capture compare value */ TIM3_CCR3 = 0; /* ---- */ /* Output compare 4 mode and preload */ TIM3_CCMR2 |= TIM_CCMR2_OC4M_PWM1 | TIM_CCMR2_OC4PE; /* Polarity and state */ TIM3_CCER |= TIM_CCER_CC4P | TIM_CCER_CC4E; //TIM3_CCER |= TIM_CCER_CC4E; /* Capture compare value */ TIM3_CCR4 = 0; /* ---- */ /* ARR reload enable */ TIM3_CR1 |= TIM_CR1_ARPE; /* Counter enable */ TIM3_CR1 |= TIM_CR1_CEN; } int main(void) { int i, j0, j1, j2, j3, d0, d1, d2, d3, j, k, kd; clock_setup(); gpio_setup(); tim_setup(); #ifdef COMPARE j0 = 0; d0 = 1; j1 = 0; d1 = 1; j2 = 0; d2 = 1; j3 = 0; d3 = 1; while (1) { TIM3_CCR1 = gamma_table_linear[j0]; j0 += d0; if (j0 == 255) d0 = -1; if (j0 == 0) d0 = 1; TIM3_CCR2 = gamma_table_1_3[j1]; j1 += d1; if (j1 == 255) d1 = -1; if (j1 == 0) d1 = 1; TIM3_CCR3 = gamma_table_2_5[j2]; j2 += d2; if (j2 == 255) d2 = -1; if (j2 == 0) d2 = 1; TIM3_CCR4 = gamma_table_3_0[j3]; j3 += d3; if (j3 == 255) d3 = -1; if (j3 == 0) d3 = 1; for (i = 0; i < 50000; i++); } #endif #ifdef MOVING_FADE j0 = 0; d0 = 1; j1 = 128; d1 = 1; j2 = 255; d2 = -1; j3 = 128; d3 = -1; while (1) { TIM3_CCR1 = GAMMA_TABLE[j0]; j0 += d0; if (j0 == 255) d0 = -1; if (j0 == 0) d0 = 1; TIM3_CCR2 = GAMMA_TABLE[j1]; j1 += d1; if (j1 == 255) d1 = -1; if (j1 == 0) d1 = 1; TIM3_CCR3 = GAMMA_TABLE[j2]; j2 += d2; if (j2 == 255) d2 = -1; if (j2 == 0) d2 = 1; TIM3_CCR4 = GAMMA_TABLE[j3]; j3 += d3; if (j3 == 255) d3 = -1; if (j3 == 0) d3 = 1; for (i = 0; i < 10000; i++); } #endif #ifdef KITT j0 = 255; d0 = -1; j1 = 20; d1 = -1; j2 = 20; d2 = -1; j3 = 20; d3 = -1; j = 0; k = 0; kd = 1; while (1) { TIM3_CCR1 = GAMMA_TABLE[j0]; j0 += d0; if (j0 == 255) d0 = -1; if (j0 == 19) j0 = 20; TIM3_CCR2 = GAMMA_TABLE[j1]; j1 += d1; if (j1 == 255) d1 = -1; if (j1 == 19) j1 = 20; TIM3_CCR3 = GAMMA_TABLE[j2]; j2 += d2; if (j2 == 255) d2 = -1; if (j2 == 19) j2 = 20; TIM3_CCR4 = GAMMA_TABLE[j3]; j3 += d3; if (j3 == 255) d3 = -1; if (j3 == 19) j3 = 20; for (i = 0; i < 15000; i++) __asm__("nop"); j++; if (j == 100) { j = 0; switch (k += kd) { case 0: j0 = 255; break; case 1: j1 = 255; break; case 2: j2 = 255; break; case 3: j3 = 255; break; } if (k == 3) kd = -1; if (k == 0) kd = 1; } } #endif return 0; }