From 05f66cde4cc2d9e57e495f6d8b51619f08191c68 Mon Sep 17 00:00:00 2001 From: Piotr Esden-Tempski Date: Sun, 2 Jan 2011 16:49:31 +0100 Subject: Ported pwmleds (pwm timer output test) to obldc. --- examples/stm32/obldc/pwmleds/Makefile | 23 ++ examples/stm32/obldc/pwmleds/pwmleds.c | 484 ++++++++++++++++++++++++++++++++ examples/stm32/obldc/pwmleds/pwmleds.ld | 31 ++ 3 files changed, 538 insertions(+) create mode 100644 examples/stm32/obldc/pwmleds/Makefile create mode 100644 examples/stm32/obldc/pwmleds/pwmleds.c create mode 100644 examples/stm32/obldc/pwmleds/pwmleds.ld (limited to 'examples/stm32/obldc') diff --git a/examples/stm32/obldc/pwmleds/Makefile b/examples/stm32/obldc/pwmleds/Makefile new file mode 100644 index 0000000..8ae74d6 --- /dev/null +++ b/examples/stm32/obldc/pwmleds/Makefile @@ -0,0 +1,23 @@ +## +## This file is part of the libopencm3 project. +## +## Copyright (C) 2009 Uwe Hermann +## +## This program is free software: you can redistribute it and/or modify +## it under the terms of the GNU General Public License as published by +## the Free Software Foundation, either version 3 of the License, or +## (at your option) any later version. +## +## This program 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 General Public License for more details. +## +## You should have received a copy of the GNU General Public License +## along with this program. If not, see . +## + +BINARY = pwmleds + +include ../../Makefile.include + diff --git a/examples/stm32/obldc/pwmleds/pwmleds.c b/examples/stm32/obldc/pwmleds/pwmleds.c new file mode 100644 index 0000000..4af57c0 --- /dev/null +++ b/examples/stm32/obldc/pwmleds/pwmleds.c @@ -0,0 +1,484 @@ +/* + * This file is part of the libopencm3 project. + * + * Copyright (C) 2010 Piotr Esden-Tempski + * + * This program is free software: you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation, either version 3 of the License, or + * (at your option) any later version. + * + * This program 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 General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program. 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; +} diff --git a/examples/stm32/obldc/pwmleds/pwmleds.ld b/examples/stm32/obldc/pwmleds/pwmleds.ld new file mode 100644 index 0000000..7ea2b92 --- /dev/null +++ b/examples/stm32/obldc/pwmleds/pwmleds.ld @@ -0,0 +1,31 @@ +/* + * This file is part of the libopencm3 project. + * + * Copyright (C) 2009 Uwe Hermann + * + * This program is free software: you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation, either version 3 of the License, or + * (at your option) any later version. + * + * This program 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 General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program. If not, see . + */ + +/* Linker script for Olimex STM32-H103 (STM32F103RBT6, 128K flash, 20K RAM). */ + +/* Define memory regions. */ +MEMORY +{ + rom (rx) : ORIGIN = 0x08000000, LENGTH = 128K + ram (rwx) : ORIGIN = 0x20000000, LENGTH = 20K +} + +/* Include the common ld script. */ +INCLUDE libopencm3_stm32.ld + -- cgit v1.2.3