STM32WB55, write in the internal flash memory with FreeRTOS

[RJARC.1]

Hi,

I try to save the configuration application in the internal flash memory of my STM32WB55 with this next fonction :

static int write(long offset, const uint8_t *buf, size_t size)
{
    size_t i;
 
    uint32_t addr = stm32wb_onchip_flash.addr + offset;
 
    volatile __ALIGN_BEGIN uint64_t write_data __ALIGN_END;
    volatile __ALIGN_BEGIN uint64_t read_data  __ALIGN_END;
    vTaskSuspendAll();
    __HAL_FLASH_CLEAR_FLAG(0xFFFFFFFF);
 
 
    HAL_FLASH_Unlock();
 
 
    __enable_irq(); //To be sure that HAL_FLASH_Program to not bloc in get tick function
 
 
    for (i = 0; i < size; i+=8, buf+=8, addr+=8)
        {
            memcpy(&write_data, buf, 8);
            /* write data */
            while(LL_FLASH_IsActiveFlag_OperationSuspended());
 
           volatile HAL_StatusTypeDef status = HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD,addr, write_data);
 
           if (status != HAL_OK)
            {
                volatile uint32_t  lastFlashError = HAL_FLASH_GetError();
                return -1;
            }
            read_data = *(uint64_t *)addr;
            /* check data */
 
            if (read_data != write_data)
            {
                __NOP();
                return -1;
            }
 
        }
   // vPortExitCritical();
    HAL_FLASH_Lock();
    xTaskResumeAll();
    return size;
}

This function works very well at initialization of the application. But when i call this function from a FreeRTOS task the HAL_FLASH_Program function return to me an error. The error is 0xA0, PGA error, but this function is always called with align adresse.

I already checked the option bytes without sucess... May be somebody have an idea to help me :\

Thank you.

[RJARC.1]

Update: 

I tried to lock the sempahores 2 and 7 before trying to write in the flash without success. 

i use this fonction : 

while(LL_HSEM_2StepLock(HSEM, 7, 0)) { }; 

LL_HSEM_ReleaseLock(HSEM, 2, 0);

For the moment, i do not use the BLE stack in my project. 

Somebody can help me ? 

Thank you.

Best Regards.