#include "hal_minifds.h" #include "cli.h" #define MINIFDS_PRINTF 0 #if MINIFDS_PRINTF #include "SEGGER_RTT.h" #include "cli.h" #define DEBUG_LOG_MINIFDS DEBUG_LOG #else #define DEBUG_LOG_MINIFDS(...) ; #endif #define ALIGN_WORD(x) ((x) % 4 == 0 ? (x) : (((x) / 4 + 1) * 4)) //例如 33->36 #define PARAMETER_CHECK(x) static char checkcec(uint32_t addr) { uint8_t crc = 0; minfds_record_t* recordhend = (minfds_record_t*)addr; for (int i = 0; i < recordhend->length; i++) { crc += ((uint8_t*)(addr + sizeof(minfds_record_t)))[i]; } if (crc == recordhend->crc8) { return 1; } else { return 0; } } static uint32_t jump(uint32_t addr) { minfds_record_t* recordhend = (minfds_record_t*)addr; return addr + ALIGN_WORD(recordhend->length + sizeof(minfds_record_t)); } void printctb(minfds_t* p_minifds) { DEBUG_LOG_MINIFDS(" free_capacity %6d bytes\r\n", p_minifds->free_capacity); DEBUG_LOG_MINIFDS(" duty_capacity %6d bytes\r\n", p_minifds->duty_capacity); DEBUG_LOG_MINIFDS(" FFFFFFFF %6d bytes\r\n", p_minifds->free_capacity - p_minifds->duty_capacity); DEBUG_LOG_MINIFDS(" record_count %3d\r\n", p_minifds->record_count); } void print_record(uint8_t* data, length_t length) { for (int i = 0; i < length; i++) { if (i % 16 == 0) { DEBUG_LOG_MINIFDS("\r\n %4d ", i); #if MINIFDS_PRINTF for (int k = 0; k < 0xffff; k++) ; #endif } DEBUG_LOG_MINIFDS("%2x ", data[i]); } DEBUG_LOG_MINIFDS("\r\n"); } char minfds_Scan(minfds_t* p_minifds) { uint32_t hendaddress = p_minifds->start_addr; minfds_record_t* recordhend = (minfds_record_t*)hendaddress; p_minifds->duty_capacity = 0; p_minifds->free_capacity = p_minifds->end_addr - p_minifds->start_addr; p_minifds->record_count = 0; DEBUG_LOG_MINIFDS(" minfds_Scan start !!!!!\r\n"); while (1) { if ((*(uint32_t*)hendaddress == 0xffffffff) || (uint32_t)hendaddress == p_minifds->end_addr) { for (uint32_t addr = hendaddress; addr < p_minifds->end_addr; addr++) { if (*(uint8_t*)addr != 0xff) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_HARDWARE 0XFFFF 0x%x !!!!!\r\n", addr); return MINIFDS_ERR_HARDWARE; } } DEBUG_LOG_MINIFDS(" minfds_Scan end !!!!!\r\n"); return MINIFDS_SUCCESS; } else { recordhend = (minfds_record_t*)hendaddress; if (checkcec(hendaddress)) { DEBUG_LOG_MINIFDS("Record addr %x Key %3d length %d %d CRC OK\r\n", (uint32_t)recordhend, recordhend->record_key, recordhend->length, ALIGN_WORD(recordhend->length + sizeof(minfds_record_t))); if (recordhend->record_key == 0) { p_minifds->duty_capacity += ALIGN_WORD(recordhend->length + sizeof(minfds_record_t)); } else { p_minifds->record_count++; p_minifds->free_capacity -= ALIGN_WORD(recordhend->length + sizeof(minfds_record_t)); } } else { DEBUG_LOG_MINIFDS("Record Key %3d : CRCERROR !!!!!\r\n", recordhend->record_key); } // print_record((uint8_t*)(hendaddress+sizeof(minfds_record_t)),recordhend->length); hendaddress = jump(hendaddress); if (hendaddress > p_minifds->end_addr) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_HARDWARE : 0x%x\r\n", hendaddress); return MINIFDS_ERR_HARDWARE; } } } } unsigned short minfds_record_count_get(minfds_t* p_minifds) { return p_minifds->record_count; } char minfds_gc(minfds_t* p_minifds) { #define WRITE_TINES 8 uint8_t gcbuffer[4096]; uint32_t duty_recodecount = 0; uint32_t recodecount = 0; uint32_t gcbuffer_index = 0; uint32_t erase_page_addr = p_minifds->start_addr; //接下来要擦除的扇区地址 uint32_t write_page_addr = p_minifds->start_addr; //接下来要的写地址 flash_OPER_Result rev = FLASH_OP_SUCCESS; unsigned short length; minfds_record_t* next_recordhend; minfds_record_t* recordhend = (minfds_record_t*)p_minifds->start_addr; DEBUG_LOG_MINIFDS("----------------------------gc s-------------------------- \r\n"); printctb(p_minifds); p_minifds->free_capacity = p_minifds->end_addr - p_minifds->start_addr; while (1) { if ((*(uint32_t*)recordhend == 0xffffffff) || (uint32_t)recordhend == p_minifds->end_addr) { if (duty_recodecount == 0) { break; } p_minifds->api.flash_page_erase(erase_page_addr); DEBUG_LOG_MINIFDS("flash_page_erase(1) %x %x\r\n", erase_page_addr, write_page_addr); //---------write--------- DEBUG_LOG_MINIFDS("write2 >= %x len =%d\r\n", write_page_addr, gcbuffer_index); for (int i = 0; i < gcbuffer_index / (4096 / WRITE_TINES); i++) { rev = p_minifds->api.flash_write( (uint32_t*)(write_page_addr + i * (4096 / WRITE_TINES)), (uint32_t*)(gcbuffer + i * (4096 / WRITE_TINES)), 4096 / 4 / WRITE_TINES); } if (gcbuffer_index % (4096 / WRITE_TINES) != 0) { rev = p_minifds->api.flash_write( (uint32_t*)(write_page_addr + (gcbuffer_index / (4096 / WRITE_TINES)) * (4096 / WRITE_TINES)), (uint32_t*)(gcbuffer + (gcbuffer_index / (4096 / WRITE_TINES)) * (4096 / WRITE_TINES)), (gcbuffer_index % (4096 / WRITE_TINES)) % 4 == 0 ? (gcbuffer_index % (4096 / WRITE_TINES)) / 4 : (gcbuffer_index % (4096 / WRITE_TINES)) / 4 + 1); } break; } else if (recordhend->record_key == 0) { duty_recodecount++; DEBUG_LOG_MINIFDS(" %3d page %2d :key duty, length %5d addr: %x\r\n", duty_recodecount, (erase_page_addr - p_minifds->start_addr) / 4096, recordhend->length, (uint32_t)recordhend); p_minifds->duty_capacity -= ALIGN_WORD(recordhend->length + sizeof(minfds_record_t)); next_recordhend = (minfds_record_t*)jump((uint32_t)recordhend); recordhend = next_recordhend; if ((uint32_t)recordhend > p_minifds->end_addr) { DEBUG_LOG_MINIFDS(" MINIFDS_ERR_HARDWARE 0x%x\r\n", (uint32_t)recordhend); return MINIFDS_ERR_HARDWARE; } while ((uint32_t)recordhend >= erase_page_addr + 4096) { p_minifds->api.flash_page_erase(erase_page_addr); erase_page_addr += 4096; DEBUG_LOG_MINIFDS("flash_page_erase(2) %x %x\r\n", erase_page_addr - 4096, write_page_addr); } } else { recodecount++; p_minifds->free_capacity -= ALIGN_WORD(recordhend->length + sizeof(minfds_record_t)); DEBUG_LOG_MINIFDS(" %3d page %2d :key %3d , length %5d addr: %x\r\n", recodecount, (erase_page_addr - p_minifds->start_addr) / 4096, recordhend->record_key, recordhend->length, (uint32_t)recordhend); next_recordhend = (minfds_record_t*)jump((uint32_t)recordhend); if ((uint32_t)next_recordhend > p_minifds->end_addr) { DEBUG_LOG_MINIFDS(" MINIFDS_ERR_HARDWARE 118 0x%x\r\n", (uint32_t)next_recordhend); return MINIFDS_ERR_HARDWARE; } length = (uint32_t)next_recordhend - (uint32_t)recordhend; for (uint32_t i = 0; i < length; i++) { gcbuffer[gcbuffer_index] = ((uint8_t*)recordhend)[i]; gcbuffer_index++; if (gcbuffer_index >= 4096) { gcbuffer_index = 0; DEBUG_LOG_MINIFDS("gcbuffer_index >= 4096\r\n"); while (erase_page_addr <= write_page_addr) { p_minifds->api.flash_page_erase(erase_page_addr); erase_page_addr += 4096; DEBUG_LOG_MINIFDS("flash_page_erase(3) %x %x\r\n", erase_page_addr - 4096, write_page_addr); } //---------write--------- DEBUG_LOG_MINIFDS("write >= %x len =%d\r\n", write_page_addr, 4096); for (int j = 0; j < WRITE_TINES; j++) { rev = p_minifds->api.flash_write( (uint32_t*)(write_page_addr + j * (4096 / WRITE_TINES)), (uint32_t*)(gcbuffer + j * (4096 / WRITE_TINES)), 4096 / 4 / WRITE_TINES); } write_page_addr += 4096; } } while ((uint32_t)next_recordhend >= erase_page_addr + 4096) { p_minifds->api.flash_page_erase(erase_page_addr); erase_page_addr += 4096; DEBUG_LOG_MINIFDS("flash_page_erase(4) %x %x\r\n", erase_page_addr - 4096, write_page_addr); } recordhend = next_recordhend; } #if MINIFDS_PRINTF for (int k = 0; k < 0xffff; k++); #endif } if (rev != FLASH_OP_SUCCESS) { DEBUG_LOG_MINIFDS(" MINIFDS_ERR_API_FAIL 0x%x\r\n", (uint32_t)p_minifds->duty_capacity); return MINIFDS_ERR_API_FAIL; } printctb(p_minifds); DEBUG_LOG_MINIFDS("----------------------------gc e-------------------------- \r\n"); return 0; } char minfds_record_add(minfds_t* p_minifds, key_t key, uint8_t* data, length_t length) { uint32_t sizewords; uint32_t rev; uint32_t hendaddress = p_minifds->start_addr; DEBUG_LOG_MINIFDS("minfds_record_add : \r\n"); printctb(p_minifds); DEBUG_LOG_MINIFDS(" Key = %d length = %d , 4klen:%d\r\n", key, length, ALIGN_WORD(length + sizeof(minfds_record_t))); if (length > MAX_RECORD_LENGTH) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_LENGTH length=%d\r\n", length); return MINIFDS_ERR_REPEAT_LENGTH; } if (key == 0) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_KEY key=0\r\n"); return MINIFDS_ERR_REPEAT_KEY; } if (p_minifds->free_capacity < ALIGN_WORD(length + sizeof(minfds_record_t))) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_NOT_FREE_CAPACITY\r\n"); return MINIFDS_ERR_NOT_FREE_CAPACITY; } if (p_minifds->free_capacity - p_minifds->duty_capacity < ALIGN_WORD(length + sizeof(minfds_record_t))) { DEBUG_LOG_MINIFDS(" minfds_record_add minfds_gc(p_minifds); %d,%d \r\n", p_minifds->duty_capacity, p_minifds->free_capacity); rev = minfds_gc(p_minifds); if (rev != 0) { DEBUG_LOG_MINIFDS(" minfds_record_add minfds_gc ERROR ; %d,%d \r\n", rev, p_minifds->free_capacity); return rev; } } while (1) { if ((*(uint32_t*)hendaddress == 0xffffffff) || (uint32_t)hendaddress == p_minifds->end_addr) { minfds_record_t hend; hend.record_key = key; hend.length = length; hend.crc8 = 0; for (int i = 0; i < length; i++) { hend.crc8 += data[i]; } sizewords = length; if (sizewords % 4 != 0) { sizewords = sizewords / 4 + 1; } else { sizewords = sizewords / 4; } DEBUG_LOG_MINIFDS(" writaddr 0x%x ,nextaddr 0x%x %d\r\n", hendaddress, hendaddress + ALIGN_WORD(hend.length + sizeof(minfds_record_t)), p_minifds->end_addr - hendaddress); p_minifds->free_capacity -= ALIGN_WORD(length + sizeof(minfds_record_t)); for (int a = 0; a < ALIGN_WORD(hend.length + sizeof(minfds_record_t)); a++) { if (*(uint8_t*)(hendaddress + a) != 0xff) { DEBUG_LOG_MINIFDS("flash data :\r\n"); print_record((uint8_t*)(hendaddress + sizeof(minfds_record_t)), sizewords * 4); DEBUG_LOG_MINIFDS("Ram data :\r\n"); print_record(data, sizewords * 4); DEBUG_LOG_MINIFDS("MINIFDS_ERR_HARDWARE NOT 0xFF\r\n"); return MINIFDS_ERR_HARDWARE; } } rev = p_minifds->api.flash_write((uint32_t*)hendaddress, (uint32_t*)&hend, sizeof(minfds_record_t) / 4); if (rev != FLASH_OP_SUCCESS) { printctb(p_minifds); DEBUG_LOG_MINIFDS("MINIFDS_ERR_API_FAIL flash_write 1 %d 0x%x 0x%x 0x%x\r\n", rev, (uint32_t*)hendaddress, (uint32_t*)&hend, sizeof(minfds_record_t) / 4); return MINIFDS_ERR_API_FAIL; } if (sizewords != 0) { rev = p_minifds->api.flash_write((uint32_t*)(hendaddress + sizeof(minfds_record_t)), (uint32_t*)data, sizewords); } if (rev == FLASH_OP_SUCCESS) { p_minifds->record_count++; if (checkcec(hendaddress) != 1) { DEBUG_LOG_MINIFDS("flash data :\r\n"); print_record((uint8_t*)(hendaddress + sizeof(minfds_record_t)), sizewords * 4); DEBUG_LOG_MINIFDS("Ram data :\r\n"); print_record(data, sizewords * 4); DEBUG_LOG_MINIFDS("MINIFDS_ERR_HARDWARE CRC\r\n"); return MINIFDS_ERR_HARDWARE; } DEBUG_LOG_MINIFDS("MINIFDS_SUCCESS\r\n"); return MINIFDS_SUCCESS; } else { DEBUG_LOG_MINIFDS("MINIFDS_ERR_API_FAIL flash_write 2 %d 0x%x 0x%x 0x%x\r\n", rev, (uint32_t*)(hendaddress + sizeof(minfds_record_t)), (uint32_t*)data, sizewords); return MINIFDS_ERR_API_FAIL; } } else { minfds_record_t* recordhend = (minfds_record_t*)hendaddress; if (recordhend->record_key == key) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_KEY\r\n"); return MINIFDS_ERR_REPEAT_KEY; } if (!checkcec(hendaddress)) { DEBUG_LOG_MINIFDS(" MINIFDS_ERR_HARDWARE CRC add 0x%x\r\n", hendaddress); return MINIFDS_ERR_HARDWARE; } hendaddress = jump(hendaddress); if (hendaddress > p_minifds->end_addr) { DEBUG_LOG_MINIFDS(" MINIFDS_ERR_HARDWARE 426 0x%x\r\n", hendaddress); return MINIFDS_ERR_HARDWARE; } } } } char minfds_record_find(minfds_t* p_minifds, key_t key, uint8_t* data, length_t* length) { uint32_t hendaddress = p_minifds->start_addr; minfds_record_t* recordhend = (minfds_record_t*)hendaddress; DEBUG_LOG_MINIFDS("minfds_record_find : \r\n"); DEBUG_LOG_MINIFDS(" Key = %d \r\n", key); if (key == 0) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_KEY key=0\r\n"); return MINIFDS_ERR_REPEAT_KEY; } if (*length == 0) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_LENGTH *length=0\r\n"); return MINIFDS_ERR_REPEAT_LENGTH; } while (1) { if ((*(uint32_t*)hendaddress == 0xffffffff) || (hendaddress == p_minifds->end_addr)) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_NOT_FIND_RECORD \r\n"); return MINIFDS_ERR_NOT_FIND_RECORD; } else if (recordhend->record_key == key) { if (*length < recordhend->length) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_LENGTH *length=%d\r\n", *length); return MINIFDS_ERR_REPEAT_LENGTH; } memcpy(data, (uint8_t*)(hendaddress + sizeof(minfds_record_t)), recordhend->length); *length = recordhend->length; DEBUG_LOG_MINIFDS(" length = %d \r\n", recordhend->length); return MINIFDS_SUCCESS; } else { hendaddress = jump(hendaddress); if (hendaddress > p_minifds->end_addr) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_HARDWARE \r\n"); return MINIFDS_ERR_HARDWARE; } recordhend = (minfds_record_t*)hendaddress; } } } char get_record_hendaddr(minfds_t* p_minifds, key_t key, uint32_t* addr) { uint32_t hendaddress = p_minifds->start_addr; minfds_record_t* recordhend = (minfds_record_t*)hendaddress; DEBUG_LOG_MINIFDS("minfds_record_get_length : \r\n"); DEBUG_LOG_MINIFDS(" Key = %d \r\n", key); if (key == 0) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_KEY key=0\r\n"); return MINIFDS_ERR_REPEAT_KEY; } while (1) { if ((*(uint32_t*)hendaddress == 0xffffffff) || (hendaddress == p_minifds->end_addr)) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_NOT_FIND_RECORD \r\n"); return MINIFDS_ERR_NOT_FIND_RECORD; } else if (recordhend->record_key == key) { *addr = (uint32_t)recordhend; DEBUG_LOG_MINIFDS(" addr = %x \r\n", *addr); return MINIFDS_SUCCESS; } else { hendaddress = jump(hendaddress); if (hendaddress > p_minifds->end_addr) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_HARDWARE \r\n"); return MINIFDS_ERR_HARDWARE; } recordhend = (minfds_record_t*)hendaddress; } } } char minfds_record_get_length(minfds_t* p_minifds, key_t key, length_t* length) { char rev = 0; uint32_t addr_hend = 0; minfds_record_t* recordhend = NULL; rev = get_record_hendaddr(p_minifds, key, &addr_hend); if (rev != MINIFDS_SUCCESS)return rev; recordhend = (minfds_record_t*)addr_hend; *length = recordhend->length; return MINIFDS_SUCCESS; } char minfds_record_find_mem(minfds_t* p_minifds, uint8_t* mem, int mem_len, key_t* key) { uint32_t hendaddress = p_minifds->start_addr; minfds_record_t* recordhend = (minfds_record_t*)hendaddress; DEBUG_LOG_MINIFDS("minfds_record_find_mem : \r\n"); DEBUG_LOG_MINIFDS(" mem_len = %d \r\n", mem_len); DEBUG_LOG_MINIFDS(" mem_len254 = %d \r\n", 100); DEBUG_LOG_MINIFDS(" [%s] \r\n", mem); if ((mem_len == 0) || (mem == NULL)) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_KEY key=0\r\n"); return MINIFDS_ERR_REPEAT_KEY; } while (1) { if ((*(uint32_t*)hendaddress == 0xffffffff) || (hendaddress == p_minifds->end_addr)) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_NOT_FIND_RECORD \r\n"); return MINIFDS_ERR_NOT_FIND_RECORD; } else if (recordhend->record_key != 0) { if (recordhend->length >= mem_len) { for (int i = 0;i < recordhend->length - mem_len;i++) { if (memcmp(mem, (uint8_t*)(hendaddress + i + sizeof(minfds_record_t)), mem_len) == 0) { *key = recordhend->record_key; DEBUG_LOG_MINIFDS("MINIFDS_SUCCESS -----\r\n"); return MINIFDS_SUCCESS; } } } hendaddress = jump(hendaddress); if (hendaddress > p_minifds->end_addr) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_HARDWARE \r\n"); return MINIFDS_ERR_HARDWARE; } recordhend = (minfds_record_t*)hendaddress; } else { hendaddress = jump(hendaddress); if (hendaddress > p_minifds->end_addr) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_HARDWARE \r\n"); return MINIFDS_ERR_HARDWARE; } recordhend = (minfds_record_t*)hendaddress; } } } char minfds_record_update(minfds_t* p_minifds, key_t key, uint8_t* data, length_t length) { uint32_t hendaddr = 0; char rev = 0; if (key == 0) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_KEY key=0\r\n"); return MINIFDS_ERR_REPEAT_KEY; } DEBUG_LOG_MINIFDS("minfds_record_update key=%d\r\n", key); rev = get_record_hendaddr(p_minifds, key, &hendaddr); if (rev == MINIFDS_SUCCESS) { minfds_record_t* recordhend = (minfds_record_t*)hendaddr; if (recordhend->length == length) { if (memcmp((uint8_t*)(hendaddr + sizeof(minfds_record_t)), data, length) == 0) { DEBUG_LOG_MINIFDS("MINIFDS_SUCCESS NOT NEED UPDATE\r\n"); return MINIFDS_SUCCESS; } } } rev = minfds_record_delete(p_minifds, key); if (rev != 0) { return rev; } return minfds_record_add(p_minifds, key, data, length); } char minfds_record_delete(minfds_t* p_minifds, key_t key) { uint32_t hendaddress = p_minifds->start_addr; flash_OPER_Result rev; minfds_record_t* recordhend = (minfds_record_t*)hendaddress; DEBUG_LOG_MINIFDS("minfds_record_delete : key %d ", key); if (key == 0) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_KEY key=0\r\n"); return MINIFDS_ERR_REPEAT_KEY; } while (1) { if ((*(uint32_t*)hendaddress == 0xffffffff) || (uint32_t)hendaddress == p_minifds->end_addr) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_NOT_FIND_RECORD record_count %d\r\n", p_minifds->record_count); return MINIFDS_ERR_NOT_FIND_RECORD; } if (recordhend->record_key == key) { minfds_record_t temp; memcpy(&temp, recordhend, sizeof(minfds_record_t)); temp.record_key = 0x00; p_minifds->duty_capacity += ALIGN_WORD(temp.length + sizeof(minfds_record_t)); p_minifds->free_capacity += ALIGN_WORD(temp.length + sizeof(minfds_record_t)); rev = p_minifds->api.flash_write((uint32_t*)hendaddress, (uint32_t*)&temp, sizeof(minfds_record_t) / 4); if (rev == FLASH_OP_SUCCESS) { if (memcmp(&temp, (uint32_t*)hendaddress, sizeof(minfds_record_t)) != 0) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_API_FAIL1\r\n"); return MINIFDS_ERR_API_FAIL; } DEBUG_LOG_MINIFDS("MINIFDS_SUCCESS\r\n"); p_minifds->record_count--; return MINIFDS_SUCCESS; } else { DEBUG_LOG_MINIFDS("MINIFDS_ERR_API_FAIL2\r\n"); return MINIFDS_ERR_API_FAIL; } } else { hendaddress = jump(hendaddress); if (hendaddress > p_minifds->end_addr) { DEBUG_LOG_MINIFDS(" MINIFDS_ERR_HARDWARE 0x%x\r\n", hendaddress); return MINIFDS_ERR_HARDWARE; } recordhend = (minfds_record_t*)hendaddress; } } } char minfds_record_delete_all(minfds_t* p_minifds) { uint32_t hendaddress = p_minifds->start_addr; uint32_t rev; minfds_record_t* recordhend = (minfds_record_t*)hendaddress; DEBUG_LOG_MINIFDS("minfds_record_delete_all : "); while (1) { if ((*(uint32_t*)hendaddress == 0xffffffff) || (uint32_t)hendaddress == p_minifds->end_addr) { return MINIFDS_SUCCESS; } if (recordhend->record_key != 0) { minfds_record_t temp; memcpy(&temp, recordhend, sizeof(minfds_record_t)); temp.record_key = 0x00; p_minifds->duty_capacity += ALIGN_WORD(temp.length + sizeof(minfds_record_t)); p_minifds->free_capacity += ALIGN_WORD(temp.length + sizeof(minfds_record_t)); DEBUG_LOG_MINIFDS(" delete record_key : %d\r\n", recordhend->record_key); rev = p_minifds->api.flash_write((uint32_t*)hendaddress, (uint32_t*)&temp, sizeof(minfds_record_t) / 4); if (rev == FLASH_OP_SUCCESS) { p_minifds->record_count--; } else { DEBUG_LOG_MINIFDS("MINIFDS_ERR_API_FAIL\r\n"); return MINIFDS_ERR_API_FAIL; } } else { hendaddress = jump(hendaddress); if (hendaddress > p_minifds->end_addr) { DEBUG_LOG_MINIFDS(" MINIFDS_ERR_HARDWARE 0x%x\r\n", hendaddress); return MINIFDS_ERR_HARDWARE; } recordhend = (minfds_record_t*)hendaddress; } } } char minfds_format(minfds_t* p_minifds) { for (int i = 0; i < (p_minifds->end_addr - p_minifds->start_addr) / 4096; i++) { p_minifds->api.flash_page_erase(p_minifds->start_addr + i * 4096); } p_minifds->duty_capacity = 0; p_minifds->record_count = 0; p_minifds->free_capacity = p_minifds->end_addr - p_minifds->start_addr; return MINIFDS_SUCCESS; } char minfds_init(minfds_t* p_minifds) { DEBUG_LOG_MINIFDS("----------------------------------\r\n"); DEBUG_LOG_MINIFDS(" Minfds Start_addr : 0x%x\r\n", p_minifds->start_addr); DEBUG_LOG_MINIFDS(" Minfds End_addr : 0x%x \r\n", p_minifds->end_addr); minfds_Scan(p_minifds); printctb(p_minifds); DEBUG_LOG_MINIFDS("----------------------------------\r\n"); return 0; } char record_index(minfds_t* p_minifds, minfds_record_t* record, uint8_t* data, int index) { uint32_t hendaddress = p_minifds->start_addr; int i = 0; minfds_record_t* recordhend = (minfds_record_t*)hendaddress; DEBUG_LOG_MINIFDS("record_index : \r\n"); DEBUG_LOG_MINIFDS(" index = %d \r\n", index); if ((index >= p_minifds->record_count) || (record == NULL) || (data == NULL)) { // DEBUG_LOG_MINIFDS("MINIFDS_ERR_PARAMETER \r\n"); return MINIFDS_ERR_PARAMETER; } while (1) { if ((*(uint32_t*)hendaddress == 0xffffffff) || (hendaddress == p_minifds->end_addr)) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_NOT_FIND_RECORD \r\n"); return MINIFDS_ERR_NOT_FIND_RECORD; } else if (recordhend->record_key != 0) { if (i == index) { data = (uint8_t*)(hendaddress + sizeof(minfds_record_t)); record = recordhend; DEBUG_LOG_MINIFDS("MINIFDS_SUCCESS \r\n"); return MINIFDS_SUCCESS; } i++; } else { hendaddress = jump(hendaddress); if (hendaddress > p_minifds->end_addr) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_HARDWARE \r\n"); return MINIFDS_ERR_HARDWARE; } recordhend = (minfds_record_t*)hendaddress; } } } char pm_add(minfds_t* p_minifds, const char* key, int key_len, unsigned char* data, length_t length) { unsigned char buff[MAX_RECORD_LENGTH]; key_t TEMP_KEY = 1; char rev = 0; if (key_len + length + 1 >= MAX_RECORD_LENGTH) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_LENGTH \r\n"); return MINIFDS_ERR_REPEAT_LENGTH; } memcpy(buff, key, key_len); buff[key_len] = ':'; rev = minfds_record_find_mem(p_minifds, buff, key_len + 1, &TEMP_KEY); if (rev == MINIFDS_SUCCESS) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_KEY \r\n"); return MINIFDS_ERR_REPEAT_KEY; } memcpy(&buff[key_len + 1], data, length); while (1) { rev = minfds_record_add(p_minifds, TEMP_KEY, buff, key_len + length + 1); if (rev != MINIFDS_ERR_REPEAT_KEY) { return rev; } TEMP_KEY++; if (TEMP_KEY == 0) { return MINIFDS_ERR_REPEAT_KEY; } } } char pm_find(minfds_t* p_minifds, const char* key, int key_len, uint8_t* data, length_t* length) { key_t TEMP_KEY = 1; char rev = 0; length_t temp_len = MAX_RECORD_LENGTH; uint8_t buff[MAX_RECORD_LENGTH]; memcpy(buff, key, key_len); buff[key_len] = ':'; rev = minfds_record_find_mem(p_minifds, buff, key_len + 1, &TEMP_KEY); if (rev != MINIFDS_SUCCESS)return rev; rev = minfds_record_find(p_minifds, TEMP_KEY, buff, &temp_len); if (rev != MINIFDS_SUCCESS)return rev; memcpy(data, &buff[key_len + 1], temp_len - key_len - 1); *length = temp_len - key_len - 1; return MINIFDS_SUCCESS; } char pm_get_length(minfds_t* p_minifds, const char* key, int key_len, length_t* length) { key_t TEMP_KEY = 1; char rev = 0; length_t temp_len = 0; uint8_t buff[MAX_RECORD_LENGTH]; memcpy(buff, key, key_len); buff[key_len] = ':'; rev = minfds_record_find_mem(p_minifds, buff, key_len + 1, &TEMP_KEY); if (rev != MINIFDS_SUCCESS)return rev; rev = minfds_record_get_length(p_minifds, TEMP_KEY, &temp_len); *length = temp_len - key_len - 1; return rev; } char pm_delete(minfds_t* p_minifds, const char* key, int key_len) { key_t TEMP_KEY = 1; char rev = 0; uint8_t buff[MAX_RECORD_LENGTH]; memcpy(buff, key, key_len); buff[key_len] = ':'; rev = minfds_record_find_mem(p_minifds, buff, key_len + 1, &TEMP_KEY); if (rev != MINIFDS_SUCCESS)return rev; rev = minfds_record_delete(p_minifds, TEMP_KEY); if (rev != MINIFDS_SUCCESS)return rev; return MINIFDS_SUCCESS; } char pm_update(minfds_t* p_minifds, const char* key, int key_len, uint8_t* data, length_t length) { key_t TEMP_KEY = 1; char rev = 0; uint8_t buff[MAX_RECORD_LENGTH]; printctb(p_minifds); if (key_len + length + 1 >= MAX_RECORD_LENGTH) { DEBUG_LOG_MINIFDS("MINIFDS_ERR_REPEAT_LENGTH \r\n"); return MINIFDS_ERR_REPEAT_LENGTH; } memcpy(buff, key, key_len); buff[key_len] = ':'; memcpy(&buff[key_len + 1], data, length); rev = minfds_record_find_mem(p_minifds, buff, key_len + 1, &TEMP_KEY); if (rev != MINIFDS_SUCCESS)return rev; return minfds_record_update(p_minifds, TEMP_KEY, buff, key_len + length + 1); } //----------------------------------------------------------------------------------------------------- /* extern minfds_t minifds; void pma_pcs(cli_t *p_cli, unsigned short argc, char **argv) { char keu[]="key1"; uint8_t datat[]="testdata"; pm_add(&minifds,keu,sizeof("key1"),datat,sizeof("testdata")); minfds_Scan(&minifds); } CLI_CMD_REGISTER(pma, "Cli cmd history", pma_pcs); void pmf_pcs(cli_t *p_cli, unsigned short argc, char **argv) { char keu[]="key1"; uint8_t datat[50]="11111111111"; uint8_t length=0; pm_find(&minifds,keu,sizeof("key1"),datat,&length); DEBUG_LOG_MINIFDS("%s \r\n",datat); } CLI_CMD_REGISTER(pmf, "Cli cmd history", pmf_pcs); void pmd_pcs(cli_t *p_cli, unsigned short argc, char **argv) { char keu[]="key1"; uint8_t datat[50]="11111111111"; pm_delete(&minifds,keu,sizeof("key1")); DEBUG_LOG_MINIFDS("%s \r\n",datat); } CLI_CMD_REGISTER(pmd, "Cli cmd history", pmd_pcs); void pmu_pcs(cli_t *p_cli, unsigned short argc, char **argv) { char keu[]="key1"; uint8_t datat[50]="11111111111"; pm_update(&minifds,keu,sizeof("key1"),datat,10); DEBUG_LOG_MINIFDS("%s \r\n",datat); } CLI_CMD_REGISTER(pmu, "Cli cmd history", pmu_pcs); */