Update lock led processing and remove debug msgs
This commit is contained in:
		
							parent
							
								
									ac97870801
								
							
						
					
					
						commit
						9af272e4bb
					
				
					 4 changed files with 10 additions and 28 deletions
				
			
		| 
						 | 
				
			
			@ -247,7 +247,6 @@ bool process_record_user (uint16_t keycode, keyrecord_t *record) {
 | 
			
		|||
 | 
			
		||||
// Runs just one time when the keyboard initializes.
 | 
			
		||||
void matrix_init_user(void) {
 | 
			
		||||
    xprintf("init start");
 | 
			
		||||
 | 
			
		||||
    led_controller_init();
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -135,7 +135,6 @@ msg_t is31_read_register(uint8_t page, uint8_t reg, uint8_t *result) {
 | 
			
		|||
 * initialise the IS31 chip
 | 
			
		||||
 * ======================== */
 | 
			
		||||
void is31_init(void) {
 | 
			
		||||
      xprintf("_is31_init\n");
 | 
			
		||||
  // just to be sure that it's all zeroes
 | 
			
		||||
  __builtin_memset(full_page,0,0xB4+1);
 | 
			
		||||
  // zero function page, all registers (assuming full_page is all zeroes)
 | 
			
		||||
| 
						 | 
				
			
			@ -200,41 +199,33 @@ static THD_FUNCTION(LEDthread, arg) {
 | 
			
		|||
    msg_args[1] = (msg >> 16) & 0XFF;
 | 
			
		||||
    msg_args[2] = (msg >> 24) & 0xFF;
 | 
			
		||||
 | 
			
		||||
      xprintf("msg_type: %d-%d-%d\n", msg_type, msg_args[0], msg_args[1]);
 | 
			
		||||
 | 
			
		||||
    switch (msg_type){
 | 
			
		||||
      case SET_FULL_ROW:
 | 
			
		||||
      xprintf("FULL ROW: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
      //write full byte to pin address, msg_args[1] = pin #, msg_args[0] = 8 bits to write
 | 
			
		||||
      //writes only to currently displayed page
 | 
			
		||||
        write_led_byte(page_status, msg_args[1], msg_args[0]);
 | 
			
		||||
        break;
 | 
			
		||||
 | 
			
		||||
      case OFF_LED:
 | 
			
		||||
      xprintf("OFF: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
      //on/off/toggle single led, msg_args[0] = row/col of led, msg_args[1] = page
 | 
			
		||||
        set_led_bit(msg_args[1], control_register_word, msg_args[0], 0);
 | 
			
		||||
        break;
 | 
			
		||||
      case ON_LED:
 | 
			
		||||
      xprintf("ON: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
        set_led_bit(msg_args[1], control_register_word, msg_args[0], 1);
 | 
			
		||||
        break;
 | 
			
		||||
      case TOGGLE_LED:
 | 
			
		||||
      xprintf("TOGGLE: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
        set_led_bit(msg_args[1], control_register_word, msg_args[0], 2);
 | 
			
		||||
        break;
 | 
			
		||||
 | 
			
		||||
      case BLINK_OFF_LED:
 | 
			
		||||
      xprintf("B_on: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
      //on/off/toggle single led, msg_args[0] = row/col of led
 | 
			
		||||
        set_led_bit(msg_args[1], control_register_word, msg_args[0], 4);
 | 
			
		||||
        break;
 | 
			
		||||
      case BLINK_ON_LED:
 | 
			
		||||
      xprintf("B_off: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
        set_led_bit(msg_args[1], control_register_word, msg_args[0], 5);
 | 
			
		||||
        break;
 | 
			
		||||
      case BLINK_TOGGLE_LED:
 | 
			
		||||
      xprintf("B_togg: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
        set_led_bit(msg_args[1], control_register_word, msg_args[0], 6);
 | 
			
		||||
        break;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -244,12 +235,10 @@ static THD_FUNCTION(LEDthread, arg) {
 | 
			
		|||
        chThdSleepMilliseconds(5);
 | 
			
		||||
        is31_read_register(0, 0x00, &temp);
 | 
			
		||||
        is31_write_register(IS31_FUNCTIONREG, IS31_REG_SHUTDOWN, IS31_REG_SHUTDOWN_OFF);
 | 
			
		||||
      xprintf("TOGGLE_ALL: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
      xprintf("temp: %d\n", temp);
 | 
			
		||||
 | 
			
		||||
        led_control_reg[0] = 0;
 | 
			
		||||
 | 
			
		||||
        //if first leds are already on, toggle frame 0 off
 | 
			
		||||
        //toggle led mask based on current state (temp)
 | 
			
		||||
        if (temp==0 || page_status > 0) {
 | 
			
		||||
          __builtin_memcpy(led_control_reg+1, all_on_leds_mask, 0x12);
 | 
			
		||||
        } else {
 | 
			
		||||
| 
						 | 
				
			
			@ -262,13 +251,14 @@ static THD_FUNCTION(LEDthread, arg) {
 | 
			
		|||
 | 
			
		||||
          page_status=0;
 | 
			
		||||
 | 
			
		||||
          //maintain lock leds
 | 
			
		||||
          //maintain lock leds, reset to off and force recheck to blink of all leds toggled on
 | 
			
		||||
          numlock_status = 0;
 | 
			
		||||
          capslock_status = 0;
 | 
			
		||||
          led_set(host_keyboard_leds());
 | 
			
		||||
        }
 | 
			
		||||
        break;
 | 
			
		||||
 | 
			
		||||
      case TOGGLE_BACKLIGHT:
 | 
			
		||||
      xprintf("TOGGLE_BKLT: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
        //msg_args[0] = on/off
 | 
			
		||||
 | 
			
		||||
        //populate 9 byte rows to be written to each pin, first byte is register (pin) address
 | 
			
		||||
| 
						 | 
				
			
			@ -287,12 +277,13 @@ static THD_FUNCTION(LEDthread, arg) {
 | 
			
		|||
 | 
			
		||||
      case DISPLAY_PAGE:
 | 
			
		||||
      //msg_args[0] = page to toggle on
 | 
			
		||||
      xprintf("DSPY_PG: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
        if (page_status != msg_args[0]) {
 | 
			
		||||
          is31_write_register(IS31_FUNCTIONREG, IS31_REG_PICTDISP, msg_args[0]);
 | 
			
		||||
          page_status = msg_args[0];
 | 
			
		||||
 | 
			
		||||
          //maintain lock leds
 | 
			
		||||
          //maintain lock leds, reset to off and force recheck for new page
 | 
			
		||||
          numlock_status = 0;
 | 
			
		||||
          capslock_status = 0;
 | 
			
		||||
          led_set(host_keyboard_leds());
 | 
			
		||||
        }
 | 
			
		||||
        break;
 | 
			
		||||
| 
						 | 
				
			
			@ -309,7 +300,6 @@ static THD_FUNCTION(LEDthread, arg) {
 | 
			
		|||
        break;
 | 
			
		||||
 | 
			
		||||
      case TOGGLE_NUM_LOCK:
 | 
			
		||||
      xprintf("NMLK: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
      //msg_args[0] = 0 or 1, off/on
 | 
			
		||||
        if (numlock_status != msg_args[0]) {
 | 
			
		||||
          set_lock_leds(NUM_LOCK_LED_ADDRESS, msg_args[0], page_status);
 | 
			
		||||
| 
						 | 
				
			
			@ -317,7 +307,6 @@ static THD_FUNCTION(LEDthread, arg) {
 | 
			
		|||
        }
 | 
			
		||||
        break;
 | 
			
		||||
      case TOGGLE_CAPS_LOCK:
 | 
			
		||||
      xprintf("CPLK: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
      //msg_args[0] = 0 or 1, off/on
 | 
			
		||||
        if (capslock_status != msg_args[0]) {
 | 
			
		||||
          set_lock_leds(CAPS_LOCK_LED_ADDRESS, msg_args[0], page_status);
 | 
			
		||||
| 
						 | 
				
			
			@ -326,7 +315,6 @@ static THD_FUNCTION(LEDthread, arg) {
 | 
			
		|||
        break;
 | 
			
		||||
 | 
			
		||||
      case STEP_BRIGHTNESS:
 | 
			
		||||
      xprintf("Step: %d-%d\n", msg_args[0], msg_args[1]);
 | 
			
		||||
      //led_args[0] = step up (1) or down (0)
 | 
			
		||||
        switch (msg_args[0]) {
 | 
			
		||||
          case 0:
 | 
			
		||||
| 
						 | 
				
			
			@ -373,7 +361,6 @@ void set_led_bit (uint8_t page, uint8_t *led_control_word, uint8_t led_addr, uin
 | 
			
		|||
  if (led_addr < 0 || led_addr > 87 || led_addr % 10 > 8) {
 | 
			
		||||
    return;
 | 
			
		||||
  }
 | 
			
		||||
      xprintf("_set action-led: %x-%d\n", action, led_addr);
 | 
			
		||||
 | 
			
		||||
  blink_bit = action>>2;//check for blink bit
 | 
			
		||||
  action &= ~(1<<2); //strip blink bit
 | 
			
		||||
| 
						 | 
				
			
			@ -381,17 +368,14 @@ void set_led_bit (uint8_t page, uint8_t *led_control_word, uint8_t led_addr, uin
 | 
			
		|||
  //led_addr tens column is pin#, ones column is bit position in 8-bit mask
 | 
			
		||||
  control_reg_addr = ((led_addr / 10) % 10 - 1 ) * 0x02;// A-matrix is every other byte
 | 
			
		||||
  control_reg_addr += blink_bit == 1 ? 0x12 : 0x00;//if blink_bit, shift 12 bytes to blink register
 | 
			
		||||
      xprintf("_set control address: %x\n", control_reg_addr);
 | 
			
		||||
 | 
			
		||||
  is31_write_register(IS31_FUNCTIONREG, IS31_REG_SHUTDOWN, IS31_REG_SHUTDOWN_ON);
 | 
			
		||||
  chThdSleepMilliseconds(5);
 | 
			
		||||
  is31_read_register(page, control_reg_addr, &temp);//maintain status of leds on this byte
 | 
			
		||||
  is31_write_register(IS31_FUNCTIONREG, IS31_REG_SHUTDOWN, IS31_REG_SHUTDOWN_OFF);
 | 
			
		||||
      xprintf("_set temp_byte_mask: %x\n", temp);
 | 
			
		||||
 | 
			
		||||
  column_bit = 1<<(led_addr % 10 - 1);
 | 
			
		||||
  column_byte = temp;
 | 
			
		||||
      xprintf("_set col_byte_mask: %x\n", column_byte);
 | 
			
		||||
 | 
			
		||||
  switch(action) {
 | 
			
		||||
    case 0:
 | 
			
		||||
| 
						 | 
				
			
			@ -451,7 +435,6 @@ void set_lock_leds(uint8_t led_addr, uint8_t led_action, uint8_t page) {
 | 
			
		|||
      led_action |= (1<<2); //set blink bit
 | 
			
		||||
    }
 | 
			
		||||
  }
 | 
			
		||||
      xprintf("_lock action: %d\n", led_action);
 | 
			
		||||
 | 
			
		||||
  set_led_bit(page,led_control_word,led_addr,led_action);
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -462,7 +445,6 @@ void set_lock_leds(uint8_t led_addr, uint8_t led_action, uint8_t page) {
 | 
			
		|||
void led_controller_init(void) {
 | 
			
		||||
  uint8_t i;
 | 
			
		||||
 | 
			
		||||
      xprintf("led_init\n");
 | 
			
		||||
  /* initialise I2C */
 | 
			
		||||
  /* I2C pins */
 | 
			
		||||
  palSetPadMode(GPIOB, 0, PAL_MODE_ALTERNATIVE_2); // PTB0/I2C0/SCL
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -75,7 +75,8 @@ void led_controller_init(void);
 | 
			
		|||
// D2:D0 extinguish time (3.5ms*2^i)
 | 
			
		||||
 | 
			
		||||
#define IS31_REG_SHUTDOWN 0x0A
 | 
			
		||||
#define IS31_REG_SHUTDOWN_ON 0x1
 | 
			
		||||
#define IS31_REG_SHUTDOWN_OFF 0x1
 | 
			
		||||
#define IS31_REG_SHUTDOWN_ON 0x0
 | 
			
		||||
 | 
			
		||||
#define IS31_REG_AGCCTRL 0x0B
 | 
			
		||||
#define IS31_REG_ADCRATE 0x0C
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -56,7 +56,7 @@ OPT_DEFS = -DCORTEX_VTOR_INIT=0x00001000
 | 
			
		|||
# Build Options
 | 
			
		||||
#   comment out to disable the options.
 | 
			
		||||
#
 | 
			
		||||
BOOTMAGIC_ENABLE ?= yes	# Virtual DIP switch configuration
 | 
			
		||||
BOOTMAGIC_ENABLE ?= no	# Virtual DIP switch configuration
 | 
			
		||||
## (Note that for BOOTMAGIC on Teensy LC you have to use a custom .ld script.)
 | 
			
		||||
MOUSEKEY_ENABLE ?= yes	# Mouse keys
 | 
			
		||||
EXTRAKEY_ENABLE ?= yes	# Audio control and System control
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue