#ifdef SUPPORT_MS_EXTENSIONS #pragma bss_seg(".virfat_flash.data.bss") #pragma data_seg(".virfat_flash.data") #pragma const_seg(".virfat_flash.text.const") #pragma code_seg(".virfat_flash.text") #endif #include "system/includes.h" #include "app_config.h" #include "fs/virfat_flash.h" #if CONFIG_JL_UI_ENABLE #include "res/resfile.h" #endif #include "tzflash_api.h" #include "boot.h" #include "sdfile.h" #define AT_VOLATILE_RAM_CODE // AT(.virfat_flash_code) #define FLASH_SIZE_8M 0x800000 #define FLASH_SIZE_16M 0x1000000 #define FLASH_SIZE_32M 0x2000000 //要与fat_comm.exe -pad-backup2 -force-align-fat -out new_res.bin -image-size 8 对应 //要与fat_comm.exe -pad-backup2 -force-align-fat -out new_res.bin -image-size 16 对应 #if TCFG_VIRFAT_INSERT_FLASH_ENABLE #if(TCFG_VIRFAT_FLASH_DEV_PATY_SIZE> FLASH_SIZE_8M) #define CONFIG_FAT_FLASH_SIZE (((TCFG_VIRFAT_FLASH_DEV_PATY_SIZE)+FLASH_SIZE_16M-1)/FLASH_SIZE_16M*FLASH_SIZE_16M) #else #define CONFIG_FAT_FLASH_SIZE TCFG_VIRFAT_FLASH_DEV_PATY_SIZE #endif #else #define CONFIG_FAT_FLASH_SIZE CONFIG_EXTERN_FLASH_SIZE #endif // 如果需要使用16M以上的flash需要修改download.bat文件与之对应 #if (CONFIG_FAT_FLASH_SIZE > 8 * 1024 * 1024 /* FLASH_SIZE_8M */ ) #define OUTFLASH_FAT16_ENABLE 1 #else /* #if (CONFIG_EXTERN_FLASH_SIZE > FLASH_SIZE_8M) */ #define OUTFLASH_FAT16_ENABLE 0 #endif /* #if (CONFIG_EXTERN_FLASH_SIZE > FLASH_SIZE_8M) */ typedef struct _flash_private_info { /* char part_name[16]; */ u32 flash_private_addr; u32 private_len; } FLASH_PRIVATE_INFO; static virfat_flash_t virfat_flash; static void *fd; static u32 real_capacity = 0; static u32 jlfat_capacity = 0; #define VIRFAT_FLASH_SET_DAMAGED_PART 0 #if VIRFAT_FLASH_SET_DAMAGED_PART static u32 occupy_clust = 0; void sdfile_fat_sub_maxclust(u32 clust); #endif #define VIRFAT_FLASH_FAST_WRITE 1 void virfat_flash_flush(); #if VIRFAT_FLASH_FAST_WRITE static u8 *buf_write = NULL; static u32 virfat_addr; static u16 fast_write_timer = 0; static OS_MUTEX virfat_fast_write_mutex; #define FAST_WRITE_TIMEOUT 100 #define FAST_WRITE_TIMER_ENABLE 0 #define virfat_fast_write_mutex_init() os_mutex_create(&virfat_fast_write_mutex) #define virfat_fast_write_mutex_pend() os_mutex_pend(&virfat_fast_write_mutex, portMAX_DELAY) #define virfat_fast_write_mutex_post() os_mutex_post(&virfat_fast_write_mutex) #endif #define portMAX_DELAY 0 static OS_MUTEX virfat_flash_mutex; #define virfat_mutex_init() os_mutex_create(&virfat_flash_mutex) #define virfat_mutex_pend() os_mutex_pend(&virfat_flash_mutex, portMAX_DELAY) #define virfat_mutex_post() os_mutex_post(&virfat_flash_mutex) static void virfat_get_cpu_fatfs_addr(char *name, u32 *addr, u32 *len) { u32 start_addr = boot_info.sfc.app_addr; /* y_printf(">>>[test]:base_addr = %d, app_addr = %d\n", boot_info.sfc.sfc_base_addr, boot_info.sfc.app_addr); */ /* u32 offset = 0; */ struct sdfile_file_head head = {0}; /* u16 local_flash_key = get_chip_id_in_phonefs(); */ while (1) { /* extern int norflash_origin_read(u8 * buf, u32 offset, u32 len); */ /* norflash_origin_read((u8 *)&head, start_addr, sizeof(head)); */ memcpy(&head, (u8 *)start_addr, sizeof(head)); /* put_buf(&head, 32); */ /* decode_data_by_user_key_in_sdfile(local_flash_key, (u8 *)&head, sizeof(head), offset, sizeof(head)); */ if (head.head_crc != CRC16((u8 *)&head.data_crc, sizeof(head) - sizeof(head.head_crc))) { y_printf("\n >>>[test]:func = %s,line= %d\n", __FUNCTION__, __LINE__); return; } /* r_printf(">>>[test]:head.name = %s, name = %s\n", head.name, name); */ if (0 == memcmp(head.name, name, strlen(name))) { break; } /* offset += sizeof(head); */ start_addr += sizeof(head); } *addr = head.addr; *len = head.len; r_printf(">>>[test]:######### start_addr = 0x%x, len = 0x%x\n", head.addr, head.len); } #if TCFG_VIRFAT_FLASH_ENABLE void fat_copy(void *pDest, void *pSrc, u32 copyLen) { if (pDest != NULL && pSrc != NULL) { while (copyLen--) { ((u8 *)pDest)[copyLen] = ((u8 *)pSrc)[copyLen]; } } } static u16 ld_word(u8 *p) { if (p != NULL) { return (u16)p[1] << 8 | p[0]; } return 0; } static u32 ld_dword(u8 *p) { if (p != NULL) { return (u32)p[3] << 24 | p[2] << 16 | p[1] << 8 | p[0]; } return 0; } //fat 备份4Kfat_table和4K目录项，保留扇区扩大8K ,8M #if 1 static const u8 bpb_data[512] = { 0xEB, 0x3C, 0x90, 0x4D, 0x53, 0x44, 0x4F, 0x53, 0x35, 0x2E, 0x30, 0x00, 0x02, 0x08, 0x18, 0x00, 0x01, 0x80, 0x00, 0x00, 0x40, 0xF8, 0x08, 0x00, 0x3F, 0x00, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x29, 0xEE, 0x8D, 0xF2, 0x2C, 0x4E, 0x4F, 0x20, 0x4E, 0x41, 0x4D, 0x45, 0x20, 0x20, 0x20, 0x20, 0x46, 0x41, 0x54, 0x31, 0x36, 0x20, 0x20, 0x20, 0x33, 0xC9, 0x8E, 0xD1, 0xBC, 0xF0, 0x7B, 0x8E, 0xD9, 0xB8, 0x00, 0x20, 0x8E, 0xC0, 0xFC, 0xBD, 0x00, 0x7C, 0x38, 0x4E, 0x24, 0x7D, 0x24, 0x8B, 0xC1, 0x99, 0xE8, 0x3C, 0x01, 0x72, 0x1C, 0x83, 0xEB, 0x3A, 0x66, 0xA1, 0x1C, 0x7C, 0x26, 0x66, 0x3B, 0x07, 0x26, 0x8A, 0x57, 0xFC, 0x75, 0x06, 0x80, 0xCA, 0x02, 0x88, 0x56, 0x02, 0x80, 0xC3, 0x10, 0x73, 0xEB, 0x33, 0xC9, 0x8A, 0x46, 0x10, 0x98, 0xF7, 0x66, 0x16, 0x03, 0x46, 0x1C, 0x13, 0x56, 0x1E, 0x03, 0x46, 0x0E, 0x13, 0xD1, 0x8B, 0x76, 0x11, 0x60, 0x89, 0x46, 0xFC, 0x89, 0x56, 0xFE, 0xB8, 0x20, 0x00, 0xF7, 0xE6, 0x8B, 0x5E, 0x0B, 0x03, 0xC3, 0x48, 0xF7, 0xF3, 0x01, 0x46, 0xFC, 0x11, 0x4E, 0xFE, 0x61, 0xBF, 0x00, 0x00, 0xE8, 0xE6, 0x00, 0x72, 0x39, 0x26, 0x38, 0x2D, 0x74, 0x17, 0x60, 0xB1, 0x0B, 0xBE, 0xA1, 0x7D, 0xF3, 0xA6, 0x61, 0x74, 0x32, 0x4E, 0x74, 0x09, 0x83, 0xC7, 0x20, 0x3B, 0xFB, 0x72, 0xE6, 0xEB, 0xDC, 0xA0, 0xFB, 0x7D, 0xB4, 0x7D, 0x8B, 0xF0, 0xAC, 0x98, 0x40, 0x74, 0x0C, 0x48, 0x74, 0x13, 0xB4, 0x0E, 0xBB, 0x07, 0x00, 0xCD, 0x10, 0xEB, 0xEF, 0xA0, 0xFD, 0x7D, 0xEB, 0xE6, 0xA0, 0xFC, 0x7D, 0xEB, 0xE1, 0xCD, 0x16, 0xCD, 0x19, 0x26, 0x8B, 0x55, 0x1A, 0x52, 0xB0, 0x01, 0xBB, 0x00, 0x00, 0xE8, 0x3B, 0x00, 0x72, 0xE8, 0x5B, 0x8A, 0x56, 0x24, 0xBE, 0x0B, 0x7C, 0x8B, 0xFC, 0xC7, 0x46, 0xF0, 0x3D, 0x7D, 0xC7, 0x46, 0xF4, 0x29, 0x7D, 0x8C, 0xD9, 0x89, 0x4E, 0xF2, 0x89, 0x4E, 0xF6, 0xC6, 0x06, 0x96, 0x7D, 0xCB, 0xEA, 0x03, 0x00, 0x00, 0x20, 0x0F, 0xB6, 0xC8, 0x66, 0x8B, 0x46, 0xF8, 0x66, 0x03, 0x46, 0x1C, 0x66, 0x8B, 0xD0, 0x66, 0xC1, 0xEA, 0x10, 0xEB, 0x5E, 0x0F, 0xB6, 0xC8, 0x4A, 0x4A, 0x8A, 0x46, 0x0D, 0x32, 0xE4, 0xF7, 0xE2, 0x03, 0x46, 0xFC, 0x13, 0x56, 0xFE, 0xEB, 0x4A, 0x52, 0x50, 0x06, 0x53, 0x6A, 0x01, 0x6A, 0x10, 0x91, 0x8B, 0x46, 0x18, 0x96, 0x92, 0x33, 0xD2, 0xF7, 0xF6, 0x91, 0xF7, 0xF6, 0x42, 0x87, 0xCA, 0xF7, 0x76, 0x1A, 0x8A, 0xF2, 0x8A, 0xE8, 0xC0, 0xCC, 0x02, 0x0A, 0xCC, 0xB8, 0x01, 0x02, 0x80, 0x7E, 0x02, 0x0E, 0x75, 0x04, 0xB4, 0x42, 0x8B, 0xF4, 0x8A, 0x56, 0x24, 0xCD, 0x13, 0x61, 0x61, 0x72, 0x0B, 0x40, 0x75, 0x01, 0x42, 0x03, 0x5E, 0x0B, 0x49, 0x75, 0x06, 0xF8, 0xC3, 0x41, 0xBB, 0x00, 0x00, 0x60, 0x66, 0x6A, 0x00, 0xEB, 0xB0, 0x42, 0x4F, 0x4F, 0x54, 0x4D, 0x47, 0x52, 0x20, 0x20, 0x20, 0x20, 0x0D, 0x0A, 0x52, 0x65, 0x6D, 0x6F, 0x76, 0x65, 0x20, 0x64, 0x69, 0x73, 0x6B, 0x73, 0x20, 0x6F, 0x72, 0x20, 0x6F, 0x74, 0x68, 0x65, 0x72, 0x20, 0x6D, 0x65, 0x64, 0x69, 0x61, 0x2E, 0xFF, 0x0D, 0x0A, 0x44, 0x69, 0x73, 0x6B, 0x20, 0x65, 0x72, 0x72, 0x6F, 0x72, 0xFF, 0x0D, 0x0A, 0x50, 0x72, 0x65, 0x73, 0x73, 0x20, 0x61, 0x6E, 0x79, 0x20, 0x6B, 0x65, 0x79, 0x20, 0x74, 0x6F, 0x20, 0x72, 0x65, 0x73, 0x74, 0x61, 0x72, 0x74, 0x0D, 0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xAC, 0xCB, 0xD8, 0x55, 0xAA }; #else //fat 备份12Kfat_table和4K目录项，保留扇区扩大16K ,32M /* static const unsigned char bpb_data[512] = { */ static char bpb_data[512] = { 0xEB, 0x3C, 0x90, 0x4D, 0x53, 0x44, 0x4F, 0x53, 0x35, 0x2E, 0x30, 0x00, 0x02, 0x08, 0x30, 0x00, 0x01, 0x00, 0x01, 0x00, 0x00, 0xF8, 0x18, 0x00, 0x3F, 0x00, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x80, 0x00, 0x29, 0xEE, 0x8D, 0xF2, 0x2C, 0x4E, 0x4F, 0x20, 0x4E, 0x41, 0x4D, 0x45, 0x20, 0x20, 0x20, 0x20, 0x46, 0x41, 0x54, 0x31, 0x36, 0x20, 0x20, 0x20, 0x33, 0xC9, 0x8E, 0xD1, 0xBC, 0xF0, 0x7B, 0x8E, 0xD9, 0xB8, 0x00, 0x20, 0x8E, 0xC0, 0xFC, 0xBD, 0x00, 0x7C, 0x38, 0x4E, 0x24, 0x7D, 0x24, 0x8B, 0xC1, 0x99, 0xE8, 0x3C, 0x01, 0x72, 0x1C, 0x83, 0xEB, 0x3A, 0x66, 0xA1, 0x1C, 0x7C, 0x26, 0x66, 0x3B, 0x07, 0x26, 0x8A, 0x57, 0xFC, 0x75, 0x06, 0x80, 0xCA, 0x02, 0x88, 0x56, 0x02, 0x80, 0xC3, 0x10, 0x73, 0xEB, 0x33, 0xC9, 0x8A, 0x46, 0x10, 0x98, 0xF7, 0x66, 0x16, 0x03, 0x46, 0x1C, 0x13, 0x56, 0x1E, 0x03, 0x46, 0x0E, 0x13, 0xD1, 0x8B, 0x76, 0x11, 0x60, 0x89, 0x46, 0xFC, 0x89, 0x56, 0xFE, 0xB8, 0x20, 0x00, 0xF7, 0xE6, 0x8B, 0x5E, 0x0B, 0x03, 0xC3, 0x48, 0xF7, 0xF3, 0x01, 0x46, 0xFC, 0x11, 0x4E, 0xFE, 0x61, 0xBF, 0x00, 0x00, 0xE8, 0xE6, 0x00, 0x72, 0x39, 0x26, 0x38, 0x2D, 0x74, 0x17, 0x60, 0xB1, 0x0B, 0xBE, 0xA1, 0x7D, 0xF3, 0xA6, 0x61, 0x74, 0x32, 0x4E, 0x74, 0x09, 0x83, 0xC7, 0x20, 0x3B, 0xFB, 0x72, 0xE6, 0xEB, 0xDC, 0xA0, 0xFB, 0x7D, 0xB4, 0x7D, 0x8B, 0xF0, 0xAC, 0x98, 0x40, 0x74, 0x0C, 0x48, 0x74, 0x13, 0xB4, 0x0E, 0xBB, 0x07, 0x00, 0xCD, 0x10, 0xEB, 0xEF, 0xA0, 0xFD, 0x7D, 0xEB, 0xE6, 0xA0, 0xFC, 0x7D, 0xEB, 0xE1, 0xCD, 0x16, 0xCD, 0x19, 0x26, 0x8B, 0x55, 0x1A, 0x52, 0xB0, 0x01, 0xBB, 0x00, 0x00, 0xE8, 0x3B, 0x00, 0x72, 0xE8, 0x5B, 0x8A, 0x56, 0x24, 0xBE, 0x0B, 0x7C, 0x8B, 0xFC, 0xC7, 0x46, 0xF0, 0x3D, 0x7D, 0xC7, 0x46, 0xF4, 0x29, 0x7D, 0x8C, 0xD9, 0x89, 0x4E, 0xF2, 0x89, 0x4E, 0xF6, 0xC6, 0x06, 0x96, 0x7D, 0xCB, 0xEA, 0x03, 0x00, 0x00, 0x20, 0x0F, 0xB6, 0xC8, 0x66, 0x8B, 0x46, 0xF8, 0x66, 0x03, 0x46, 0x1C, 0x66, 0x8B, 0xD0, 0x66, 0xC1, 0xEA, 0x10, 0xEB, 0x5E, 0x0F, 0xB6, 0xC8, 0x4A, 0x4A, 0x8A, 0x46, 0x0D, 0x32, 0xE4, 0xF7, 0xE2, 0x03, 0x46, 0xFC, 0x13, 0x56, 0xFE, 0xEB, 0x4A, 0x52, 0x50, 0x06, 0x53, 0x6A, 0x01, 0x6A, 0x10, 0x91, 0x8B, 0x46, 0x18, 0x96, 0x92, 0x33, 0xD2, 0xF7, 0xF6, 0x91, 0xF7, 0xF6, 0x42, 0x87, 0xCA, 0xF7, 0x76, 0x1A, 0x8A, 0xF2, 0x8A, 0xE8, 0xC0, 0xCC, 0x02, 0x0A, 0xCC, 0xB8, 0x01, 0x02, 0x80, 0x7E, 0x02, 0x0E, 0x75, 0x04, 0xB4, 0x42, 0x8B, 0xF4, 0x8A, 0x56, 0x24, 0xCD, 0x13, 0x61, 0x61, 0x72, 0x0B, 0x40, 0x75, 0x01, 0x42, 0x03, 0x5E, 0x0B, 0x49, 0x75, 0x06, 0xF8, 0xC3, 0x41, 0xBB, 0x00, 0x00, 0x60, 0x66, 0x6A, 0x00, 0xEB, 0xB0, 0x42, 0x4F, 0x4F, 0x54, 0x4D, 0x47, 0x52, 0x20, 0x20, 0x20, 0x20, 0x0D, 0x0A, 0x52, 0x65, 0x6D, 0x6F, 0x76, 0x65, 0x20, 0x64, 0x69, 0x73, 0x6B, 0x73, 0x20, 0x6F, 0x72, 0x20, 0x6F, 0x74, 0x68, 0x65, 0x72, 0x20, 0x6D, 0x65, 0x64, 0x69, 0x61, 0x2E, 0xFF, 0x0D, 0x0A, 0x44, 0x69, 0x73, 0x6B, 0x20, 0x65, 0x72, 0x72, 0x6F, 0x72, 0xFF, 0x0D, 0x0A, 0x50, 0x72, 0x65, 0x73, 0x73, 0x20, 0x61, 0x6E, 0x79, 0x20, 0x6B, 0x65, 0x79, 0x20, 0x74, 0x6F, 0x20, 0x72, 0x65, 0x73, 0x74, 0x61, 0x72, 0x74, 0x0D, 0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xAC, 0xCB, 0xD8, 0x55, 0xAA }; #endif static u32 get_first_one(u32 n) { u32 pos = 0; for (pos = 0; pos < 32; pos++) { if (n & BIT(pos)) { return pos; } } return 0xff; } static bool virfat_flash_mount(virfat_flash_t *disk_handler, u8 *buf) { u32 fatsize; u32 maxclust; /* u32 sects_fat; */ u32 n_rootdir; /*计算FAT表大小*/ fatsize = ld_word(&buf[BPB_FATSz16]); /* Number of sectors per FAT */ if (!fatsize) { fatsize = ld_dword(&buf[BPB_FATSz32]); } disk_handler->fatsize = fatsize * 512; //fat表大小 byte. disk_handler->fatbase = ld_word(&buf[BPB_RsvdSecCnt]); /* FAT start sector (lba) */ /* disk_handler->fatbase2 = disk_handler->fatbase + fatsize; */ fatsize *= buf[BPB_NumFATs]; disk_handler->csize = get_first_one(buf[BPB_SecPerClus]); /* Number of sectors per cluster */ n_rootdir = ld_word(&buf[BPB_RootEntCnt]); /* Nmuber of root directory entries */ disk_handler->database = (disk_handler->fatbase + fatsize + n_rootdir / 16); /* Data start sector (lba) */ /*计算总容量*/ disk_handler->capacity = ld_word(&buf[BPB_TotSec16]); /* Number of sectors on the file system */ if (!disk_handler->capacity) { disk_handler->capacity = ld_dword(&buf[BPB_TotSec32]); } /* r_printf(">>>[test]:cap = 0x%x, csize = %d\n",disk_handler->capacity, disk_handler->csize); */ maxclust = (disk_handler->capacity - ld_word(&buf[BPB_RsvdSecCnt]) - fatsize - n_rootdir / 16) >> disk_handler->csize; disk_handler->max_clust = maxclust + 2; #if VIRFAT_FLASH_SET_DAMAGED_PART if (occupy_clust) { disk_handler->max_clust -= occupy_clust; occupy_clust = 0; } /* r_printf(">>>[test]:maxclust = %d\n", maxclust); */ #endif disk_handler->fs_type = (maxclust >= MIN_FAT32) ? FS_FAT32 : ((maxclust >= MIN_FAT16) ? FS_FAT16 : FS_FAT12); /* r_printf(">>>[test]:fs_type = 0x%x\n", disk_handler->fs_type); */ /* Root directory start cluster */ if (disk_handler->fs_type == FS_FAT32) { disk_handler->dirbase = disk_handler->database; disk_handler->database += 1 << disk_handler->csize; } else { disk_handler->dirbase = disk_handler->fatbase + fatsize; } disk_handler->clustSize = disk_handler->csize + 9; return TRUE; } static void vir_read_reserved_area(u8 *buf, u32 len) { if (buf != NULL) { memset(buf, 0, len); } } static void vir_read_BPB(u8 *buf, u32 offset, u32 len) { u8 *bpb_alloc = zalloc(512); if (bpb_alloc == NULL || offset > 512 || (offset + len) > 512) { memset(buf, 0, 512); return; } memcpy(bpb_alloc, bpb_data, 512); int a = 0; if (real_capacity >= 32 * 1024 * 1024 / 512) { fat_copy(&bpb_alloc[BPB_TotSec16], &a, 2); fat_copy(&bpb_alloc[BPB_TotSec32], &real_capacity, 4); } else { fat_copy(&bpb_alloc[BPB_TotSec16], &real_capacity, 2); } if (real_capacity >= 16 * 1024 * 1024 / 512) { int fatsize = (real_capacity * 512 / 4096 * 2 + 4097) / 4096 * 4096; //计算fat表大小,按fat16来,注意fat表前面占有F8FFFFFF. int fat_sector = fatsize / 512; int rsvdsec = fat_sector + 4096 / 512 + 4096 / 512; //目录项128 * 32 = 4096 不变,工具配置规则目录项没有扩大 /* r_printf(">>>[test]:fat_sector = 0x%x, rsvdsec = 0x%x\n", fat_sector, rsvdsec); */ fat_copy(&bpb_alloc[BPB_FATSz16], &fat_sector, 2); fat_copy(&bpb_alloc[BPB_RsvdSecCnt], &rsvdsec, 2); } put_buf((const u8 *)bpb_alloc, 96); memcpy(buf, bpb_alloc + offset, len); free(bpb_alloc); /* u8 bpb_jl_head[] = "JLBT_DISK"; */ /* memset(buf, 0, 512); */ /* memcpy(buf, bpb_data + offset, len); */ /* memcpy(buf + sizeof(bpb_data), bpb_jl_head, sizeof(bpb_jl_head)); */ /* buf[510] = 0x55; */ /* buf[511] = 0xAA; */ } static int virfat_read(void *fd, void *buf, u32 addr, u32 len) { int rlen = -1; if (fd != NULL && buf != NULL) { rlen = dev_bulk_read(fd, buf, addr, len); } return rlen; } static int virfat_write(void *fd, void *buf, u32 addr, u32 len) { int wlen = -1; if (fd != NULL && buf != NULL) { wlen = dev_bulk_write(fd, buf, addr, len); } return wlen; } static int virfat_ioctl(void *fd, u32 cmd, u32 arg) { int res = -1; if (fd != NULL) { res = dev_ioctl(fd, cmd, arg); } return res; } //////////////////////////////////////sdfile_fat 备份fat表和目录项///////////////////////////////////////////////// #define BACKUPS_SPACE ((virfat_flash.database - virfat_flash.fatbase) * 512) #define DIR_ENTRY_DEV_ADDR ((virfat_flash.dirbase - virfat_flash.fatbase) * 512) //sdfile_fat的fat表和目录项都是4K对齐的地址和长度 #define BK_BUF_LEN 4096 //记入VM，序号需要整理成独立的 /* #define CFG_FATFS_BACKUP_FLAG 145 */ extern const int FATFS_BACKUP_ENABLE; //文件系统安全备份功能使能 static u8 backup_record_flag = 0; typedef enum { BK_OK = 0, BK_DATA_IS_FF, BK_DATA_LEN_ISNOT_ALIGN, BK_FATFS_DATA_IS_WRONG, BK_ALREADY_RECORD, BK_NOT_RECORD, BK_DEV_READ_DATA_ERROR = 8, BK_DEV_ERASE_DATA_ERROR, BK_DEV_WRITE_DATA_ERROR, BK_FATFS_NOT_USED = 0xFF, } BK_RESULT; static u8 bk_check_is_FF(u8 *data, u32 len) { u8 is_ff_flag = 0; int sub_len = len / 32; if (len % 32) { return BK_DATA_LEN_ISNOT_ALIGN; } for (int j = 0; j < sub_len; j++) { is_ff_flag = 1; for (int i = 0; i < 32; i++) { if (data[i] != 0xFF) { is_ff_flag = 0; break; } } if (is_ff_flag) { break; } } return is_ff_flag; } static int virfat_flash_backups_fat_dir_data() { u8 *buf = zalloc(BK_BUF_LEN); ASSERT(buf); int ret = BK_OK; for (int offset = 0; offset < BACKUPS_SPACE; offset += BK_BUF_LEN) { int rw_len; rw_len = virfat_read(fd, buf, BACKUPS_SPACE + offset, BK_BUF_LEN); if (rw_len != BK_BUF_LEN) { ret = BK_DEV_READ_DATA_ERROR; goto __exit; } if (bk_check_is_FF(buf, BK_BUF_LEN)) { ret = BK_DATA_IS_FF; goto __exit; } //check fat table data if (offset == 0) { if (buf[0] != 0xF8 || buf[1] != 0xFF) { ret = BK_FATFS_DATA_IS_WRONG; goto __exit; } } //check dir entry data /* if (offset == DIR_ENTRY_DEV_ADDR) { */ /* } */ ret = virfat_ioctl(fd, IOCTL_ERASE_SECTOR, offset); if (ret) { ret = BK_DEV_ERASE_DATA_ERROR; goto __exit; } rw_len = virfat_write(fd, buf, offset, BK_BUF_LEN); if (rw_len != BK_BUF_LEN) { ret = BK_DEV_WRITE_DATA_ERROR; goto __exit; } } //VM 标记放在备份后面 u8 bk_info = 1; syscfg_write(CFG_FATFS_BACKUP_FLAG, &bk_info, sizeof(u8)); y_printf(">>>[test]:write bk_info = 0x%x\n", bk_info); __exit: y_printf("\n >>>[test]:func = %s,line= %d, ret = %d\n", __FUNCTION__, __LINE__, ret); if (buf) { free(buf); } return ret; } static int virfat_flash_resume_fat_dir_data() { u8 *buf = zalloc(BK_BUF_LEN); ASSERT(buf); int ret = BK_OK; for (int offset = 0; offset < BACKUPS_SPACE; offset += BK_BUF_LEN) { int rw_len; rw_len = virfat_read(fd, buf, offset, BK_BUF_LEN); if (rw_len != BK_BUF_LEN) { ret = BK_DEV_READ_DATA_ERROR; goto __exit; } /* y_printf(">>>[test]:offset = %d, fd = 0x%p, buf = 0x%p\n", offset, fd, buf); */ /* put_buf(buf, rw_len); */ if (bk_check_is_FF(buf, BK_BUF_LEN)) { ret = BK_DATA_IS_FF; goto __exit; } //check fat table data if (offset == 0) { if (buf[0] != 0xF8 || buf[1] != 0xFF) { ret = BK_FATFS_DATA_IS_WRONG; goto __exit; } } ret = virfat_ioctl(fd, IOCTL_ERASE_SECTOR, BACKUPS_SPACE + offset); if (ret) { ret = BK_DEV_ERASE_DATA_ERROR; goto __exit; } /* y_printf(">>>[test]:offset = %d, fd = 0x%p, buf = 0x%p\n", offset, fd, buf); */ rw_len = virfat_write(fd, buf, BACKUPS_SPACE + offset, BK_BUF_LEN); if (rw_len != BK_BUF_LEN) { ret = BK_DEV_WRITE_DATA_ERROR; goto __exit; } } //清VM 标记放在还原后面 u8 bk_info = 0; syscfg_write(CFG_FATFS_BACKUP_FLAG, (void *)&bk_info, sizeof(u8)); y_printf(">>>[test]:write bk_info = 0x%x\n", bk_info); __exit: y_printf("\n >>>[test]:func = %s,line= %d, ret = %d\n", __FUNCTION__, __LINE__, ret); if (buf) { free(buf); } return ret; } int virfat_flash_check_resume_flag() { //: fatfs 需要预留区域增加备份还原标志, sdfile_fat不需要,使用VM备份标志处理 int ret; u8 *buf = zalloc(BK_BUF_LEN); ASSERT(buf); u8 bk_info; syscfg_read(CFG_FATFS_BACKUP_FLAG, (void *)&bk_info, sizeof(u8)); y_printf(">>>[test]:read bk_info = 0x%x\n", bk_info); y_printf(">>>[test]:BACKUPS_SPACE = %d\n", BACKUPS_SPACE); u8 resume_flag = 0; for (int offset = 0; offset < BACKUPS_SPACE; offset += BK_BUF_LEN) { ret = virfat_read(fd, buf, BACKUPS_SPACE + offset, BK_BUF_LEN); if (ret != BK_BUF_LEN) { ret = BK_DEV_READ_DATA_ERROR; goto __exit; } if (bk_check_is_FF(buf, BK_BUF_LEN)) { resume_flag = 1; break; } //check fat table data if (offset == 0) { if (buf[0] != 0xF8 || buf[1] != 0xFF) { resume_flag = 1; break; } } } r_printf(">>>[test]:bk_info, resume_flag = 0x%x, 0x%x\n", bk_info, resume_flag); if (bk_info || resume_flag) { ret = virfat_flash_resume_fat_dir_data(); } __exit: if (buf) { free(buf); } return ret; } int fatfs_sdfile_fat_backup_fat_dir_data() { if (backup_record_flag) { return BK_ALREADY_RECORD; } int ret = virfat_flash_backups_fat_dir_data(); if (ret == BK_OK) { backup_record_flag = 1; } return ret; } int fatfs_backup_flag_clear() { printf("\n >>>[test]:func = %s,line= %d\n", __FUNCTION__, __LINE__); if (!backup_record_flag) { return BK_NOT_RECORD; } backup_record_flag = 0; u8 bk_info = 0; syscfg_write(CFG_FATFS_BACKUP_FLAG, (void *)&bk_info, sizeof(u8)); y_printf(">>>[test]:write bk_info = 0x%x\n", bk_info); return BK_OK; } void fatfs_backup_clear_null_dir() { backup_record_flag = 1; //避免此时刻进行备份 struct vfscan *fs = fscan("storage/virfat_flash/C/", "-r -tALL -sn ", 4); r_printf(">>>[test]:all filenum = %d\n", fs->file_number); for (int i = fs->file_number; i >= 1; i--) { FILE *fd = fselect(fs, FSEL_BY_NUMBER, i); if (fd) { struct vfs_attr attr; fget_attrs(fd, &attr); //空文件进行删除 if (0 == attr.sclust || 0 == attr.fsize) { fdelete(fd); } else { fclose(fd); } backup_record_flag = 1; //避免此时刻进行备份 } } fscan_release(fs); backup_record_flag = 0; } //////////////////////////////////////////////////////////////////////////////////////////// AT_VOLATILE_RAM_CODE static u32 virfat_flash_read(void *buf, u32 addr_sec, u32 len) { /* y_printf("11111111111[r:%d],,", addr_sec); */ u32 real_addrsec = 0; u32 rlen; if (buf == NULL) { return 0; } if (addr_sec == 0) { vir_read_BPB(buf, 0, 512); y_printf("fatbase:%d \n", virfat_flash.fatbase); y_printf("dirbase:%d \n", virfat_flash.dirbase); y_printf("database:%d \n", virfat_flash.database); return len; } else if (addr_sec < 4096 / 512) { vir_read_reserved_area(buf, len); return len; } else { real_addrsec = addr_sec - 4096 / 512; } /* r_printf(">>>[test]111111:real-add= %d\n",real_addrsec); */ #if VIRFAT_FLASH_FAST_WRITE virfat_fast_write_mutex_pend(); int align_addr = real_addrsec * 512 / 4096 * 4096; if (align_addr == virfat_addr) { virfat_flash_flush(); } virfat_fast_write_mutex_post(); #endif rlen = dev_bulk_read(fd, buf, real_addrsec * 512, len); return rlen; } static void virfat_fast_write_free(void *p) { #if VIRFAT_FLASH_FAST_WRITE virfat_fast_write_mutex_pend(); virfat_flash_flush(); if (buf_write) { free(buf_write); buf_write = NULL; } fast_write_timer = 0; virfat_fast_write_mutex_post(); #endif } static u32 virfat_flash_write(void *buf, u32 addr_sec, u32 len) { /* r_printf("[w:%d],,", addr_sec); */ u8 *buf_temp = (u8 *)zalloc(4096); u32 wlen = 0; u32 real_addrsec; if (buf == NULL) { if (buf_temp) { free(buf_temp); buf_temp = NULL; } return 0; } //backup deal if (FATFS_BACKUP_ENABLE && (addr_sec >= virfat_flash.fatbase) && (addr_sec < virfat_flash.database)) { u8 ret = fatfs_sdfile_fat_backup_fat_dir_data(); if (ret != BK_OK && ret != BK_ALREADY_RECORD) { wlen = 0; goto __exit; } } if (addr_sec == 0) { wlen = len; goto __exit; } else if (addr_sec < 4096 / 512) { wlen = len; goto __exit; } else if (addr_sec < virfat_flash.fatbase) { //备份区不写 /* real_addrsec = addr_sec - 4096 / 512 + 0; // 0为flash里面保留区域（备份fat表和目录项）实际位置。 */ wlen = len; goto __exit; } else if (addr_sec < virfat_flash.dirbase) { /* real_addrsec = addr_sec - 4096 / 512; */ int real_fatbase = virfat_flash.fatbase * 512 - 4096; if (virfat_flash.fatsize > 4096) { int a = (addr_sec - virfat_flash.fatbase) * 512 / 4096; real_fatbase += a * 4096; addr_sec -= a * 4096 / 512; } virfat_read(fd, buf_temp, real_fatbase, 4096); virfat_ioctl(fd, IOCTL_ERASE_SECTOR, real_fatbase); memcpy(buf_temp + (addr_sec - virfat_flash.fatbase) * 512, buf, len); wlen = virfat_write(fd, buf_temp, real_fatbase, 4096); if (wlen == 4096) { wlen = len; } } else if (addr_sec < virfat_flash.database) { /* real_addrsec = addr_sec - 4096 / 512; */ int real_dirbase = virfat_flash.dirbase * 512 - 4096; virfat_read(fd, buf_temp, real_dirbase, 4096); virfat_ioctl(fd, IOCTL_ERASE_SECTOR, real_dirbase); memcpy(buf_temp + (addr_sec - virfat_flash.dirbase) * 512, buf, len); wlen = virfat_write(fd, buf_temp, real_dirbase, 4096); if (wlen == 4096) { wlen = len; } } else { real_addrsec = addr_sec - 4096 / 512; /* real_addrsec = addr_sec - virfat_flash.database + 16 * 1024 * UNIT / 512; // 16KxUNIT为flash里面数据区实际位置。 */ int align_addr = real_addrsec * 512 / 4096 * 4096; int offset = real_addrsec * 512 % 4096; #if VIRFAT_FLASH_FAST_WRITE virfat_fast_write_mutex_pend(); if (FAST_WRITE_TIMER_ENABLE) { if (fast_write_timer) { sys_timeout_del(fast_write_timer); fast_write_timer = 0; } } if (!buf_write) { buf_write = (u8 *)zalloc(4096); ASSERT(buf_write); virfat_addr = 0; } if (virfat_addr == 0) { virfat_addr = align_addr; virfat_read(fd, buf_write, virfat_addr, 4096); } if (virfat_addr != align_addr) { virfat_ioctl(fd, IOCTL_ERASE_SECTOR, virfat_addr); wlen = virfat_write(fd, buf_write, virfat_addr, 4096); if (wlen != 4096) { r_printf(">>>[test]:wlen = %d, len = %d\n", wlen, len); log_e("write error!!!!!!!!!!!!!"); virfat_fast_write_mutex_post(); goto __exit; } virfat_addr = align_addr; virfat_read(fd, buf_write, virfat_addr, 4096); } memcpy(buf_write + offset, buf, len); wlen = len; if (FAST_WRITE_TIMER_ENABLE) { fast_write_timer = sys_timeout_add(NULL, virfat_fast_write_free, FAST_WRITE_TIMEOUT); } virfat_fast_write_mutex_post(); #else virfat_read(fd, buf_temp, align_addr, 4096); virfat_ioctl(fd, IOCTL_ERASE_SECTOR, align_addr); memcpy(buf_temp + offset, buf, len); wlen = virfat_write(fd, buf_temp, align_addr, 4096); if (wlen == 4096) { wlen = len; } #endif /* wlen = virfat_write(fd, buf, real_addrsec * 512, len); */ } __exit: if (buf_temp) { free(buf_temp); buf_temp = NULL; } return wlen; } AT_VOLATILE_RAM_CODE u32 virfat_flash_read_watch(void *buf, u32 addr_sec, u32 len) { /* y_printf("[r:%d],,", addr_sec); */ u32 real_addrsec = 0; u32 rlen; if (buf == NULL) { return 0; } /* if (addr_sec == 0) { */ if (addr_sec < 512) { vir_read_BPB(buf, addr_sec, len); y_printf("fatbase:%d \n", virfat_flash.fatbase); y_printf("dirbase:%d \n", virfat_flash.dirbase); y_printf("database:%d \n", virfat_flash.database); return len; } else if (addr_sec < 4096) { vir_read_reserved_area(buf, len); return len; } else { real_addrsec = addr_sec - 4096 ; } /* r_printf(">>>[test]:real-add= %d\n",real_addrsec); */ #if VIRFAT_FLASH_FAST_WRITE virfat_fast_write_mutex_pend(); int align_addr = real_addrsec / 4096 * 4096; if (align_addr == virfat_addr) { virfat_flash_flush(); } virfat_fast_write_mutex_post(); #endif rlen = dev_bulk_read(fd, buf, real_addrsec, len); return rlen; } u32 virfat_flash_write_watch(void *buf, u32 addr_sec, u32 len) { u32 wlen; u32 real_addrsec = 0; //backup deal if (FATFS_BACKUP_ENABLE && (addr_sec >= virfat_flash.fatbase) && (addr_sec < virfat_flash.database)) { u8 ret = fatfs_sdfile_fat_backup_fat_dir_data(); if (ret != BK_OK && ret != BK_ALREADY_RECORD) { return 0; } } if (addr_sec == 0) { return len; } else if (addr_sec < 4096) { return len; } else { real_addrsec = addr_sec - 4096; } if (fd < 0) { log_e("Invalid file descriptor"); return 0; } wlen = virfat_write(fd, buf, real_addrsec, len); if (wlen != len) { r_printf(">>>[test]:wlen = %d, len = %d\n", wlen, len); log_e("write error!!!!!!!!!!!!!"); } return wlen; } u32 virfat_flash_erase_watch(int cmd, u32 arg) { if (arg == 0) { return 0; } else if (arg < 4096) { return 0; } else { arg = arg - 4096; } if (fd < 0) { log_e("Invalid file descriptor"); return 0; } return virfat_ioctl(fd, cmd, arg); } u32 virfat_flash_erase(int cmd, u32 arg) { if (fd < 0) { log_e("Invalid file descriptor"); return 0; } return virfat_ioctl(fd, cmd, arg); } u32 virfat_flash_capacity() //fat上容量 { return virfat_flash.capacity * 512; } u32 virfat_flash_get_real_capacity() //获取实际flash容量 { if (jlfat_capacity == 0) { virfat_ioctl(fd, IOCTL_GET_CAPACITY, (u32)&jlfat_capacity); #if (OUTFLASH_FAT16_ENABLE == 0) int min_fat16_size = 10 * 1024 * 1024; if (jlfat_capacity > min_fat16_size) { return min_fat16_size; } /* jlfat_capacity = 8 * 1024 * 1024; */ #else if (jlfat_capacity < 16 * 1024 * 1024) { #if VIRFAT_FLASH_SET_DAMAGED_PART y_printf(">>>[test]:real_capacity = 0x%x\n", jlfat_capacity); occupy_clust = CONFIG_FAT_FLASH_SIZE - jlfat_capacity; if (occupy_clust % 4096) { occupy_clust = occupy_clust / 4096 + 1; } else { occupy_clust = occupy_clust / 4096; } sdfile_fat_sub_maxclust(occupy_clust); #endif /* jlfat_capacity = 16 * 1024 * 1024; */ } #endif jlfat_capacity = CONFIG_FAT_FLASH_SIZE; } return jlfat_capacity; } /*----------------------------------------------------------------------------*/ /** @brief: @param: @return: @author:phewlee. @note: 外置flash jlaft文件系统,获取文件名。 @date: 2021-05-19 */ /*----------------------------------------------------------------------------*/ #define BUF_LEN 512 void virfat_flash_get_dirinfo(void *file_buf, u32 *file_num) { u32 cnt = 0; u8 *buf = zalloc(BUF_LEN); u8 name_buf[12] = {0}; u32 dir_len = (virfat_flash.database - virfat_flash.dirbase) * 512; for (int k = 0; k < dir_len; k += BUF_LEN) { virfat_flash_read_watch(buf, virfat_flash.dirbase * 512 + k, BUF_LEN); for (int i = 0; i < BUF_LEN; i += 32) { memset(name_buf, 0, 12); memcpy(name_buf, buf + i, 12); /* put_buf(buf, 32); */ if (name_buf[0] == 0xE5) { continue; } if ((name_buf[0] != 0) && (name_buf[1] != 0)) { if (file_buf) { memcpy((void *)((u32)file_buf + cnt * 12), name_buf, 12); } cnt++; /* r_printf(">>>[test]:name = %s\n", name_buf); */ } else { /* y_printf("\n >>>[test]:func = %s,line= %d\n",__FUNCTION__, __LINE__); */ break; } } } *file_num = cnt; free(buf); } /*----------------------------------------------------------------------------*/ /** @brief: @param: @return: @author:phewlee. @note: 外置flash jlaft文件系统,获取文件信息。 @date: 2021-05-19 */ /*----------------------------------------------------------------------------*/ #if JLFAT_DIRINFO_ENABLE void virfat_flash_get_alldirinfo(JLFAT_DIRINFO *dir_info, u32 *file_num) { u32 cnt = 0; u8 *buf = zalloc(BUF_LEN); u8 dir[32] = {0}; u32 dir_len = (virfat_flash.database - virfat_flash.dirbase) * 512; for (int k = 0; k < dir_len; k += BUF_LEN) { virfat_flash_read_watch(buf, virfat_flash.dirbase * 512 + k, BUF_LEN); for (int i = 0; i < BUF_LEN; i += 32) { memset(dir, 0, 32); memcpy(dir, buf + i, 32); if (dir[0] == 0xE5) { continue; } if ((dir[0] != 0) && (dir[1] != 0)) { if (dir_info) { memcpy(dir_info[cnt].name, dir, 11); dir_info[cnt].name[11] = 0; dir_info[cnt].attr = buf[DIR_Attr] & (~AM_FCH); dir_info[cnt].fsize = ld_dword((u8 *)(&dir[DIR_FileSize])); dir_info[cnt].sclust = ((u32)ld_word(&dir[DIR_FstClusHI]) << 16) | ld_word(&dir[DIR_FstClusLO]); dir_info[cnt].fix_date = ld_word((u8 *)(&dir[DIR_WrtDate])); dir_info[cnt].fix_time = ld_word((u8 *)(&dir[DIR_WrtTime])); } cnt++; /* r_printf(">>>[test]:name = %s\n", dir_info[cnt].name); */ } else { /* y_printf("\n >>>[test]:func = %s,line= %d\n",__FUNCTION__, __LINE__); */ break; } } } *file_num = cnt; free(buf); } #endif static u32 virfat_flash_available() { return 1; } u8 virfat_flash_init(void) { u32 a = 0; virfat_flash_mount(&virfat_flash, (u8 *)bpb_data); real_capacity = virfat_flash_get_real_capacity(); int min_fat32_size = ((MIN_FAT32 - 2) << (virfat_flash.csize + 9)); ASSERT(real_capacity < min_fat32_size, "capacity > min_fat32_size, not surport fat32 flash"); /* #if (OUTFLASH_FAT16_ENABLE == 0) */ /* #<{(| int min_fat16_size = ((MIN_FAT16 - 2) << (virfat_flash.csize + 9)); |)}># */ /* #<{(| r_printf(">>>[test]:min fat16 = %d\n", min_fat16_size); |)}># */ /* int min_fat16_size = 10 * 1024 * 1024; */ /* if (real_capacity > min_fat16_size) { */ /* real_capacity = min_fat16_size; */ /* } */ /* #endif */ u8 *bpb_alloc = zalloc(512); ASSERT(bpb_alloc); memcpy(bpb_alloc, bpb_data, 512); r_printf(">>>[test]:real_capacity = 0x%x\n", real_capacity); real_capacity = real_capacity / 512; if (virfat_flash.capacity != real_capacity) { if (real_capacity >= 32 * 1024 * 1024 / 512) { fat_copy(&bpb_alloc[BPB_TotSec16], &a, 2); fat_copy(&bpb_alloc[BPB_TotSec32], &real_capacity, 4); } else { fat_copy(&bpb_alloc[BPB_TotSec16], &real_capacity, 2); } if (real_capacity >= 16 * 1024 * 1024 / 512) { int fatsize = (real_capacity * 512 / 4096 * 2 + 4097) / 4096 * 4096; //计算fat表大小,按fat16来,注意fat表前面占有F8FFFFFF. int fat_sector = fatsize / 512; int rsvdsec = fat_sector + 4096 / 512 + 4096 / 512; //目录项128 * 32 = 4096 不变,工具配置规则目录项没有扩大 r_printf(">>>[test]:fat_sector = 0x%x, rsvdsec = 0x%x\n", fat_sector, rsvdsec); fat_copy(&bpb_alloc[BPB_FATSz16], &fat_sector, 2); fat_copy(&bpb_alloc[BPB_RsvdSecCnt], &rsvdsec, 2); } put_buf((const u8 *)bpb_alloc, 96); virfat_flash_mount(&virfat_flash, (u8 *) bpb_alloc); } /* y_printf("fatbase:%d \n", virfat_flash.fatbase); */ /* y_printf("dirbase:%d \n", virfat_flash.dirbase); */ /* y_printf("database:%d \n", virfat_flash.database); */ /* y_printf("clustSize:%d \n", virfat_flash.clustSize); */ if (bpb_alloc) { free(bpb_alloc); } return 0; } //////////////////////////////////////////////////////////////////////////////////////////////// ////////////////////////////device api////////////////////////////////////////////////////////// static struct device virfat_flash_dev; static int flash_virfat_init(const struct dev_node *node, void *arg) { /* r_printf(">>>[test]:init name = %s\n", virfat_flash.re_devname); */ if (arg) { memcpy(&virfat_flash.re_devname, arg, strlen(arg)); } return 0; } static int flash_virfat_open(const char *name, struct device **device, void *arg) { /* y_printf(">>>[test]:dev_name = %s\n", virfat_flash.re_devname); */ r_printf(">>>[test]:virfat_flash open!!!!!!\n"); *device = &virfat_flash_dev; fd = dev_open((const char *)&virfat_flash.re_devname, arg); ASSERT(fd); virfat_flash_init(); if (FATFS_BACKUP_ENABLE) { virfat_flash_check_resume_flag(); } return 0; } #if 0 AT_VOLATILE_RAM_CODE int flash_virfat_read(struct device *device, void *buf, u32 len, u32 addr) { /* y_printf(">>>[test]:r；addr = %d ,len = %d\n", addr, len); */ virfat_flash_read_watch(buf, addr, len); return len; } #else AT_VOLATILE_RAM_CODE int flash_virfat_read(struct device *device, void *buf, u32 len, u32 addr) { /* y_printf(">>>[test]:r；addr = %d ,len = %d\n", addr, len); */ void *_buf = buf; u32 _len = len; u32 _lba = addr; while (_len) { virfat_flash_read((void *)_buf, _lba, 512); //printf_buf(_buf, 512); _len -= 1; _lba += 1; _buf += 512; } return len; /* return virfat_flash_read(buf, addr, len); */ } #endif static int flash_virfat_write(struct device *device, void *buf, u32 len, u32 addr) { /* r_printf(">>>[test]:w；addr = %d ,len = %d\n", addr, len); */ /* return virfat_flash_write(buf, addr, len); */ void *_buf = buf; u32 _len = len; u32 _lba = addr; while (_len) { virfat_flash_write((void *)_buf, _lba, 512); //printf_buf(_buf, 512); _len -= 1; _lba += 1; _buf += 512; } return len; } static bool flash_virfat_online(const struct dev_node *node) { return 1; } #if VIRFAT_FLASH_FAST_WRITE int virfat_flash_fast_write_init(void) { virfat_fast_write_mutex_init(); return 0; } early_initcall(virfat_flash_fast_write_init); #endif void virfat_flash_flush() { #if VIRFAT_FLASH_FAST_WRITE virfat_fast_write_mutex_pend(); if (virfat_addr && buf_write && fd) { virfat_ioctl(fd, IOCTL_ERASE_SECTOR, virfat_addr); int wlen = virfat_write(fd, buf_write, virfat_addr, 4096); if (wlen != 4096) { /* r_printf(">>>[test]:wlen = %d, len = %d\n", wlen, len); */ log_e("write error!!!!!!!!!!!!!"); } virfat_addr = 0; } virfat_fast_write_mutex_post(); #endif } static int flash_virfat_close(struct device *device) { #if VIRFAT_FLASH_FAST_WRITE virfat_fast_write_mutex_pend(); if (FAST_WRITE_TIMER_ENABLE == 0) { virfat_fast_write_free(NULL); } virfat_fast_write_mutex_post(); #endif dev_close(device); return 0; } static int flash_virfat_ioctrl(struct device *device, u32 cmd, u32 arg) { int err = 0; switch (cmd) { case IOCTL_GET_STATUS: *(u32 *)arg = 1; break; case IOCTL_GET_ID: virfat_ioctl(fd, IOCTL_GET_ID, arg); /* *((u32 *)arg) = 0x12345678; */ break; case IOCTL_GET_CAPACITY: *((u32 *)arg) = virfat_flash_capacity(); break; case IOCTL_GET_BLOCK_SIZE: *((u32 *)arg) = 512; break; case IOCTL_ERASE_PAGE: case IOCTL_ERASE_SECTOR: case IOCTL_ERASE_BLOCK: /* y_printf(">>>[test]:in flash_vir eraser addr = %d\n", arg); */ err = virfat_flash_erase(cmd, arg); break; case IOCTL_FLUSH: /* y_printf("\n >>>[test]:func = %s,line= %d\n",__FUNCTION__, __LINE__); */ virfat_flash_flush(); virfat_ioctl(fd, IOCTL_FLUSH, arg); if (FATFS_BACKUP_ENABLE) { fatfs_backup_flag_clear(); } break; case IOCTL_CMD_RESUME: break; case IOCTL_CMD_SUSPEND: break; case IOCTL_SET_ASYNC_MODE: break; default: err = -EINVAL; break; } return err; } const struct device_operations virfat_flash_dev_ops = { .init = flash_virfat_init, .online = flash_virfat_online, .open = flash_virfat_open, .read = flash_virfat_read, .write = flash_virfat_write, .ioctl = flash_virfat_ioctrl, .close = flash_virfat_close, }; static int _private_sfc_read(void *fd, void *buf, u32 addr, u32 len) { struct device *device = (struct device *)fd; FLASH_PRIVATE_INFO *flash_private_info = (FLASH_PRIVATE_INFO *)device->private_data; if (flash_private_info->private_len < (addr + len)) { return -1; } u32 cpu_addr = sdfile_flash_addr2cpu_addr(flash_private_info->flash_private_addr + addr); /* r_printf(">>>[test]:cpu_addr = %d, addr = %d\n", cpu_addr, addr); */ memcpy((u8 *)buf, (u8 *)cpu_addr, len); /* put_buf(buf, len); */ return len; } static int _private_sfc_write(void *fd, void *buf, u32 addr, u32 len) { struct device *device = (struct device *)fd; FLASH_PRIVATE_INFO *flash_private_info = (FLASH_PRIVATE_INFO *)device->private_data; if (flash_private_info->private_len < (addr + len)) { return -1; } u32 wlen = -1; addr += flash_private_info->flash_private_addr; /* r_printf(">>>[test]:addr = %d\n", addr); */ /* put_buf(buf, len); */ wlen = tzflash_write(buf, len, addr); return wlen; } static int _private_sfc_ioctl(void *fd, u32 cmd, u32 arg) { int res = -1; struct device *device = (struct device *)fd; FLASH_PRIVATE_INFO *flash_private_info = (FLASH_PRIVATE_INFO *)device->private_data; if ((cmd == IOCTL_ERASE_SECTOR) || (cmd == IOCTL_ERASE_PAGE) || (cmd == IOCTL_ERASE_BLOCK)) { if (flash_private_info->private_len <= arg) { return -1; } arg += flash_private_info->flash_private_addr; } res = tzflash_ioctl(cmd, arg); return res; } static int private_sfc_init(const struct dev_node *node, void *arg) { virfat_mutex_init(); return 0; } static int private_sfc_open(const char *name, struct device **device, void *arg) { r_printf(">>>[test]:private_sfc open!!!!!!\n"); virfat_mutex_pend(); struct device *private_sfc_dev = (struct device *)zalloc(sizeof(struct device)); FLASH_PRIVATE_INFO *flash_private_info = (FLASH_PRIVATE_INFO *)zalloc(sizeof(FLASH_PRIVATE_INFO)); /* if (arg) { */ /* memcpy(flash_private_info->part_name, arg, strlen(arg)); */ /* } */ virfat_get_cpu_fatfs_addr(arg, &flash_private_info->flash_private_addr, &flash_private_info->private_len); private_sfc_dev->private_data = flash_private_info; *device = private_sfc_dev; virfat_mutex_post(); ASSERT(boot_info.vm.align >= 8, "virfat_flash erase sector < 4K is not support!!!!!!!!!"); return 0; } int private_sfc_read(struct device *device, void *buf, u32 len, u32 addr) { /* y_printf(">>>[test]:r；addr = %d ,len = %d\n", addr, len); */ virfat_mutex_pend(); int rlen = _private_sfc_read(device, buf, addr, len); virfat_mutex_post(); return rlen; } static int private_sfc_write(struct device *device, void *buf, u32 len, u32 addr) { /* r_printf(">>>[test]:w；addr = %d ,len = %d\n", addr, len); */ virfat_mutex_pend(); int wlen = _private_sfc_write(device, buf, addr, len); virfat_mutex_post(); return wlen; } static bool private_sfc_online(const struct dev_node *node) { return 1; } static int private_sfc_close(struct device *device) { virfat_mutex_pend(); dev_close(device); if (device->private_data) { free(device->private_data); } free(device); virfat_mutex_post(); return 0; } static int private_sfc_ioctrl(struct device *device, u32 cmd, u32 arg) { virfat_mutex_pend(); int err = 0; FLASH_PRIVATE_INFO *flash_private_info = (FLASH_PRIVATE_INFO *)device->private_data; switch (cmd) { case IOCTL_GET_STATUS: *(u32 *)arg = 1; break; case IOCTL_GET_ID: /* virfat_ioctl(device, IOCTL_GET_ID, arg); */ /* *((u32 *)arg) = 0x12345678; */ break; case IOCTL_GET_CAPACITY: *((u32 *)arg) = flash_private_info->private_len; break; case IOCTL_GET_BLOCK_SIZE: *((u32 *)arg) = 512; break; case IOCTL_ERASE_PAGE: case IOCTL_ERASE_SECTOR: case IOCTL_ERASE_BLOCK: /* y_printf(">>>[test]:in flash_vir eraser addr = %d\n", arg); */ err = _private_sfc_ioctl(device, cmd, arg); break; case IOCTL_FLUSH: break; case IOCTL_CMD_RESUME: break; case IOCTL_CMD_SUSPEND: break; case IOCTL_SET_ASYNC_MODE: break; default: err = -EINVAL; break; } virfat_mutex_post(); return err; } const struct device_operations private_sfc_dev_ops = { .init = private_sfc_init, .online = private_sfc_online, .open = private_sfc_open, .read = private_sfc_read, .write = private_sfc_write, .ioctl = private_sfc_ioctrl, .close = private_sfc_close, }; #else void virfat_flash_get_dirinfo(void *file_buf, u32 *file_num) { *file_num = 0; }; u32 virfat_flash_read_watch(void *buf, u32 addr_sec, u32 len) { return 0; } u32 virfat_flash_write_watch(void *buf, u32 addr_sec, u32 len) { return 0; } u32 virfat_flash_erase_watch(int cmd, u32 arg) { return 0; } u32 virfat_flash_capacity() { return 0; } u32 virfat_flash_get_real_capacity() { return 0; } #endif