2 * pffs.c - pseudo flash filesystem
4 * author: hackbard@hackdaworld.org
14 #define pffs_check_magic(data) (((data)&PFFS_INDEX_MAGIC_MASK)==PFFS_INDEX_MAGIC)
15 #define pffs_fnlen(data) (((data)&PFFS_FNLEN_MASK)>>4)
16 #define pffs_daddr_msb(data) (((data)&PFFS_LEN_MSB_MASK))
17 #define pffs_sec_erase(pffs,sec) pffs->fe(pffs->base_addr|pffs->sec_addr[sec])
19 u32 pffs_find_index(t_pffs *pffs,u8 sector) {
23 pffs->fr(pffs->base_addr+pffs->sec_addr[sector],&data,2);
25 if((data&0xf000)==PFFS_INDEX_MAGIC) {
26 pffs->index_sec=sector;
27 return PFFS_INDEX_FOUND;
30 return PFFS_NO_INDEX_FOUND;
33 int pffs_sec_empty(t_pffs *pffs,u8 sec) {
38 addr=pffs->base_addr|pffs->sec_addr[sec];
40 while(addr<(pffs->base_addr|pffs->sec_addr[sec+1])) {
41 pffs->fr(addr,&data,2);
43 return PFFS_SEC_NOT_EMPTY;
47 return PFFS_SEC_EMPTY;
50 int pffs_find_data_tmp(t_pffs *pffs,u8 sector) {
52 u32 iaddr,daddr,dend,dstart;
56 iaddr=pffs->base_addr|pffs->sec_addr[pffs->index_sec];
57 dstart=pffs->sec_addr[sector];
58 dend=pffs->sec_addr[sector+1];
60 while(iaddr<(pffs->base_addr|pffs->sec_addr[sector+1])) {
61 pffs->fr(iaddr,data,6);
62 if(pffs_check_magic(data[0]))
64 daddr=pffs_daddr_msb(data[0])|data[1];
65 if((daddr+data[2]<dstart)|(daddr>=dend)) {
66 fnlen=pffs_fnlen(data[0]);
67 iaddr+=(6+fnlen+fnlen);
71 return PFFS_NO_DATA_TMP;
74 pffs->data_tmp_sec=sector;
75 if(pffs_sec_empty(pffs,sector)!=PFFS_SEC_EMPTY)
76 pffs->fe(pffs->base_addr|dstart);
78 return PFFS_DATA_TMP_FOUND;;
81 int pffs_orientate(t_pffs *pffs) {
83 u8 sec,sec0,sec1,found;
85 sec0=pffs->sec_num_index[0];
86 sec1=pffs->sec_num_index[1];
90 /* check index sectors */
91 if(pffs_find_index(pffs,sec0)==PFFS_INDEX_FOUND)
93 else if(pffs_find_index(pffs,sec1)==PFFS_INDEX_FOUND)
96 /* chose temp data sector */
98 sec0=pffs->sec_num_data[0];
99 sec1=pffs->sec_num_data[1];
100 for(sec=sec1;sec>=sec0;sec--)
101 if(pffs_find_data_tmp(pffs,sec)==PFFS_DATA_TMP_FOUND)
104 return PFFS_INDEX_FOUND;
107 /* initial run => no data + no index assumed => check whether erased! */
108 // erase index sectors
109 if(!pffs_sec_empty(pffs,sec0))
110 pffs_sec_erase(pffs,sec0);
111 if(!pffs_sec_empty(pffs,sec1))
112 pffs_sec_erase(pffs,sec1);
113 pffs->index_sec=sec0;
114 // erase data sectors
115 sec0=pffs->sec_num_data[0];
116 sec1=pffs->sec_num_data[1];
117 pffs->data_tmp_sec=sec1;
118 for(sec=sec0;sec<=sec1;sec++)
119 if(!pffs_sec_empty(pffs,sec))
120 pffs_sec_erase(pffs,sec);
125 int pffs_get_data_sec(t_pffs_fd *fd) {
131 sec0=pffs->sec_num_data[0];
132 sec1=pffs->sec_num_data[1];
134 for(sec=sec0;sec<sec1;sec++) {
135 if((addr<pffs->sec_addr[sec+1])&(addr>=pffs->sec_addr[sec])) {
144 int pffs_rearrange(t_pffs *pffs) {
151 int pffs_flash_register(t_pffs *pffs,u32 base_addr,u32 *sec_addr,u8 sec_num,
152 int (*fw)(u32 addr,u16 *buf,int len),
153 int (*fr)(u32 addr,u16 *buf,int len),
154 int (*fe)(u32 addr)) {
156 /* assign physical flash specs */
157 pffs->base_addr=base_addr;
158 pffs->sec_addr=sec_addr;
159 pffs->sec_num=sec_num;
161 /* flash acccess function pointers */
166 pffs->state|=PFFS_REGISTERED;
171 int pffs_init(t_pffs *pffs) {
173 /* check whether a flash is registered */
174 if(!(pffs->state&PFFS_REGISTERED))
178 pffs_orientate(pffs);
183 int pffs_find_file(t_pffs *pffs,char *file,u32 *iaddr,u32 *daddr,u16 *len) {
186 u16 data[PFFS_MAX_FILENAME_SIZE+PFFS_HEADER_SIZE];
188 *iaddr=pffs->base_addr|pffs->sec_addr[pffs->index_sec];
190 while(*iaddr<pffs->sec_addr[pffs->index_sec+1]) {
191 pffs->fr(*iaddr,data,3);
193 if(!pffs_check_magic(data[0]))
196 fnl=pffs_fnlen(data[0]);
197 pffs->fr(*iaddr+6,data+3,fnl+fnl);
199 if(!strncmp(file,(char *)(data+3),fnl+fnl)) {
200 *daddr=pffs->base_addr|((data[0]&0x000f)<<16)|data[1];
202 return PFFS_FILE_FOUND;
208 return PFFS_FILE_NOT_FOUND;
211 int pffs_open_read(t_pffs_fd *fd) {
215 ret=pffs_find_file(fd->pffs,fd->file,
216 &(fd->iaddr),&(fd->daddr),&(fd->len));
218 if(ret==PFFS_FILE_FOUND) {
226 int pffs_write_index_init(t_pffs_fd *fd) {
229 u16 data[PFFS_HEADER_SIZE+PFFS_MAX_FILENAME_SIZE];
234 if(fd->iaddr+6+fns+fns>=pffs->sec_addr[pffs->index_sec+1])
235 return PFFS_NO_INDEX_SPACE_LEFT;
237 data[0]=0x7f00|(fns<<4)|((fd->daddr>>16)&0xf);
238 data[1]=fd->daddr&0xffff;
239 pffs->fw(fd->iaddr,data,4);
240 pffs->fw(fd->iaddr+6,fd->file,fns+fns);
242 return PFFS_INDEX_WROTE_INIT;
245 int pffs_write_finish(t_pffs_fd *fd) {
247 fd->pffs->fw(fd->iaddr+4,&(fd->len),2);
252 int pffs_open_write(t_pffs_fd *fd) {
256 ret=pffs_find_file(fd->pffs,fd->file,
257 &(fd->iaddr),&(fd->daddr),&(fd->len));
260 case PFFS_FILE_NOT_FOUND:
261 ret=pffs_write_index_init();
262 if(ret!=PFFS_INDEX_WROTE_INIT)
268 case PFFS_FILE_FOUND:
276 int pffs_open(t_pffs *pffs,t_pffs_fd *fd,char *file,u8 mode) {
280 /* the pffs struct */
284 fd->fn_size=strlen(file);
286 fd->file[fd->fn_size++]='\0';
288 if(fd->fn_size>PFFS_MAX_FILENAME_SIZE)
289 return PFFS_FILENAME_TOO_LONG;
290 strncpy(fd->file,file,fd->fn_size+fd->fn_size);
298 ret=pffs_open_read(fd);
301 ret=pffs_open_write(fd);
305 return PFFS_MODE_UNSUPPORTED;
311 int pffs_read(t_pffs_fd *fd,u8 *buf,int len) {
316 /* check whether valid */
317 if(!(fd->mode&PFFS_READ))
322 return PFFS_INVALID_LEN;
324 /* check how much we read */
325 missing=fd->len-(fd->dptr-fd->daddr);
329 if((fd->dptr+len)>=pffs->sec_addr[pffs->sec_num_data[1]+1])
330 sec_end=pffs->sec_addr[pffs->sec_num_data[1]+1]-fd->dptr;
334 fd->pffs->fr(fd->dptr,(u16 *)buf,len);
340 int pffs_write(t_pffs_fd *fd,u8 buf,int len) {
342 /* check whether valid */
343 if(!(fd->mode&PFFS_WRITE))
348 return PFFS_INVALID_LEN;
350 missing=PFFS_MAX_FILE_SIZE-fd->len;
355 if(fd->dptr+len>=pffs->)