]> git.donarmstrong.com Git - qmk_firmware.git/blob - keyboards/ergodox_ez/ergodox_ez.c
i2c fix
[qmk_firmware.git] / keyboards / ergodox_ez / ergodox_ez.c
1 #include QMK_KEYBOARD_H
2
3 extern inline void ergodox_board_led_on(void);
4 extern inline void ergodox_right_led_1_on(void);
5 extern inline void ergodox_right_led_2_on(void);
6 extern inline void ergodox_right_led_3_on(void);
7 extern inline void ergodox_right_led_on(uint8_t led);
8
9 extern inline void ergodox_board_led_off(void);
10 extern inline void ergodox_right_led_1_off(void);
11 extern inline void ergodox_right_led_2_off(void);
12 extern inline void ergodox_right_led_3_off(void);
13 extern inline void ergodox_right_led_off(uint8_t led);
14
15 extern inline void ergodox_led_all_on(void);
16 extern inline void ergodox_led_all_off(void);
17
18 extern inline void ergodox_right_led_1_set(uint8_t n);
19 extern inline void ergodox_right_led_2_set(uint8_t n);
20 extern inline void ergodox_right_led_3_set(uint8_t n);
21 extern inline void ergodox_right_led_set(uint8_t led, uint8_t n);
22
23 extern inline void ergodox_led_all_set(uint8_t n);
24
25
26 bool i2c_initialized = 0;
27 uint8_t mcp23018_status = 0x20;
28
29 void matrix_init_kb(void) {
30    // keyboard LEDs (see "PWM on ports OC1(A|B|C)" in "teensy-2-0.md")
31     TCCR1A = 0b10101001;  // set and configure fast PWM
32     TCCR1B = 0b00001001;  // set and configure fast PWM
33
34     // (tied to Vcc for hardware convenience)
35     DDRB  &= ~(1<<4);  // set B(4) as input
36     PORTB &= ~(1<<4);  // set B(4) internal pull-up disabled
37
38     // unused pins - C7, D4, D5, D7, E6
39     // set as input with internal pull-up enabled
40     DDRC  &= ~(1<<7);
41     DDRD  &= ~(1<<5 | 1<<4);
42     DDRE  &= ~(1<<6);
43     PORTC |=  (1<<7);
44     PORTD |=  (1<<5 | 1<<4);
45     PORTE |=  (1<<6);
46
47     ergodox_blink_all_leds();
48
49     matrix_init_user();
50 }
51
52 void ergodox_blink_all_leds(void)
53 {
54     ergodox_led_all_off();
55     ergodox_led_all_set(LED_BRIGHTNESS_DEFAULT);
56     ergodox_right_led_1_on();
57     _delay_ms(50);
58     ergodox_right_led_2_on();
59     _delay_ms(50);
60     ergodox_right_led_3_on();
61     _delay_ms(50);
62 #ifdef LEFT_LEDS
63     ergodox_left_led_1_on();
64     _delay_ms(50);
65     if (!mcp23018_status) {
66       mcp23018_status = ergodox_left_leds_update();
67     }
68     ergodox_left_led_2_on();
69     _delay_ms(50);
70     if (!mcp23018_status) {
71       mcp23018_status = ergodox_left_leds_update();
72     }
73     ergodox_left_led_3_on();
74     _delay_ms(50);
75     if (!mcp23018_status) {
76       mcp23018_status = ergodox_left_leds_update();
77     }
78 #endif
79     ergodox_right_led_1_off();
80     _delay_ms(50);
81     ergodox_right_led_2_off();
82     _delay_ms(50);
83     ergodox_right_led_3_off();
84 #ifdef LEFT_LEDS
85     _delay_ms(50);
86     ergodox_left_led_1_off();
87     if (!mcp23018_status) {
88       mcp23018_status = ergodox_left_leds_update();
89     }
90     _delay_ms(50);
91     ergodox_left_led_2_off();
92     if (!mcp23018_status) {
93       mcp23018_status = ergodox_left_leds_update();
94     }
95     _delay_ms(50);
96     ergodox_left_led_3_off();
97     if (!mcp23018_status) {
98       mcp23018_status = ergodox_left_leds_update();
99     }
100 #endif
101
102     //ergodox_led_all_on();
103     //_delay_ms(333);
104     ergodox_led_all_off();
105 }
106
107 uint8_t init_mcp23018(void) {
108     mcp23018_status = 0x20;
109
110     // I2C subsystem
111
112     // uint8_t sreg_prev;
113     // sreg_prev=SREG;
114     // cli();
115     if (i2c_initialized == 0) {
116         i2c_init();  // on pins D(1,0)
117         i2c_initialized = true;
118         _delay_ms(1000);
119     }
120
121     // set pin direction
122     // - unused  : input  : 1
123     // - input   : input  : 1
124     // - driving : output : 0
125     mcp23018_status = i2c_start(I2C_ADDR_WRITE);    if (mcp23018_status) goto out;
126     mcp23018_status = i2c_write(IODIRA);            if (mcp23018_status) goto out;
127     mcp23018_status = i2c_write(0b00000000);        if (mcp23018_status) goto out;
128     mcp23018_status = i2c_write(0b00111111);        if (mcp23018_status) goto out;
129     i2c_stop();
130
131     // set pull-up
132     // - unused  : on  : 1
133     // - input   : on  : 1
134     // - driving : off : 0
135     mcp23018_status = i2c_start(I2C_ADDR_WRITE);    if (mcp23018_status) goto out;
136     mcp23018_status = i2c_write(GPPUA);             if (mcp23018_status) goto out;
137     mcp23018_status = i2c_write(0b00000000);        if (mcp23018_status) goto out;
138     mcp23018_status = i2c_write(0b00111111);        if (mcp23018_status) goto out;
139
140 out:
141     i2c_stop();
142
143 #ifdef LEFT_LEDS
144     if (!mcp23018_status) mcp23018_status = ergodox_left_leds_update();
145 #endif // LEFT_LEDS
146
147     // SREG=sreg_prev;
148
149     return mcp23018_status;
150 }
151
152 #ifdef LEFT_LEDS
153 uint8_t ergodox_left_leds_update(void) {
154     if (mcp23018_status) { // if there was an error
155         return mcp23018_status;
156     }
157 #define LEFT_LED_1_SHIFT        7       // in MCP23018 port B
158 #define LEFT_LED_2_SHIFT        6       // in MCP23018 port B
159 #define LEFT_LED_3_SHIFT        7       // in MCP23018 port A
160
161     // set logical value (doesn't matter on inputs)
162     // - unused  : hi-Z : 1
163     // - input   : hi-Z : 1
164     // - driving : hi-Z : 1
165     mcp23018_status = i2c_start(I2C_ADDR_WRITE);
166     if (mcp23018_status) goto out;
167     mcp23018_status = i2c_write(OLATA);
168     if (mcp23018_status) goto out;
169     mcp23018_status = i2c_write(0b11111111
170                                 & ~(ergodox_left_led_3<<LEFT_LED_3_SHIFT)
171                                 );
172     if (mcp23018_status) goto out;
173     mcp23018_status = i2c_write(0b11111111
174                                 & ~(ergodox_left_led_2<<LEFT_LED_2_SHIFT)
175                                 & ~(ergodox_left_led_1<<LEFT_LED_1_SHIFT)
176                                 );
177     if (mcp23018_status) goto out;
178
179  out:
180     i2c_stop();
181     return mcp23018_status;
182 }
183 #endif
184
185
186 #ifdef SWAP_HANDS_ENABLE
187 __attribute__ ((weak))
188 // swap-hands action needs a matrix to define the swap
189 const keypos_t hand_swap_config[MATRIX_ROWS][MATRIX_COLS] = {
190     /* Left hand, matrix positions */
191     {{0,13}, {1,13}, {2,13}, {3,13}, {4,13}, {5,13}},
192     {{0,12}, {1,12}, {2,12}, {3,12}, {4,12}, {5,12}},
193     {{0,11}, {1,11}, {2,11}, {3,11}, {4,11}, {5,11}},
194     {{0,10}, {1,10}, {2,10}, {3,10}, {4,10}, {5,10}},
195     {{0,9}, {1,9}, {2,9}, {3,9}, {4,9}, {5,9}},
196     {{0,8}, {1,8}, {2,8}, {3,8}, {4,8}, {5,8}},
197     {{0,7}, {1,7}, {2,7}, {3,7}, {4,7}, {5,7}},
198     /* Right hand, matrix positions */
199     {{0,6}, {1,6}, {2,6}, {3,6}, {4,6}, {5,6}},
200     {{0,5}, {1,5}, {2,5}, {3,5}, {4,5}, {5,5}},
201     {{0,4}, {1,4}, {2,4}, {3,4}, {4,4}, {5,4}},
202     {{0,3}, {1,3}, {2,3}, {3,3}, {4,3}, {5,3}},
203     {{0,2}, {1,2}, {2,2}, {3,2}, {4,2}, {5,2}},
204     {{0,1}, {1,1}, {2,1}, {3,1}, {4,1}, {5,1}},
205     {{0,0}, {1,0}, {2,0}, {3,0}, {4,0}, {5,0}},
206 };
207 #endif
208
209 #ifdef RGB_MATRIX_ENABLE
210 const is31_led g_is31_leds[DRIVER_LED_TOTAL] = {
211 /*   driver
212  *   |  R location
213  *   |  |      G location
214  *   |  |      |      B location
215  *   |  |      |      | */
216     {0, C3_1,  C2_1,  C4_1}, // LED1 on right
217     {0, C6_1,  C5_1,  C7_1}, // LED2
218     {0, C4_2,  C3_2,  C5_2}, // LED3
219     {0, C7_2,  C6_2,  C8_2}, // LED4
220     {0, C2_3,  C1_3,  C3_3}, // LED5
221     {0, C5_3,  C4_3,  C6_3}, // LED6
222     {0, C8_3,  C7_3,  C9_3}, // LED7
223     {0, C2_4,  C1_4,  C3_4}, // LED8
224     {0, C6_4,  C5_4,  C7_4}, // LED9
225     {0, C2_5,  C1_5,  C3_5}, // LED10
226     {0, C7_5,  C6_5,  C8_5}, // LED11
227     {0, C2_6,  C1_6,  C3_6}, // LED12
228     {0, C5_6,  C4_6,  C6_6}, // LED13
229     {0, C8_6,  C7_6,  C9_6}, // LED14
230     {0, C2_7,  C1_7,  C3_7}, // LED15
231     {0, C5_7,  C4_7,  C6_7}, // LED16
232     {0, C2_8,  C1_8,  C3_8}, // LED17
233     {0, C5_8,  C4_8,  C6_8}, // LED18
234
235     {0, C3_9,  C2_9,  C4_9}, // LED19
236     {0, C6_9,  C5_9,  C7_9}, // LED20
237     {0, C4_10, C3_10, C5_10}, // LED21
238     {0, C7_10, C6_10, C8_10}, // LED22
239     {0, C2_11, C1_11, C3_11}, // LED23
240     {0, C5_11, C4_11, C6_11}, // LED24
241
242     {1, C3_1,  C2_1,  C4_1}, // LED1 on left
243     {1, C6_1,  C5_1,  C7_1}, // LED2
244     {1, C4_2,  C3_2,  C5_2}, // LED3
245     {1, C7_2,  C6_2,  C8_2}, // LED4
246     {1, C2_3,  C1_3,  C3_3}, // LED5
247     {1, C5_3,  C4_3,  C6_3}, // LED6
248     {1, C8_3,  C7_3,  C9_3}, // LED7
249     {1, C2_4,  C1_4,  C3_4}, // LED8
250     {1, C6_4,  C5_4,  C7_4}, // LED9
251     {1, C2_5,  C1_5,  C3_5}, // LED10
252     {1, C7_5,  C6_5,  C8_5}, // LED11
253     {1, C2_6,  C1_6,  C3_6}, // LED12
254     {1, C5_6,  C4_6,  C6_6}, // LED13
255     {1, C8_6,  C7_6,  C9_6}, // LED14
256     {1, C2_7,  C1_7,  C3_7}, // LED15
257     {1, C5_7,  C4_7,  C6_7}, // LED16
258     {1, C2_8,  C1_8,  C3_8}, // LED17
259     {1, C5_8,  C4_8,  C6_8}, // LED18
260
261     {1, C3_9,  C2_9,  C4_9}, // LED19
262     {1, C6_9,  C5_9,  C7_9}, // LED20
263     {1, C4_10, C3_10, C5_10}, // LED21
264     {1, C7_10, C6_10, C8_10}, // LED22
265     {1, C2_11, C1_11, C3_11}, // LED23
266     {1, C5_11, C4_11, C6_11} // LED24
267 };
268
269
270 const rgb_led g_rgb_leds[DRIVER_LED_TOTAL] = {
271
272     /*{row | col << 4}
273       |             {x=0..224, y=0..64}
274       |              |                    modifier
275       |              |                    | */
276     {{0|(0<<4)},   {24.9*5, 16*0}, 0}, // LED 1 on right
277     {{0|(1<<4)},   {24.9*6, 16*0}, 0}, // LED 2
278     {{0|(2<<4)},   {24.9*7, 16*0}, 0}, // LED 3
279     {{0|(3<<4)},   {24.9*8, 16*0}, 0}, // LED 4
280     {{0|(4<<4)},   {24.9*9, 16*0}, 0}, // LED 5
281
282     {{1|(5<<4)},   {24.9*5, 16*1}, 0}, // LED 6
283     {{1|(6<<4)},   {24.9*6, 16*1}, 0}, // LED 7
284     {{1|(7<<4)},   {24.9*7, 16*1}, 0}, // LED 8
285     {{1|(8<<4)},   {24.9*8, 16*1}, 0}, // LED 9
286     {{1|(9<<4)},   {24.9*9, 16*1}, 0}, // LED 10
287
288     {{2|(5<<4)},   {24.9*5, 16*2}, 0}, // LED 11
289     {{2|(6<<4)},   {24.9*6, 16*2}, 0}, // LED 12
290     {{2|(7<<4)},   {24.9*7, 16*2}, 0}, // LED 13
291     {{2|(8<<4)},   {24.9*8, 16*2}, 0}, // LED 14
292     {{2|(9<<4)},   {24.9*9, 16*2}, 0}, // LED 15
293
294     {{3|(5<<4)},   {24.9*5, 16*2}, 0}, // LED 16
295     {{3|(6<<4)},   {24.9*6, 16*2}, 0}, // LED 17
296     {{3|(7<<4)},   {24.9*7, 16*2}, 0}, // LED 18
297     {{3|(8<<4)},   {24.9*8, 16*2}, 0}, // LED 19
298     {{3|(9<<4)},   {24.9*9, 16*2}, 0}, // LED 20
299
300     {{4|(6<<4)},   {24.9*6, 16*2}, 0}, // LED 21
301     {{4|(7<<4)},   {24.9*7, 16*2}, 0}, // LED 22
302     {{4|(8<<4)},   {24.9*8, 16*2}, 0}, // LED 23
303     {{4|(9<<4)},   {24.9*9, 16*2}, 0}, // LED 24
304
305     {{0|(0<<4)},   {24.9*4, 16*0}, 0}, // LED 1 on left
306     {{0|(1<<4)},   {24.9*3, 16*0}, 0}, // LED 2
307     {{0|(2<<4)},   {24.9*2, 16*0}, 0}, // LED 3
308     {{0|(3<<4)},   {24.9*1, 16*0}, 0}, // LED 4
309     {{0|(4<<4)},   {24.9*0, 16*0}, 0}, // LED 5
310
311     {{1|(5<<4)},   {24.9*4, 16*1}, 0}, // LED 6
312     {{1|(6<<4)},   {24.9*3, 16*1}, 0}, // LED 7
313     {{1|(7<<4)},   {24.9*2, 16*1}, 0}, // LED 8
314     {{1|(8<<4)},   {24.9*1, 16*1}, 0}, // LED 9
315     {{1|(9<<4)},   {24.9*0, 16*1}, 0}, // LED 10
316
317     {{2|(5<<4)},   {24.9*4, 16*2}, 0}, // LED 11
318     {{2|(6<<4)},   {24.9*3, 16*2}, 0}, // LED 12
319     {{2|(7<<4)},   {24.9*2, 16*2}, 0}, // LED 13
320     {{2|(8<<4)},   {24.9*1, 16*2}, 0}, // LED 14
321     {{2|(9<<4)},   {24.9*0, 16*2}, 0}, // LED 15
322
323     {{3|(5<<4)},   {24.9*4, 16*2}, 0}, // LED 16
324     {{3|(6<<4)},   {24.9*3, 16*2}, 0}, // LED 17
325     {{3|(7<<4)},   {24.9*2, 16*2}, 0}, // LED 18
326     {{3|(8<<4)},   {24.9*1, 16*2}, 0}, // LED 19
327     {{3|(9<<4)},   {24.9*0, 16*2}, 0}, // LED 20
328
329     {{4|(6<<4)},   {24.9*3, 16*2}, 0}, // LED 21
330     {{4|(7<<4)},   {24.9*2, 16*2}, 0}, // LED 22
331     {{4|(8<<4)},   {24.9*1, 16*2}, 0}, // LED 23
332     {{4|(9<<4)},   {24.9*0, 16*2}, 0}, // LED 24
333 };
334 #endif