498 lines
14 KiB
C
498 lines
14 KiB
C
/*
|
|
* This file is part of the libopencm3 project.
|
|
*
|
|
* Copyright (C) 2010 Piotr Esden-Tempski <piotr@esden.net>
|
|
*
|
|
* 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 <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <libopencm3/stm32/f1/rcc.h>
|
|
#include <libopencm3/stm32/f1/gpio.h>
|
|
#include <libopencm3/stm32/timer.h>
|
|
|
|
// #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 TIM1 clock. */
|
|
rcc_peripheral_enable_clock(&RCC_APB2ENR, RCC_APB2ENR_TIM1EN);
|
|
|
|
/* Enable GPIOC, Alternate Function clocks. */
|
|
rcc_peripheral_enable_clock(&RCC_APB2ENR,
|
|
RCC_APB2ENR_IOPAEN | RCC_APB2ENR_AFIOEN);
|
|
}
|
|
|
|
void gpio_setup(void)
|
|
{
|
|
/*
|
|
* Set GPIO_TIM1_CH1/2/3/4 (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_TIM1_CH1 | GPIO_TIM1_CH2 |
|
|
GPIO_TIM1_CH3 | GPIO_TIM1_CH4);
|
|
|
|
/*
|
|
* Remap TIM1:
|
|
* CH1 -> PC6
|
|
* CH2 -> PC7
|
|
* CH3 -> PC8
|
|
* CH4 -> PC9
|
|
*/
|
|
// AFIO_MAPR |= AFIO_MAPR_TIM3_REMAP_FULL_REMAP;
|
|
}
|
|
|
|
void tim_setup(void)
|
|
{
|
|
#if 0
|
|
TIM1_CR1 = TIM_CR1_CMS_CENTER_1 | TIM_CR1_ARPE;
|
|
TIM1_CCMR1 = TIM_CCMR1_OC1M_PWM1 | TIM_CCMR1_OC1PE |
|
|
TIM_CCMR1_OC2M_PWM1 | TIM_CCMR1_OC2PE;
|
|
TIM1_CCMR2 = TIM_CCMR2_OC3M_PWM1 | TIM_CCMR2_OC3PE;
|
|
|
|
TIM1_CCER &= ~TIM_CCER_CC1P;
|
|
#endif
|
|
#if 1
|
|
TIM1_SMCR &= ~TIM_SMCR_SMS_MASK;
|
|
TIM1_CR1 &= ~TIM_CR1_CEN;
|
|
|
|
/* Clock division and mode */
|
|
TIM1_CR1 = TIM_CR1_CKD_CK_INT | TIM_CR1_CMS_EDGE;
|
|
/* Period */
|
|
TIM1_ARR = 65535;
|
|
/* Prescaler */
|
|
TIM1_PSC = 2;
|
|
TIM1_EGR = TIM_EGR_UG;
|
|
|
|
/* ---- */
|
|
/* Output compare 1 mode and preload */
|
|
TIM1_CCMR1 |= TIM_CCMR1_OC1M_PWM1 | TIM_CCMR1_OC1PE;
|
|
|
|
/* Polarity and state */
|
|
// TIM1_CCER = TIM_CCER_CC1P | TIM_CCER_CC1E;
|
|
TIM1_CCER |= TIM_CCER_CC1E;
|
|
|
|
/* Capture compare value */
|
|
TIM1_CCR1 = 1000;
|
|
|
|
/* ---- */
|
|
/* Output compare 2 mode and preload */
|
|
TIM1_CCMR1 |= TIM_CCMR1_OC2M_PWM1 | TIM_CCMR1_OC2PE;
|
|
|
|
/* Polarity and state */
|
|
// TIM1_CCER = TIM_CCER_CC1P | TIM_CCER_CC1E;
|
|
TIM1_CCER |= TIM_CCER_CC2E;
|
|
|
|
/* Capture compare value */
|
|
TIM1_CCR2 = 1000;
|
|
|
|
/* ---- */
|
|
/* Output compare 3 mode and preload */
|
|
TIM1_CCMR2 |= TIM_CCMR2_OC3M_PWM1 | TIM_CCMR2_OC3PE;
|
|
|
|
/* Polarity and state */
|
|
// TIM1_CCER = TIM_CCER_CC1P | TIM_CCER_CC1E;
|
|
TIM1_CCER |= TIM_CCER_CC3E;
|
|
|
|
/* Capture compare value */
|
|
TIM1_CCR3 = 1000;
|
|
|
|
/* ---- */
|
|
/* Output compare 4 mode and preload */
|
|
TIM1_CCMR2 |= TIM_CCMR2_OC4M_PWM1 | TIM_CCMR2_OC4PE;
|
|
|
|
/* Polarity and state */
|
|
// TIM1_CCER = TIM_CCER_CC1P | TIM_CCER_CC1E;
|
|
TIM1_CCER |= TIM_CCER_CC4E;
|
|
|
|
/* Capture compare value */
|
|
TIM1_CCR4 = 1000;
|
|
|
|
/* ---- */
|
|
/* ARR reload enable */
|
|
TIM1_CR1 |= TIM_CR1_ARPE;
|
|
|
|
TIM1_BDTR |= TIM_BDTR_MOE;
|
|
|
|
/* Counter enable */
|
|
TIM1_CR1 |= TIM_CR1_CEN;
|
|
#endif
|
|
}
|
|
|
|
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) {
|
|
TIM1_CCR1 = gamma_table_linear[j0];
|
|
j0 += d0;
|
|
if (j0 == 255)
|
|
d0 = -1;
|
|
if (j0 == 0)
|
|
d0 = 1;
|
|
TIM1_CCR2 = gamma_table_1_3[j1];
|
|
j1 += d1;
|
|
if (j1 == 255)
|
|
d1 = -1;
|
|
if (j1 == 0)
|
|
d1 = 1;
|
|
TIM1_CCR3 = gamma_table_2_5[j2];
|
|
j2 += d2;
|
|
if (j2 == 255)
|
|
d2 = -1;
|
|
if (j2 == 0)
|
|
d2 = 1;
|
|
TIM1_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) {
|
|
TIM1_CCR1 = GAMMA_TABLE[j0];
|
|
j0 += d0;
|
|
if (j0 == 255)
|
|
d0 = -1;
|
|
if (j0 == 0)
|
|
d0 = 1;
|
|
TIM1_CCR2 = GAMMA_TABLE[j1];
|
|
j1 += d1;
|
|
if (j1 == 255)
|
|
d1 = - 1;
|
|
if (j1 == 0)
|
|
d1 = 1;
|
|
TIM1_CCR3 = GAMMA_TABLE[j2];
|
|
j2 += d2;
|
|
if (j2 == 255)
|
|
d2 = -1;
|
|
if (j2 == 0)
|
|
d2 = 1;
|
|
TIM1_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) {
|
|
TIM1_CCR1 = GAMMA_TABLE[j0];
|
|
j0 += d0;
|
|
if (j0 == 255)
|
|
d0 = -1;
|
|
if (j0 == 19)
|
|
j0 = 20;
|
|
TIM1_CCR2 = GAMMA_TABLE[j1];
|
|
j1 += d1;
|
|
if (j1 == 255)
|
|
d1 = -1;
|
|
if (j1 == 19)
|
|
j1 = 20;
|
|
TIM1_CCR3 = GAMMA_TABLE[j2];
|
|
j2 += d2;
|
|
if (j2 == 255)
|
|
d2 = -1;
|
|
if (j2 == 19)
|
|
j2 = 20;
|
|
TIM1_CCR4 = GAMMA_TABLE[j3];
|
|
j3 += d3;
|
|
if (j3 == 255)
|
|
d3 = -1;
|
|
if (j3 == 19)
|
|
j3 = 20;
|
|
for (i = 0; i < 5000; i++);
|
|
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;
|
|
}
|