Дисплей tm1637 не работает

Дисплей tm1637 не работает

Жирным вsделена функция, написанная с ошибкой (должен быть ScanKey).

Я переделал код под STM32:

volatile uint16_t Test_1 = 0;

unsigned char keydate = 0;

/// ====================
void I2CStart (void) // 1637 start
<
CLK_HIGH;
SDA_HIGH;
delay_us (2);
SDA_LOW;
>
// =========
void I2Cask (void) // 1637 Answer
<
CLK_LOW;
SDA_INPUT;///////////////////
delay_us (5); // After the falling edge of the eighth clock delay 5us, ACK signals the beginning of judgment
while (SDA_STATE);
SDA_OUTPUT;///////////////////
CLK_HIGH;
delay_us (2);
CLK_LOW;
>
// ====
void I2CStop (void) // 1637 Stop
<
CLK_LOW;
delay_us (2);
SDA_LOW;
delay_us (2);
CLK_HIGH;
delay_us (2);
SDA_HIGH;
>
// =====
void I2CWrByte (unsigned char oneByte) // write a byte
<
unsigned char i;
for (i = 0; i > 1;
CLK_HIGH;
delay_us (3);
>
>
// ———- —
unsigned char ScanKey (void) // read buttons
<
unsigned char rekey,i; //rkey, was not used
I2CStart ();
I2CWrByte (0x42); // read command buttons
I2Cask ();
SDA_HIGH; // read keys before data lines pulled
for (i = 0; i > 1;
delay_us(30);
CLK_HIGH;
SDA_INPUT;///////////////////
delay_us(30); ///////////////
if(SDA_STATE)///////////////////////////////////////////////////////////////////////Зависает ТУТ.
<
rekey=rekey|0x80;
>
else
<
rekey=rekey|0x00;
>
SDA_OUTPUT;///////////////////
delay_us(30);
>
I2Cask();
I2CStop();
return (rekey);
>
void SmgDisplay(void) // Write display register
<
unsigned char i;
I2CStart();
I2CWrByte(0x40); //40H address is automatically incremented by 1 mode, 44H fixed address mode
I2Cask();
I2CStop();
I2CStart();
I2CWrByte(0xc0); // Set the first address
I2Cask();
for(i=0;i CFGR &=

RCC_CFGR_SW; //Очистка битов выбора источника тактового сигнала
RCC->CR &=

RCC_CR_PLLON; //Отключаем генератор PLL
RCC->CR &=

RCC_CR_HSEON;
while((RCC->CR & RCC_CR_HSERDY)!=0) <>

RCC->CR |= RCC_CR_HSION; //Включить генератор HSI
while((RCC->CR & RCC_CR_HSIRDY)==0) <>
RCC->CFGR &=

RCC_CFGR_SW; //Выбрать источником тактового сигнала HSI
while((RCC->CFGR & RCC_CFGR_SWS)!=0) <> // !=0 — HSI; !=4 — HSE; !=8 — PLL;

RCC_CFGR_PPRE1;
while((RCC->CFGR & RCC_CFGR_PPRE1)!=0)<> // !=0 — Not devided; !=1024 — Dev=2; !=1280 — Dev=4; !=1536 — Dev=8; !=1792 — Dev=16;

init();// Initialization
SmgDisplay(); // Write register and open display

while(1)
<
keydate = ScanKey(); // Read key value, the key value is not read out for treatment.
>
>

BSRR |= GPIO_BSRR_BS6)
#define CLK_LOW (GPIOB->BSRR |= GPIO_BSRR_BR6)
#define SDA_HIGH (GPIOB->BSRR |= GPIO_BSRR_BS7)
#define SDA_LOW (GPIOB->BSRR |= GPIO_BSRR_BR7)

#define CLK_INPUT GPIOB->CRL &=

(GPIO_CRL_MODE6 | GPIO_CRL_CNF6); GPIOB->CRL |= (GPIO_CRL_CNF6_0)
#define CLK_OUTPUT GPIOB->CRL &=

(GPIO_CRL_MODE6 | GPIO_CRL_CNF6); GPIOB->CRL |= (GPIO_CRL_MODE6_0 | GPIO_CRL_CNF6_0)
#define SDA_INPUT GPIOB->CRL &=

(GPIO_CRL_MODE7 | GPIO_CRL_CNF7); GPIOB->CRL |= (GPIO_CRL_CNF7_0)
#define SDA_OUTPUT GPIOB->CRL &=

(GPIO_CRL_MODE7 | GPIO_CRL_CNF7); GPIOB->CRL |= (GPIO_CRL_MODE7_0 | GPIO_CRL_CNF7_0)

#define CLK_STATE (GPIOB->IDR & GPIO_IDR_IDR6)
#define SDA_STATE (GPIOB->IDR & GPIO_IDR_IDR7)

Вроде все правильно сделал, но код зависает в ожидании второго ACK.

Может кто-то делал подобное? Наверное есть какая-то особенность при запуске, про которую я не знаю.