Flash 16字节对齐写操作

#define MCU_FLASH_PRGM_BASE      0x08000000
#define FLASH_128BITS_MASK       0xFFFFFFF0

bool halFlashWrite(HAL_FLASH_ADDR_t ofst, const void* pdat, uint16_t num)  
{  
    uint32_t actual_ofst = ofst | (uint32_t)MCU_FLASH_PRGM_BASE; // 计算实际写入的起始地址  
    uint32_t unaligned_start = actual_ofst % 16; // 计算起始地址的不对齐部分  
    uint8_t page_buf[16]; // 16字节的临时缓冲区  
  
    // 处理起始地址的不对齐部分  
    if (unaligned_start > 0)  
    {  
        memset(page_buf, 0xFF, 16); // 先将缓冲区填充为0xFF  
        if (pdat != NULL && num > 0)  
        {  
            // 复制未对齐部分的数据到缓冲区  
            uint32_t copy_size = (num < (16 - unaligned_start)) ? num : (16 - unaligned_start);  
            memcpy(page_buf + unaligned_start, pdat, copy_size);  
            mcuFlashWordWr(actual_ofst - unaligned_start, page_buf, 16);  
            pdat = (const uint8_t*)pdat + copy_size;  
            num -= copy_size;  
        }  
        else  
        {  
            mcuFlashWordWr(actual_ofst - unaligned_start, page_buf, 16);  
        }  
        actual_ofst += 16 - unaligned_start;  
    }  
  
    // 处理对齐后的数据写入  
    if (num >= 16)  
    {  
        // 如果pdat不为NULL且num是16的倍数，直接写入  
        if (pdat != NULL && (num % 16) == 0)  
        {  
            mcuFlashWordWr(actual_ofst, pdat, num);  
        }  
        else  
        {  
            // 如果num不是16的倍数，填充剩余的字节并写入  
            memset(page_buf, 0xFF, 16);  
            while (num > 0)  
            {  
                uint32_t write_size = (num < 16) ? num : 16;  
                if (pdat != NULL && num > 0)  
                {  
                    memcpy(page_buf, pdat, write_size);  
                    pdat = (const uint8_t*)pdat + write_size;  
                }  
                mcuFlashWordWr(actual_ofst, page_buf, 16);  
                actual_ofst += 16;  
                num -= write_size;  
            }  
        }  
    }  
    else if (pdat != NULL && num > 0)  
    {  
        // 处理剩余的小于16字节的数据，需要填充到16字节并写入  
        memset(page_buf, 0xFF, 16);  
        memcpy(page_buf, pdat, num);  
        mcuFlashWordWr(actual_ofst, page_buf, 16);  
    }  
  
    return true;  
}