forked from mirrors/qmk_userspace
		
	To prevent key stuck clear matrix array when ADB error occurs.
This commit is contained in:
		
					parent
					
						
							
								dd0017558e
							
						
					
				
			
			
				commit
				
					
						d8ce19abd0
					
				
			
		
					 2 changed files with 40 additions and 34 deletions
				
			
		| 
						 | 
					@ -38,27 +38,22 @@ along with this program.  If not, see <http://www.gnu.org/licenses/>.
 | 
				
			||||||
#   error "MATRIX_ROWS must not exceed 255"
 | 
					#   error "MATRIX_ROWS must not exceed 255"
 | 
				
			||||||
#endif
 | 
					#endif
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#define CAPS        0x39
 | 
					#define ADB_CAPS_UP     (ADB_CAPS | 0x80)
 | 
				
			||||||
#define CAPS_UP     (CAPS | 0x80)
 | 
					 | 
				
			||||||
#define ROW(key)    ((key)>>3&0x0F)
 | 
					 | 
				
			||||||
#define COL(key)    ((key)&0x07)
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static bool _matrix_is_modified = false;
 | 
					static bool is_modified = false;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
// matrix state buffer(1:on, 0:off)
 | 
					// matrix state buffer(1:on, 0:off)
 | 
				
			||||||
#if (MATRIX_COLS <= 8)
 | 
					#if (MATRIX_COLS <= 8)
 | 
				
			||||||
static uint8_t *matrix;
 | 
					static uint8_t matrix[MATRIX_ROWS];
 | 
				
			||||||
static uint8_t _matrix0[MATRIX_ROWS];
 | 
					 | 
				
			||||||
#else
 | 
					#else
 | 
				
			||||||
static uint16_t *matrix;
 | 
					static uint16_t matrix[MATRIX_ROWS];
 | 
				
			||||||
static uint16_t _matrix0[MATRIX_ROWS];
 | 
					 | 
				
			||||||
#endif
 | 
					#endif
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#ifdef MATRIX_HAS_GHOST
 | 
					#ifdef MATRIX_HAS_GHOST
 | 
				
			||||||
static bool matrix_has_ghost_in_row(uint8_t row);
 | 
					static bool matrix_has_ghost_in_row(uint8_t row);
 | 
				
			||||||
#endif
 | 
					#endif
 | 
				
			||||||
static void _register_key(uint8_t key);
 | 
					static void register_key(uint8_t key);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					
 | 
				
			||||||
inline
 | 
					inline
 | 
				
			||||||
| 
						 | 
					@ -78,8 +73,7 @@ void matrix_init(void)
 | 
				
			||||||
    adb_host_init();
 | 
					    adb_host_init();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // initialize matrix state: all keys off
 | 
					    // initialize matrix state: all keys off
 | 
				
			||||||
    for (uint8_t i=0; i < MATRIX_ROWS; i++) _matrix0[i] = 0x00;
 | 
					    for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00;
 | 
				
			||||||
    matrix = _matrix0;
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
    print_enable = true;
 | 
					    print_enable = true;
 | 
				
			||||||
    debug_enable = true;
 | 
					    debug_enable = true;
 | 
				
			||||||
