keyboards/gergo/gergo.c

   1 #include QMK_KEYBOARD_H
   2
   3 bool i2c_initialized = 0;
   4 i2c_status_t mcp23018_status = 0x20;
   5
   6 void matrix_init_kb(void) {
   7     // (tied to Vcc for hardware convenience)
   8     //DDRB  &= ~(1<<4);  // set B(4) as input
   9     //PORTB &= ~(1<<4);  // set B(4) internal pull-up disabled
  10
  11     // unused pins - C7, D4, D5, D7, E6
  12     // set as input with internal pull-up enabled
  13     DDRC  &= ~(1<<7);
  14     DDRD  &= ~(1<<5 | 1<<4 | 1<<6 | 1<<7);
  15     DDRE  &= ~(1<<6);
  16     PORTC |=  (1<<7);
  17     PORTD |=  (1<<5 | 1<<4 | 1<<6 | 1<<7);
  18     PORTE |=  (1<<6);
  19
  20     matrix_init_user();
  21 }
  22
  23
  24 uint8_t init_mcp23018(void) {
  25     print("starting init");
  26     mcp23018_status = 0x20;
  27
  28     // I2C subsystem
  29
  30     // uint8_t sreg_prev;
  31     // sreg_prev=SREG;
  32     // cli();
  33
  34     if (i2c_initialized == 0) {
  35         i2c_init();  // on pins D(1,0)
  36         i2c_initialized = true;
  37         _delay_ms(1000);
  38     }
  39     // i2c_init(); // on pins D(1,0)
  40     // _delay_ms(1000);
  41
  42     // set pin direction
  43     // - unused  : input  : 1
  44     // - input   : input  : 1
  45     // - driving : output : 0
  46     mcp23018_status = i2c_start(I2C_ADDR_WRITE, ERGODOX_EZ_I2C_TIMEOUT);    if (mcp23018_status) goto out;
  47     mcp23018_status = i2c_write(IODIRA, ERGODOX_EZ_I2C_TIMEOUT);            if (mcp23018_status) goto out;
  48     mcp23018_status = i2c_write(0b10000000, ERGODOX_EZ_I2C_TIMEOUT);        if (mcp23018_status) goto out;
  49     mcp23018_status = i2c_write(0b11111111, ERGODOX_EZ_I2C_TIMEOUT);        if (mcp23018_status) goto out;
  50     i2c_stop(ERGODOX_EZ_I2C_TIMEOUT);
  51
  52     // set pull-up
  53     // - unused  : on  : 1
  54     // - input   : on  : 1
  55     // - driving : off : 0
  56     mcp23018_status = i2c_start(I2C_ADDR_WRITE, ERGODOX_EZ_I2C_TIMEOUT);    if (mcp23018_status) goto out;
  57     mcp23018_status = i2c_write(GPPUA, ERGODOX_EZ_I2C_TIMEOUT);             if (mcp23018_status) goto out;
  58     mcp23018_status = i2c_write(0b10000000, ERGODOX_EZ_I2C_TIMEOUT);        if (mcp23018_status) goto out;
  59     mcp23018_status = i2c_write(0b11111111, ERGODOX_EZ_I2C_TIMEOUT);        if (mcp23018_status) goto out;
  60
  61 out:
  62     i2c_stop(ERGODOX_EZ_I2C_TIMEOUT);
  63     // SREG=sreg_prev;
  64     //uprintf("Init %x\n", mcp23018_status);
  65     return mcp23018_status;
  66 }