d7489ebfbd
Thanks to Thomas Otto for pointing out problems with the clock code in examples and his clock routine implementations. Based on that the most common clock combination routines were added to the library and all routines in examples setting up the clock replaced with calls to that functions.
479 lines
14 KiB
C
479 lines
14 KiB
C
/*
|
|
* This file is part of the libopenstm32 project.
|
|
*
|
|
* Copyright (C) 2010 Piotr Esden-Tempski <piotr@esden.net>
|
|
*
|
|
* 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 <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <libopenstm32/rcc.h>
|
|
#include <libopenstm32/gpio.h>
|
|
#include <libopenstm32/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 uint16_t 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, TIM3EN);
|
|
|
|
/* Enable GPIOC, Alternate Function clocks. */
|
|
rcc_peripheral_enable_clock(&RCC_APB2ENR, IOPCEN | AFIOEN);
|
|
}
|
|
|
|
void gpio_setup(void)
|
|
{
|
|
/*
|
|
* Set GPIO6 (in GPIO port C) to
|
|
* 'output alternate function push-pull'.
|
|
*/
|
|
gpio_set_mode(GPIOC, GPIO_MODE_OUTPUT_50_MHZ,
|
|
GPIO_CNF_OUTPUT_ALTFN_PUSHPULL,
|
|
GPIO6 | GPIO7 | GPIO8 | GPIO9);
|
|
|
|
/* Remap TIM3:
|
|
* CH1 -> PC6
|
|
* CH2 -> PC7
|
|
* CH3 -> PC8
|
|
* CH4 -> PC9
|
|
*/
|
|
AFIO_MAPR |= AFIO_MAPR_TIM3_REMAP_FULL_REMAP;
|
|
}
|
|
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_CC1P | TIM_CCER_CC1E;
|
|
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_CC1P | TIM_CCER_CC1E;
|
|
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_CC1P | TIM_CCER_CC1E;
|
|
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 < 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;
|
|
}
|