Сканирование матричной клавиатуры

void KEYBOARD_SCAN(void){ //Функция для сканирования клавы
    int i;
    start_scan = 0; //Сбрасываем флаг, после вызова этой функции
    for(counter_row_scan = 0; counter_row_scan < ROWS; counter_row_scan++){ //Сканирование рядов
        row_port[counter_row_scan]->BRR = (1 << row_pin[counter_row_scan]); //Выставляем 0 на текущем пине рядов
            for(counter_col_scan = 0; counter_col_scan < COLS; counter_col_scan++){ //Сканирование колонок
                if(!(col_port[counter_col_scan]->IDR & (1 << col_pin[counter_col_scan]))){ //Если на текущем пине колонок обнаружился 0
                    counter_release = 0; //Обнулить счётчик отпускания кнопки
                    key = keys[counter_row_scan][counter_col_scan]; //Записать текущеесостояние кнопки из массива
                    if(key == old_key){ //Если текущая кнопка равна кнопке с прошлого сканирования
                        if(KEYB_COUNT_SCAN == counter_pressed++){ //Если кнопку нажимают в течении количества сканирований, указанных в параметрах, то засчитываем нажатие кнопки
                            find_key = key; //Кнопка найдена
                        }
                        if(KEYB_HOLD_COUNTER_PERIOD == counter_pressed){ //Срабатывание от длительного нажатия кнопки //Если кнопка нажата в течении указанного в параметрах количества секунд
                            find_hold_key = key; //Символ пустышка, для опознования, что сработало долгое нажатие определённой кнопки.
                        }
                    }else{
                        old_key = key; //В следующем сканировании, old key это будет значение кнопки просканенное в прошлый раз
                    }
                }else{
                    if(counter_pressed > KEYB_COUNT_SCAN){ //Если количество сканирований нажатой кнопки больше указанных в параметрах
                    if((COLS * KEYB_COUNT_SCAN) == counter_release++){ //счетчик что кнопку отпустили
                        counter_pressed = 0; //Сброс счётчика нажатой кнопки
                        counter_release = 0; //Сброс счётчика отпущенной кнопки
                        TIM2->CR1 &= ~TIM_CR1_CEN; //Выключение таймера2
                        TIM2->CNT = 0; //Обнуление счётчика таймера2
                        old_key = 0;
                        key = 0;
                        for(i = 0; i < ROWS; i++){
                            row_port[i]->BRR = (1 << row_pin[i]); //Все пины рядов обратно в 0
                            EXTI->FTSR |= (1 << col_pin[i]); //Включаем прерывания путём вкл условия срабатывания прерывания (по спаду фронта)
                        }
                        return; //Кнопка отжата, всё выключили, больше в этой функции нечего делать, поэтому принудительно выходим
                    }
                }
            }
        }
        row_port[counter_row_scan]->BSRR = (1 << row_pin[counter_row_scan]); //После скана всех колонок поднимаем лог уровень на текущем ряде в 1
    }
}

#ifndef KEYBOARD_H
#define KEYBOARD_H
 
#include "stm32f10x.h"
#include "lcd.h"
//НАСТРОЙКИ=====================================================================
#define ROWS 4 //Объявляем, что на клаве 4 ряда кнопок
#define COLS 3 //Объявляем, что на клаве 3 колонки кнопок
#define KEYB_COUNT_SCAN 5 //Количество полных сканирований клавы, после которых принимается решение, что нажатие и отпускание кнопки засчитано.
#define KEYB_SCAN_PERIOD 10 //Keyboard period scan, ms
#define KEYB_HOLD_PERIOD 1000 //Period hold button, ms Продолжительность времени, за которое засчитываем удержание кнопки. Т.е. Длительное нажатие. 
#define KEYB_LED 0 //Если объявлен этот дефайн, то используется светодоид подтверждения нажатия клавиш. Если не используется, закомментировать строку. 0 - если светодиод включается подачей нуля на пин, 1 - если подачей единицы на пин
#define KEYB_BUZZER 1 //Если объявлен этот дефайн, то используется буззер подтверждения нажатия клавиш. Если не используется, закомментировать строку. 0 - если буззер включается подачей нуля на пин, 1 - если подачей единицы на пин
#define KEYB_ROW1_PORT GPIOB //Порт 1 ряда
#define KEYB_ROW2_PORT GPIOB //Порт 2 ряда
#define KEYB_ROW3_PORT GPIOB //Порт 3 ряда
#define KEYB_ROW4_PORT GPIOB //Порт 4 ряда
#define KEYB_ROW_PIN1 5 //Пин 1 ряда
#define KEYB_ROW_PIN2 6 //Пин 2 ряда 
#define KEYB_ROW_PIN3 7 //Пин 3 ряда
#define KEYB_ROW_PIN4 8 //Пин 4 ряда
#define KEYB_COL1_PORT GPIOB //Порт 1 колонки
#define KEYB_COL2_PORT GPIOB //Порт 2 колонки
#define KEYB_COL3_PORT GPIOB //Порт 3 колонки
//#define KEYB_COL4_PORT GPIOB //Порт 4 колонки
#define KEYB_COL_PIN1 11 //Пин 1 колонки 
#define KEYB_COL_PIN2 12 //Пин 2 колонки 
#define KEYB_COL_PIN3 13 //Пин 3 колонки 
//#define KEYB_COL_PIN4 14 //Пин 4 колонки 
//Конец НАСТРОЕК================================================================================================
#define KEYB_HOLD_COUNTER_PERIOD (KEYB_HOLD_PERIOD / KEYB_SCAN_PERIOD)
#define GPIO_MODE_ROWS 0x5 //Режим пина для рядов GP Out, 10MHz, Open Drain
#define GPIO_MODE_COLS 0x8 //Режим пина для колонок In, Push Pull
 
 
void KEYBOARD_INI(void);
void KEYBOARD_SCAN(void);
extern uint16_t start_scan;
extern char find_key, find_hold_key;
#endif

void keyboard_scan(void){
    int i;
    start_scan = 0; //Сбрасываем флаг, после вызова этой функции
    for(counter_row_scan = 0; counter_row_scan < ROWS; counter_row_scan++){ //Сканирование рядов
        row_port[counter_row_scan]->BSRRH = (1 << row_pin[counter_row_scan]); //Выставляем 0 на текущем пине рядов
        for(counter_col_scan = 0; counter_col_scan < COLS; counter_col_scan++){ //Сканирование колонок
            tmp = col_port[counter_col_scan]->IDR;
            if(!(tmp & (1 << col_pin[counter_col_scan]))){ //Если на текущем пине колонок обнаружился 0
                ke[i++] = keys[counter_row_scan][counter_col_scan];
            }
        }
        row_port[counter_row_scan]->BSRRL = (1 << row_pin[counter_row_scan]); //После скана всех колонок поднимаем лог уровень на текущем ряде в 1
    }
}