]> git.donarmstrong.com Git - qmk_firmware.git/blob - keyboards/ergodox_ez/ergodox_ez.c
implement ergodox_left_leds_update in ergodox_ez
[qmk_firmware.git] / keyboards / ergodox_ez / ergodox_ez.c
1 #include QMK_KEYBOARD_H
2 #include "i2cmaster.h"
3
4
5 extern inline void ergodox_board_led_on(void);
6 extern inline void ergodox_right_led_1_on(void);
7 extern inline void ergodox_right_led_2_on(void);
8 extern inline void ergodox_right_led_3_on(void);
9 extern inline void ergodox_right_led_on(uint8_t led);
10
11 extern inline void ergodox_board_led_off(void);
12 extern inline void ergodox_right_led_1_off(void);
13 extern inline void ergodox_right_led_2_off(void);
14 extern inline void ergodox_right_led_3_off(void);
15 extern inline void ergodox_right_led_off(uint8_t led);
16
17 extern inline void ergodox_led_all_on(void);
18 extern inline void ergodox_led_all_off(void);
19
20 extern inline void ergodox_right_led_1_set(uint8_t n);
21 extern inline void ergodox_right_led_2_set(uint8_t n);
22 extern inline void ergodox_right_led_3_set(uint8_t n);
23 extern inline void ergodox_right_led_set(uint8_t led, uint8_t n);
24
25 extern inline void ergodox_led_all_set(uint8_t n);
26
27
28 bool i2c_initialized = 0;
29 uint8_t mcp23018_status = 0x20;
30
31 void matrix_init_kb(void) {
32    // keyboard LEDs (see "PWM on ports OC1(A|B|C)" in "teensy-2-0.md")
33     TCCR1A = 0b10101001;  // set and configure fast PWM
34     TCCR1B = 0b00001001;  // set and configure fast PWM
35
36     // (tied to Vcc for hardware convenience)
37     DDRB  &= ~(1<<4);  // set B(4) as input
38     PORTB &= ~(1<<4);  // set B(4) internal pull-up disabled
39
40     // unused pins - C7, D4, D5, D7, E6
41     // set as input with internal pull-ip enabled
42     DDRC  &= ~(1<<7);
43     DDRD  &= ~(1<<5 | 1<<4);
44     DDRE  &= ~(1<<6);
45     PORTC |=  (1<<7);
46     PORTD |=  (1<<5 | 1<<4);
47     PORTE |=  (1<<6);
48
49     ergodox_blink_all_leds();
50
51     matrix_init_user();
52 }
53
54 void ergodox_blink_all_leds(void)
55 {
56     ergodox_led_all_off();
57     ergodox_led_all_set(LED_BRIGHTNESS_HI);
58     ergodox_right_led_1_on();
59     _delay_ms(50);
60     ergodox_right_led_2_on();
61     _delay_ms(50);
62     ergodox_right_led_3_on();
63     _delay_ms(50);
64 #ifdef LEFT_LEDS
65     ergodox_left_led_1_on();
66     _delay_ms(50);
67     if (!mcp23018_status) {
68       mcp23018_status = ergodox_left_leds_update();
69     }
70     ergodox_left_led_2_on();
71     _delay_ms(50);
72     if (!mcp23018_status) {
73       mcp23018_status = ergodox_left_leds_update();
74     }
75     ergodox_left_led_3_on();
76     _delay_ms(50);
77     if (!mcp23018_status) {
78       mcp23018_status = ergodox_left_leds_update();
79     }
80 #endif
81     ergodox_right_led_1_off();
82     _delay_ms(50);
83     ergodox_right_led_2_off();
84     _delay_ms(50);
85     ergodox_right_led_3_off();
86 #ifdef LEFT_LEDS
87     _delay_ms(50);
88     ergodox_left_led_1_off();
89     if (!mcp23018_status) {
90       mcp23018_status = ergodox_left_leds_update();
91     }
92     _delay_ms(50);
93     ergodox_left_led_2_off();
94     if (!mcp23018_status) {
95       mcp23018_status = ergodox_left_leds_update();
96     }
97     _delay_ms(50);
98     ergodox_left_led_3_off();
99     if (!mcp23018_status) {
100       mcp23018_status = ergodox_left_leds_update();
101     }
102 #endif
103     
104     //ergodox_led_all_on();
105     //_delay_ms(333);
106     ergodox_led_all_off();
107 }
108
109 uint8_t init_mcp23018(void) {
110     mcp23018_status = 0x20;
111
112     // I2C subsystem
113
114     // uint8_t sreg_prev;
115     // sreg_prev=SREG;
116     // cli();
117     if (i2c_initialized == 0) {
118         i2c_init();  // on pins D(1,0)
119         i2c_initialized = true;
120         _delay_ms(1000);
121     }
122
123     // set pin direction
124     // - unused  : input  : 1
125     // - input   : input  : 1
126     // - driving : output : 0
127     mcp23018_status = i2c_start(I2C_ADDR_WRITE);    if (mcp23018_status) goto out;
128     mcp23018_status = i2c_write(IODIRA);            if (mcp23018_status) goto out;
129     mcp23018_status = i2c_write(0b00000000);        if (mcp23018_status) goto out;
130     mcp23018_status = i2c_write(0b00111111);        if (mcp23018_status) goto out;
131     i2c_stop();
132
133     // set pull-up
134     // - unused  : on  : 1
135     // - input   : on  : 1
136     // - driving : off : 0
137     mcp23018_status = i2c_start(I2C_ADDR_WRITE);    if (mcp23018_status) goto out;
138     mcp23018_status = i2c_write(GPPUA);             if (mcp23018_status) goto out;
139     mcp23018_status = i2c_write(0b00000000);        if (mcp23018_status) goto out;
140     mcp23018_status = i2c_write(0b00111111);        if (mcp23018_status) goto out;
141
142 out:
143     i2c_stop();
144
145 #ifdef LEFT_LEDS
146     if (!mcp23018_status) mcp23018_status = ergodox_left_leds_update();
147 #endif // LEFT_LEDS
148
149     // SREG=sreg_prev;
150
151     return mcp23018_status;
152 }
153
154 #ifdef LEFT_LEDS
155 uint8_t ergodox_left_leds_update(void) {
156     if (mcp23018_status) { // if there was an error
157         return mcp23018_status;
158     }
159 #define LEFT_LED_1_SHIFT        7       // in MCP23018 port B
160 #define LEFT_LED_2_SHIFT        6       // in MCP23018 port B
161 #define LEFT_LED_3_SHIFT        7       // in MCP23018 port A
162
163     // set logical value (doesn't matter on inputs)
164     // - unused  : hi-Z : 1
165     // - input   : hi-Z : 1
166     // - driving : hi-Z : 1
167     mcp23018_status = i2c_start(I2C_ADDR_WRITE);
168     if (mcp23018_status) goto out;
169     mcp23018_status = i2c_write(OLATA);
170     if (mcp23018_status) goto out;
171     mcp23018_status = i2c_write(0b11111111
172                                 & ~(ergodox_left_led_3<<LEFT_LED_3_SHIFT)
173                                 );
174     if (mcp23018_status) goto out;
175     mcp23018_status = i2c_write(0b11111111
176                                 & ~(ergodox_left_led_2<<LEFT_LED_2_SHIFT)
177                                 & ~(ergodox_left_led_1<<LEFT_LED_1_SHIFT)
178                                 );
179     if (mcp23018_status) goto out;
180
181  out:
182     i2c_stop();
183     return mcp23018_status;
184 }
185 #endif
186
187
188 #ifdef ONEHAND_ENABLE
189 __attribute__ ((weak))
190 // swap-hands action needs a matrix to define the swap
191 const keypos_t hand_swap_config[MATRIX_ROWS][MATRIX_COLS] = {
192     /* Left hand, matrix positions */
193     {{0,13}, {1,13}, {2,13}, {3,13}, {4,13}, {5,13}},
194     {{0,12}, {1,12}, {2,12}, {3,12}, {4,12}, {5,12}},
195     {{0,11}, {1,11}, {2,11}, {3,11}, {4,11}, {5,11}},
196     {{0,10}, {1,10}, {2,10}, {3,10}, {4,10}, {5,10}},
197     {{0,9}, {1,9}, {2,9}, {3,9}, {4,9}, {5,9}},
198     {{0,8}, {1,8}, {2,8}, {3,8}, {4,8}, {5,8}},
199     {{0,7}, {1,7}, {2,7}, {3,7}, {4,7}, {5,7}},
200     /* Right hand, matrix positions */
201     {{0,6}, {1,6}, {2,6}, {3,6}, {4,6}, {5,6}},
202     {{0,5}, {1,5}, {2,5}, {3,5}, {4,5}, {5,5}},
203     {{0,4}, {1,4}, {2,4}, {3,4}, {4,4}, {5,4}},
204     {{0,3}, {1,3}, {2,3}, {3,3}, {4,3}, {5,3}},
205     {{0,2}, {1,2}, {2,2}, {3,2}, {4,2}, {5,2}},
206     {{0,1}, {1,1}, {2,1}, {3,1}, {4,1}, {5,1}},
207     {{0,0}, {1,0}, {2,0}, {3,0}, {4,0}, {5,0}},
208 };
209 #endif