Как читать данные по I2C с помощью HAL?

uint8_t y2s_Buffer;
uint16_t addr = 0x8404;
 
if(HAL_I2C_Master_Transmit(&head_I2C, (uint16_t)(ADR), (uint8_t*)addr, 2, 100) != HAL_OK){ // На этом моменте все зависает
return 0;
}
 
// До сюда даже не доходит
if(HAL_I2C_Master_Receive(&head_I2C, (uint16_t)ADR, (uint8_t*)y2s_Buffer, 1, 100) != HAL_OK){
return 0;
}

uint8_t y2s_Buffer[3];
 
uint16_t addr = 0x8404;
uint16_t val = 0x06;
 
y2s_Buffer[0] = (uint8_t)(addr >> 8);
y2s_Buffer[1] = (uint8_t)(addr & 0xFF);
y2s_Buffer[2] = (uint8_t)(val & 0xFF);
 
if(HAL_I2C_Master_Transmit(&head_I2C, (uint16_t)(ADR), (uint8_t*)y2s_Buffer, 3, 100) != HAL_OK){
return 0;
}

uint8_t y2s_Buffer[SIZE] = {0};
HAL_I2C_Master_Transmit(&head_I2C, I2C_DevAddress, &y2s_Buffer[0], SIZE, Timeout);

result User_MPU6050_Test(void)
{
uint8_t data[1];
uint16_t div_adr;
 
div_adr = (MPU6050_DEFAULT_ADDRESS | MPU6050_WRITE);
data[0] = MPU6050_RA_WHO_AM_I;
 
HAL_I2C_Master_Transmit(&hy2s1,div_adr,(uint8_t*)data,1,200);
 
div_adr = (MPU6050_DEFAULT_ADDRESS);
HAL_I2C_Master_Receive(&hy2s1,div_adr,(uint8_t*)data,1,200);
 
if(data[0] == 0x68) return 1;
return 0;
}

uint8_t I2C_Read_Byte(uint8_t addr)
{
uint8_t data = 0;
uint8_t d;
while (HAL_I2C_GetState(&hy2s1) != HAL_I2C_STATE_READY);
d = HAL_I2C_Master_Transmit(&hy2s1, SLAVE_ADDR, &addr, 1, TIMEOUT);
if ( d != HAL_OK) {
return d;
}
 
while (HAL_I2C_GetState(&hy2s1) != HAL_I2C_STATE_READY);
d = HAL_I2C_Master_Receive(&hy2s1, SLAVE_ADDR, &data, 1, TIMEOUT);
if ( d != HAL_OK) {
return d;
}
return data;
}
 
uint8_t I2C_Write_Byte(uint8_t addr, uint8_t data)
{
uint8_t buf[] = {addr, data};
uint8_t d;
while (HAL_I2C_GetState(&hy2s1) != HAL_I2C_STATE_READY);
d = HAL_I2C_Master_Transmit(&hy2s1, SLAVE_ADDR, buf, 2, TIMEOUT);
if ( d != HAL_OK) {
return d;
}
return HAL_OK;
}

I2C_Write_Byte(0x40, 0xD0);
prymtf("0x40: %x\n", I2C_Read_Byte(0x40));

if(hy2s->Init.AddressingMode == I2C_ADDRESSINGMODE_7BIT)
{
/* Send slave address */
hy2s->Instance->DR = I2C_7BIT_ADD_WRITE(DevAddress);
}

typedef enum
{
HAL_OK       = 0x00,
HAL_ERROR    = 0x01,
HAL_BUSY     = 0x02,
HAL_TIMEOUT  = 0x03
} HAL_StatusTypeDef;

uint8_t y2s_Buffer;
uint16_t addr = 0x8404;
 
if(HAL_I2C_Master_Transmit(&head_I2C, (uint16_t)(ADR), (uint8_t*)&addr, 2, 100) != HAL_OK){ // На этом моменте все зависает
return 0;
}
 
// До сюда даже не доходит
if(HAL_I2C_Master_Receive(&head_I2C, (uint16_t)ADR, (uint8_t*)&y2s_Buffer, 1, 100) != HAL_OK){
return 0;
}