]> git.donarmstrong.com Git - qmk_firmware.git/blob - keyboards/quefrency/split_util.c
Rgb matrix arm (#3648)
[qmk_firmware.git] / keyboards / quefrency / split_util.c
1 #include <avr/io.h>
2 #include <avr/wdt.h>
3 #include <avr/power.h>
4 #include <avr/interrupt.h>
5 #include <util/delay.h>
6 #include <avr/eeprom.h>
7 #include "split_util.h"
8 #include "matrix.h"
9 #include "keyboard.h"
10 #include "config.h"
11 #include "timer.h"
12 #include "pincontrol.h"
13
14 #ifdef USE_I2C
15 #  include "i2c.h"
16 #else
17 #  include "serial.h"
18 #endif
19
20 volatile bool isLeftHand = true;
21
22 static void setup_handedness(void) {
23   // Test D2 pin for handedness, if D2 is grounded, it's the right hand
24   pinMode(D2, PinDirectionInput);
25   isLeftHand = digitalRead(D2);
26 }
27
28 static void keyboard_master_setup(void) {
29 #ifdef USE_I2C
30     i2c_master_init();
31 #ifdef SSD1306OLED
32     matrix_master_OLED_init();
33 #endif
34 #else
35     serial_master_init();
36 #endif
37 }
38
39 static void keyboard_slave_setup(void) {
40   timer_init();
41 #ifdef USE_I2C
42     i2c_slave_init(SLAVE_I2C_ADDRESS);
43 #else
44     serial_slave_init();
45 #endif
46 }
47
48 bool has_usb(void) {
49    USBCON |= (1 << OTGPADE); //enables VBUS pad
50    _delay_us(5);
51    return (USBSTA & (1<<VBUS));  //checks state of VBUS
52 }
53
54 void split_keyboard_setup(void) {
55    setup_handedness();
56
57    if (has_usb()) {
58       keyboard_master_setup();
59    } else {
60       keyboard_slave_setup();
61    }
62    sei();
63 }
64
65 void keyboard_slave_loop(void) {
66    matrix_init();
67
68    while (1) {
69       matrix_slave_scan();
70    }
71 }
72
73 // this code runs before the usb and keyboard is initialized
74 void matrix_setup(void) {
75     split_keyboard_setup();
76
77     if (!has_usb()) {
78         keyboard_slave_loop();
79     }
80 }