| 
						 | 
					@ -95,48 +89,53 @@ uint8_t matrix_scan(void)
 | 
				
			||||||
    uint16_t codes;
 | 
					    uint16_t codes;
 | 
				
			||||||
    uint8_t key0, key1;
 | 
					    uint8_t key0, key1;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    _matrix_is_modified = false;
 | 
					    is_modified = false;
 | 
				
			||||||
    codes = adb_host_kbd_recv();
 | 
					    codes = adb_host_kbd_recv();
 | 
				
			||||||
    key0 = codes>>8;
 | 
					    key0 = codes>>8;
 | 
				
			||||||
    key1 = codes&0xFF;
 | 
					    key1 = codes&0xFF;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    if (debug_enable && codes) {
 | 
					    if (debug_matrix && codes) {
 | 
				
			||||||
        print("adb_host_kbd_recv: "); phex16(codes); print("\n");
 | 
					        print("adb_host_kbd_recv: "); phex16(codes); print("\n");
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#ifdef MATRIX_HAS_LOCKING_CAPS
 | 
					#ifdef MATRIX_HAS_LOCKING_CAPS
 | 
				
			||||||
    // Send Caps key up event
 | 
					    // Send Caps key up event
 | 
				
			||||||
    if (matrix_is_on(ROW(CAPS), COL(CAPS))) {
 | 
					    if (matrix_is_on(MATRIX_ROW(ADB_CAPS), MATRIX_COL(ADB_CAPS))) {
 | 
				
			||||||
        _matrix_is_modified = true;
 | 
					        register_key(ADB_CAPS_UP);
 | 
				
			||||||
        _register_key(CAPS_UP);
 | 
					 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
#endif
 | 
					#endif
 | 
				
			||||||
    if (codes == 0) {                           // no keys
 | 
					    if (codes == 0) {                           // no keys
 | 
				
			||||||
        return 0;
 | 
					        return 0;
 | 
				
			||||||
    } else if (key0 == 0xFF && key1 != 0xFF) {  // error
 | 
					    } else if (codes == 0x7F7F) {   // power key press
 | 
				
			||||||
        return codes&0xFF;
 | 
					        register_key(0x7F);
 | 
				
			||||||
 | 
					    } else if (codes == 0xFFFF) {   // power key release
 | 
				
			||||||
 | 
					        register_key(0xFF);
 | 
				
			||||||
 | 
					    } else if (key0 == 0xFF) {      // error
 | 
				
			||||||
 | 
					        if (debug_matrix) print("adb_host_kbd_recv: ERROR(matrix cleared.)\n");
 | 
				
			||||||
 | 
					        // clear matrix to unregister all keys
 | 
				
			||||||
 | 
					        for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00;
 | 
				
			||||||
 | 
					        return key1;
 | 
				
			||||||
    } else {
 | 
					    } else {
 | 
				
			||||||
#ifdef MATRIX_HAS_LOCKING_CAPS    
 | 
					#ifdef MATRIX_HAS_LOCKING_CAPS    
 | 
				
			||||||
        if (host_keyboard_leds() & (1<<USB_LED_CAPS_LOCK)) {
 | 
					        if (host_keyboard_leds() & (1<<USB_LED_CAPS_LOCK)) {
 | 
				
			||||||
            // Ignore LockingCaps key down event when CAPS LOCK is on
 | 
					            // Ignore LockingCaps key down event when CAPS LOCK is on
 | 
				
			||||||
            if (key0 == CAPS && (key1 == CAPS || key1 == 0xFF)) return 0;
 | 
					            if (key0 == ADB_CAPS && (key1 == ADB_CAPS || key1 == 0xFF)) return 0;
 | 
				
			||||||
            if (key0 == CAPS) key0 = key1;
 | 
					            if (key0 == ADB_CAPS) key0 = key1;
 | 
				
			||||||
            if (key1 == CAPS) key1 = 0xFF;
 | 
					            if (key1 == ADB_CAPS) key1 = 0xFF;
 | 
				
			||||||
            // Convert LockingCaps key up event into down event
 | 
					            // Convert LockingCaps key up event into down event
 | 
				
			||||||
            if (key0 == CAPS_UP) key0 = CAPS;
 | 
					            if (key0 == ADB_CAPS_UP) key0 = ADB_CAPS;
 | 
				
			||||||
            if (key1 == CAPS_UP) key1 = CAPS;
 | 
					            if (key1 == ADB_CAPS_UP) key1 = ADB_CAPS;
 | 
				
			||||||
        } else {
 | 
					        } else {
 | 
				
			||||||
            // CAPS LOCK off:
 | 
					            // ADB_CAPS LOCK off:
 | 
				
			||||||
            // Ignore LockingCaps key up event when CAPS LOCK is off
 | 
					            // Ignore LockingCaps key up event when ADB_CAPS LOCK is off
 | 
				
			||||||
            if (key0 == CAPS_UP && (key1 == CAPS_UP || key1 == 0xFF)) return 0;
 | 
					            if (key0 == ADB_CAPS_UP && (key1 == ADB_CAPS_UP || key1 == 0xFF)) return 0;
 | 
				
			||||||
            if (key0 == CAPS_UP) key0 = key1;
 | 
					            if (key0 == ADB_CAPS_UP) key0 = key1;
 | 
				
			||||||
            if (key1 == CAPS_UP) key1 = 0xFF;
 | 
					            if (key1 == ADB_CAPS_UP) key1 = 0xFF;
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
#endif        
 | 
					#endif        
 | 
				
			||||||
        _matrix_is_modified = true;
 | 
					        register_key(key0);
 | 
				
			||||||
        _register_key(key0);
 | 
					 | 
				
			||||||
        if (key1 != 0xFF)       // key1 is 0xFF when no second key.
 | 
					        if (key1 != 0xFF)       // key1 is 0xFF when no second key.
 | 
				
			||||||
            _register_key(key1);
 | 
					            register_key(key1);
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    return 1;
 | 
					    return 1;
 | 
				
			||||||
| 
						 | 
					@ -144,7 +143,7 @@ uint8_t matrix_scan(void)
 | 
				
			||||||
 | 
					
 | 
				
			||||||
bool matrix_is_modified(void)
 | 
					bool matrix_is_modified(void)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
    return _matrix_is_modified;
 | 
					    return is_modified;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
inline
 | 
					inline
 | 
				
			||||||
| 
						 | 
					@ -177,6 +176,7 @@ uint16_t matrix_get_row(uint8_t row)
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void matrix_print(void)
 | 
					void matrix_print(void)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
 | 
					    if (!debug_matrix) return;
 | 
				
			||||||
#if (MATRIX_COLS <= 8)
 | 
					#if (MATRIX_COLS <= 8)
 | 
				
			||||||
    print("r/c 01234567\n");
 | 
					    print("r/c 01234567\n");
 | 
				
			||||||
#else
 | 
					#else
 | 
				
			||||||
| 
						 | 
					@ -229,7 +229,7 @@ static bool matrix_has_ghost_in_row(uint8_t row)
 | 
				
			||||||
#endif
 | 
					#endif
 | 
				
			||||||
 | 
					
 | 
				
			||||||
inline
 | 
					inline
 | 
				
			||||||
static void _register_key(uint8_t key)
 | 
					static void register_key(uint8_t key)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
    uint8_t col, row;
 | 
					    uint8_t col, row;
 | 
				
			||||||
    col = key&0x07;
 | 
					    col = key&0x07;
 | 
				
			||||||
| 
						 | 
					@ -239,4 +239,5 @@ static void _register_key(uint8_t key)
 | 
				
			||||||
    } else {
 | 
					    } else {
 | 
				
			||||||
        matrix[row] |=  (1<<col);
 | 
					        matrix[row] |=  (1<<col);
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
					    is_modified = true;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
| 
						 | 
					
 | 
				
			||||||
| 
						 | 
					@ -38,6 +38,7 @@ POSSIBILITY OF SUCH DAMAGE.
 | 
				
			||||||
#ifndef ADB_H
 | 
					#ifndef ADB_H
 | 
				
			||||||
#define ADB_H
 | 
					#define ADB_H
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include <stdint.h>
 | 
				
			||||||
#include <stdbool.h>
 | 
					#include <stdbool.h>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#if !(defined(ADB_PORT) && \
 | 
					#if !(defined(ADB_PORT) && \
 | 
				
			||||||
| 
						 | 
					@ -47,6 +48,10 @@ POSSIBILITY OF SUCH DAMAGE.
 | 
				
			||||||
#   error "ADB port setting is required in config.h"
 | 
					#   error "ADB port setting is required in config.h"
 | 
				
			||||||
#endif
 | 
					#endif
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#define ADB_POWER       0x7F
 | 
				
			||||||
 | 
					#define ADB_CAPS        0x39
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					
 | 
				
			||||||
// ADB host
 | 
					// ADB host
 | 
				
			||||||
void     adb_host_init(void);
 | 
					void     adb_host_init(void);
 | 
				
			||||||
bool     adb_host_psw(void);
 | 
					bool     adb_host_psw(void);
 | 
				
			||||||
| 
						 | 
					
 | 
				
			||||||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue