Передача данных по i2c через DMA STM32F401CUE6

I2C_HandleTypeDef hi2c1;
 
void SystemClock_Config(void);
static void MX_GPIO_Init(void);
static void MX_I2C1_Init(void);
void DMA_Init(void);
uint8_t st7567a_IsDeviceReady(I2C_HandleTypeDef i2c);
void DMA_Transmit(I2C_HandleTypeDef *hi2c, uint8_t *pBuffer, uint8_t size);
void I2C_write(I2C_HandleTypeDef *hi2c, uint8_t Addr, uint8_t *pBuffer, uint16_t size);
//==============================================================================================================================
 
uint8_t addr_i2c;
uint8_t Buffer[10] = {0x1,0x2,0x3,0x4,0x5,0x6,0x7,0x8,0x9,0xFF};
//==============================================================================================================================
 
void DMA_Init(void)
{
  __enable_irq ();
  RCC->AHB1ENR|=RCC_AHB1ENR_DMA1EN;
  DMA1_Stream6->CR = 0 ;
  DMA1_Stream6->CR |= DMA_CHANNEL_6;
  DMA1_Stream6->CR |= DMA_SxCR_MINC;
  DMA1_Stream6->CR |= DMA_SxCR_DIR_0;
  DMA1_Stream6->CR |= DMA_SxCR_TCIE | DMA_SxCR_HTIE | DMA_SxCR_TEIE | DMA_SxCR_DMEIE;
  HAL_NVIC_SetPriority(DMA1_Stream6_IRQn, 0, 0);
  HAL_NVIC_EnableIRQ(DMA1_Stream6_IRQn);
}
//==============================================================================================================================
 
uint8_t st7567a_IsDeviceReady(I2C_HandleTypeDef i2c)
{
    for(uint8_t i = 0; i < 255; i++)
    {
        HAL_Delay(10);
        if(HAL_I2C_IsDeviceReady(&i2c, i, 3, 100) == HAL_OK)
        {
            return i;
        }
    }
    return 0;
}
//==============================================================================================================================
 
void DMA1_Stream6_IRQHandler(void)
{
    HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
    if(DMA1->HISR & DMA_HISR_TCIF6)
    {
        DMA1->HIFCR &= ~ DMA_HIFCR_CTCIF6;
        DMA1_Stream6->CR&=~DMA_SxCR_EN;
        uint8_t temp __attribute__((unused)) = hi2c1.Instance->SR1 | hi2c1.Instance->SR2;
        hi2c1.Instance->CR1 |= I2C_CR1_STOP;
        while( !( hi2c1.Instance->CR1 & I2C_CR1_STOP )) ;
    }
    else if(DMA1->HISR & DMA_HISR_HTIF6)
        {
        DMA1->HIFCR &= ~ DMA_HIFCR_CHTIF6;
        }
    else if(DMA1->HISR & DMA_HISR_TEIF6)
            {
        DMA1->HIFCR &= ~ DMA_HIFCR_CTEIF6;
            }
    else if(DMA1->HISR & DMA_HISR_DMEIF6)
            {
        DMA1->HIFCR &= ~ DMA_HIFCR_CDMEIF6;
            }
}
 
//==============================================================================================================================
uint8_t tmp = 1;
void DMA_Transmit(I2C_HandleTypeDef *hi2c, uint8_t *pBuffer, uint8_t size)
{
    DMA1_Stream6->M0AR = (uint32_t)pBuffer;
    DMA1_Stream6->PAR=(uint32_t)&hi2c->Instance->DR;
    DMA1_Stream6->NDTR = size;
    hi2c->Instance->CR2 |= I2C_CR2_DMAEN;
    DMA1_Stream6->CR |= DMA_SxCR_EN;
    tmp = 2;
}
//==============================================================================================================================
 
void I2C_write(I2C_HandleTypeDef *hi2c, uint8_t Addr, uint8_t *pBuffer, uint16_t size)
{
    while(hi2c->Instance->SR2&I2C_SR2_BUSY){;}
    hi2c->Instance->CR1 |= I2C_CR1_START | I2C_CR1_ACK;
    while( !( hi2c->Instance->SR1 & I2C_SR1_SB )){;}
    hi2c->Instance->DR = Addr;
    while( !( hi2c->Instance->SR1 & I2C_SR1_ADDR )){;}
    DMA_Transmit(hi2c, pBuffer, size);
}
 
int main(void)
{
SystemClock_Config();
MX_GPIO_Init();
MX_I2C1_Init();
DMA_Init();
addr_i2c = st7567a_IsDeviceReady(hi2c1);
I2C_write(&hi2c1, addr_i2c, Buffer, 10);
while (1)
{
}
}
void SystemClock_Config(void)
{
  RCC_OscInitTypeDef RCC_OscInitStruct = {0};
  RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
  __HAL_RCC_PWR_CLK_ENABLE();
  __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE2);
  RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
  RCC_OscInitStruct.HSEState = RCC_HSE_ON;
  RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
  RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
  RCC_OscInitStruct.PLL.PLLM = 15;
  RCC_OscInitStruct.PLL.PLLN = 72;
  RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2;
  RCC_OscInitStruct.PLL.PLLQ = 4;
  if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
  {
    Error_Handler();
  }
 
  /** Initializes the CPU, AHB and APB buses clocks
  */
  RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
                              |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
  RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
  RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
  RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
  RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
 
  if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_1) != HAL_OK)
  {
    Error_Handler();
  }
}
 
static void MX_I2C1_Init(void)
{
 
  hi2c1.Instance = I2C1;
  hi2c1.Init.ClockSpeed = 100000;
  hi2c1.Init.DutyCycle = I2C_DUTYCYCLE_2;
  hi2c1.Init.OwnAddress1 = 0;
  hi2c1.Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT;
  hi2c1.Init.DualAddressMode = I2C_DUALADDRESS_DISABLE;
  hi2c1.Init.OwnAddress2 = 0;
  hi2c1.Init.GeneralCallMode = I2C_GENERALCALL_DISABLE;
  hi2c1.Init.NoStretchMode = I2C_NOSTRETCH_DISABLE;
  if (HAL_I2C_Init(&hi2c1) != HAL_OK)
  {
    Error_Handler();
  }
}
 
static void MX_GPIO_Init(void)
{
  GPIO_InitTypeDef GPIO_InitStruct = {0};
 
  /* GPIO Ports Clock Enable */
  __HAL_RCC_GPIOC_CLK_ENABLE();
  __HAL_RCC_GPIOH_CLK_ENABLE();
  __HAL_RCC_GPIOA_CLK_ENABLE();
  __HAL_RCC_GPIOB_CLK_ENABLE();
 
  /*Configure GPIO pin Output Level */
  HAL_GPIO_WritePin(GPIOC, GPIO_PIN_13, GPIO_PIN_SET);
 
  /*Configure GPIO pin Output Level */
  HAL_GPIO_WritePin(GPIOC, GPIO_PIN_14|GPIO_PIN_15, GPIO_PIN_RESET);
 
  /*Configure GPIO pin Output Level */
  HAL_GPIO_WritePin(GPIOA, GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2|GPIO_PIN_3
                          |GPIO_PIN_4|GPIO_PIN_5|GPIO_PIN_6|GPIO_PIN_7
                          |GPIO_PIN_8|GPIO_PIN_9|GPIO_PIN_10|GPIO_PIN_11
                          |GPIO_PIN_12|GPIO_PIN_15, GPIO_PIN_RESET);
 
  /*Configure GPIO pin Output Level */
  HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2|GPIO_PIN_10
                          |GPIO_PIN_12|GPIO_PIN_13|GPIO_PIN_14|GPIO_PIN_15
                          |GPIO_PIN_3|GPIO_PIN_4|GPIO_PIN_8|GPIO_PIN_9, GPIO_PIN_RESET);
 
  /*Configure GPIO pins : PC13 PC14 PC15 */
  GPIO_InitStruct.Pin = GPIO_PIN_13|GPIO_PIN_14|GPIO_PIN_15;
  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
 
  /*Configure GPIO pins : PA0 PA1 PA2 PA3
                           PA4 PA5 PA6 PA7
                           PA8 PA9 PA10 PA11
                           PA12 PA15 */
  GPIO_InitStruct.Pin = GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2|GPIO_PIN_3
                          |GPIO_PIN_4|GPIO_PIN_5|GPIO_PIN_6|GPIO_PIN_7
                          |GPIO_PIN_8|GPIO_PIN_9|GPIO_PIN_10|GPIO_PIN_11
                          |GPIO_PIN_12|GPIO_PIN_15;
  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
 
  /*Configure GPIO pins : PB0 PB1 PB2 PB10
                           PB12 PB13 PB14 PB15
                           PB3 PB4 PB8 PB9 */
  GPIO_InitStruct.Pin = GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2|GPIO_PIN_10
                          |GPIO_PIN_12|GPIO_PIN_13|GPIO_PIN_14|GPIO_PIN_15
                          |GPIO_PIN_3|GPIO_PIN_4|GPIO_PIN_8|GPIO_PIN_9;
  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
 
  /*Configure GPIO pin : PB5 */
  GPIO_InitStruct.Pin = GPIO_PIN_5;
  GPIO_InitStruct.Mode = GPIO_MODE_IT_RISING;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
 
}
void Error_Handler(void)
{
  __disable_irq();
  while (1)
  {
  }
}

static void I2C_isr(int rx){
    uint32_t isr = DMA1->ISR;
    DMA_Channel_TypeDef *ch = (rx) ? DMA1_Channel7 : DMA1_Channel6;
    ch->CCR &= ~DMA_CCR_EN; // clear enable for further settings
    if(isr & (DMA_ISR_TEIF6 | DMA_ISR_TEIF7)){
        goterr = 1; goto ret;
    }
    if(dma_remain){ // receive/send next portion
        uint16_t len = (dma_remain > 255) ? 255 : dma_remain;
        ch->CNDTR = len;
        if(rx){
            if(!i2c_startr(dmaaddr, dma_remain, 0)){
                goterr = 1; goto ret;
            }
            ch->CMAR += 255;
        }
        dma_remain -= len;
        ch->CCR |= DMA_CCR_EN;
        DMA1->IFCR = DMA_IFCR_CTCIF6 | DMA_IFCR_CTCIF7;
        return;
    }else if(rx) i2c_got_DMA = 1; // last transfer was Rx and all data read
ret:
    ch->CCR = 0;
    I2Cbusy = 0;
    DMA1->IFCR = 0x0ff00000; // clear all flags for channel6/7
}