1 // SPDX-License-Identifier: GPL-2.0+
5 * R/W (V)FAT 12/16/32 filesystem implementation by Donggeun Kim
14 #include <asm/byteorder.h>
16 #include <asm/cache.h>
17 #include <linux/ctype.h>
19 #include <linux/math64.h>
22 static void uppercase(char *str, int len)
26 for (i = 0; i < len; i++) {
32 static int total_sector;
33 static int disk_write(__u32 block, __u32 nr_blocks, void *buf)
40 if (cur_part_info.start + block + nr_blocks >
41 cur_part_info.start + total_sector) {
42 printf("error: overflow occurs\n");
46 ret = blk_dwrite(cur_dev, cur_part_info.start + block, nr_blocks, buf);
47 if (nr_blocks && ret == 0)
54 * set_name() - set short name in directory entry
56 * @dirent: directory entry
57 * @filename: long file name
59 static void set_name(dir_entry *dirent, const char *filename)
61 char s_name[VFAT_MAXLEN_BYTES];
63 int period_location, len, i, ext_num;
68 len = strlen(filename);
72 strncpy(s_name, filename, VFAT_MAXLEN_BYTES - 1);
73 s_name[VFAT_MAXLEN_BYTES - 1] = '\0';
74 uppercase(s_name, len);
76 period = strchr(s_name, '.');
78 period_location = len;
81 period_location = period - s_name;
82 ext_num = len - period_location - 1;
85 /* Pad spaces when the length of file name is shorter than eight */
86 if (period_location < 8) {
87 memcpy(dirent->name, s_name, period_location);
88 for (i = period_location; i < 8; i++)
89 dirent->name[i] = ' ';
90 } else if (period_location == 8) {
91 memcpy(dirent->name, s_name, period_location);
93 memcpy(dirent->name, s_name, 6);
95 * TODO: Translating two long names with the same first six
96 * characters to the same short name is utterly wrong.
97 * Short names must be unique.
99 dirent->name[6] = '~';
100 dirent->name[7] = '1';
104 memcpy(dirent->ext, s_name + period_location + 1, ext_num);
105 for (i = ext_num; i < 3; i++)
106 dirent->ext[i] = ' ';
108 memcpy(dirent->ext, s_name + period_location + 1, 3);
110 debug("name : %s\n", dirent->name);
111 debug("ext : %s\n", dirent->ext);
115 * Write fat buffer into block device
117 static int flush_dirty_fat_buffer(fsdata *mydata)
119 int getsize = FATBUFBLOCKS;
120 __u32 fatlength = mydata->fatlength;
121 __u8 *bufptr = mydata->fatbuf;
122 __u32 startblock = mydata->fatbufnum * FATBUFBLOCKS;
124 debug("debug: evicting %d, dirty: %d\n", mydata->fatbufnum,
125 (int)mydata->fat_dirty);
127 if ((!mydata->fat_dirty) || (mydata->fatbufnum == -1))
130 /* Cap length if fatlength is not a multiple of FATBUFBLOCKS */
131 if (startblock + getsize > fatlength)
132 getsize = fatlength - startblock;
134 startblock += mydata->fat_sect;
137 if (disk_write(startblock, getsize, bufptr) < 0) {
138 debug("error: writing FAT blocks\n");
142 if (mydata->fats == 2) {
143 /* Update corresponding second FAT blocks */
144 startblock += mydata->fatlength;
145 if (disk_write(startblock, getsize, bufptr) < 0) {
146 debug("error: writing second FAT blocks\n");
150 mydata->fat_dirty = 0;
156 * Set the file name information from 'name' into 'slotptr',
158 static int str2slot(dir_slot *slotptr, const char *name, int *idx)
162 for (j = 0; j <= 8; j += 2) {
163 if (name[*idx] == 0x00) {
164 slotptr->name0_4[j] = 0;
165 slotptr->name0_4[j + 1] = 0;
169 slotptr->name0_4[j] = name[*idx];
173 for (j = 0; j <= 10; j += 2) {
174 if (name[*idx] == 0x00) {
175 slotptr->name5_10[j] = 0;
176 slotptr->name5_10[j + 1] = 0;
180 slotptr->name5_10[j] = name[*idx];
184 for (j = 0; j <= 2; j += 2) {
185 if (name[*idx] == 0x00) {
186 slotptr->name11_12[j] = 0;
187 slotptr->name11_12[j + 1] = 0;
191 slotptr->name11_12[j] = name[*idx];
196 if (name[*idx] == 0x00)
200 /* Not used characters are filled with 0xff 0xff */
202 for (; end_idx < 5; end_idx++) {
203 slotptr->name0_4[end_idx * 2] = 0xff;
204 slotptr->name0_4[end_idx * 2 + 1] = 0xff;
209 for (; end_idx < 6; end_idx++) {
210 slotptr->name5_10[end_idx * 2] = 0xff;
211 slotptr->name5_10[end_idx * 2 + 1] = 0xff;
216 for (; end_idx < 2; end_idx++) {
217 slotptr->name11_12[end_idx * 2] = 0xff;
218 slotptr->name11_12[end_idx * 2 + 1] = 0xff;
224 static int new_dir_table(fat_itr *itr);
225 static int flush_dir(fat_itr *itr);
228 * Fill dir_slot entries with appropriate name, id, and attr
229 * 'itr' will point to a next entry
232 fill_dir_slot(fat_itr *itr, const char *l_name)
234 __u8 temp_dir_slot_buffer[MAX_LFN_SLOT * sizeof(dir_slot)];
235 dir_slot *slotptr = (dir_slot *)temp_dir_slot_buffer;
236 __u8 counter = 0, checksum;
239 /* Get short file name checksum value */
240 checksum = mkcksum(itr->dent->name, itr->dent->ext);
243 memset(slotptr, 0x00, sizeof(dir_slot));
244 ret = str2slot(slotptr, l_name, &idx);
245 slotptr->id = ++counter;
246 slotptr->attr = ATTR_VFAT;
247 slotptr->alias_checksum = checksum;
252 slotptr->id |= LAST_LONG_ENTRY_MASK;
254 while (counter >= 1) {
255 memcpy(itr->dent, slotptr, sizeof(dir_slot));
259 if (itr->remaining == 0)
262 /* allocate a cluster for more entries */
263 if (!fat_itr_next(itr))
265 (!itr->is_root || itr->fsdata->fatsize == 32) &&
274 * Set the entry at index 'entry' in a FAT (12/16/32) table.
276 static int set_fatent_value(fsdata *mydata, __u32 entry, __u32 entry_value)
278 __u32 bufnum, offset, off16;
281 switch (mydata->fatsize) {
283 bufnum = entry / FAT32BUFSIZE;
284 offset = entry - bufnum * FAT32BUFSIZE;
287 bufnum = entry / FAT16BUFSIZE;
288 offset = entry - bufnum * FAT16BUFSIZE;
291 bufnum = entry / FAT12BUFSIZE;
292 offset = entry - bufnum * FAT12BUFSIZE;
295 /* Unsupported FAT size */
299 /* Read a new block of FAT entries into the cache. */
300 if (bufnum != mydata->fatbufnum) {
301 int getsize = FATBUFBLOCKS;
302 __u8 *bufptr = mydata->fatbuf;
303 __u32 fatlength = mydata->fatlength;
304 __u32 startblock = bufnum * FATBUFBLOCKS;
306 /* Cap length if fatlength is not a multiple of FATBUFBLOCKS */
307 if (startblock + getsize > fatlength)
308 getsize = fatlength - startblock;
310 if (flush_dirty_fat_buffer(mydata) < 0)
313 startblock += mydata->fat_sect;
315 if (disk_read(startblock, getsize, bufptr) < 0) {
316 debug("Error reading FAT blocks\n");
319 mydata->fatbufnum = bufnum;
323 mydata->fat_dirty = 1;
325 /* Set the actual entry */
326 switch (mydata->fatsize) {
328 ((__u32 *) mydata->fatbuf)[offset] = cpu_to_le32(entry_value);
331 ((__u16 *) mydata->fatbuf)[offset] = cpu_to_le16(entry_value);
334 off16 = (offset * 3) / 4;
336 switch (offset & 0x3) {
338 val1 = cpu_to_le16(entry_value) & 0xfff;
339 ((__u16 *)mydata->fatbuf)[off16] &= ~0xfff;
340 ((__u16 *)mydata->fatbuf)[off16] |= val1;
343 val1 = cpu_to_le16(entry_value) & 0xf;
344 val2 = (cpu_to_le16(entry_value) >> 4) & 0xff;
346 ((__u16 *)mydata->fatbuf)[off16] &= ~0xf000;
347 ((__u16 *)mydata->fatbuf)[off16] |= (val1 << 12);
349 ((__u16 *)mydata->fatbuf)[off16 + 1] &= ~0xff;
350 ((__u16 *)mydata->fatbuf)[off16 + 1] |= val2;
353 val1 = cpu_to_le16(entry_value) & 0xff;
354 val2 = (cpu_to_le16(entry_value) >> 8) & 0xf;
356 ((__u16 *)mydata->fatbuf)[off16] &= ~0xff00;
357 ((__u16 *)mydata->fatbuf)[off16] |= (val1 << 8);
359 ((__u16 *)mydata->fatbuf)[off16 + 1] &= ~0xf;
360 ((__u16 *)mydata->fatbuf)[off16 + 1] |= val2;
363 val1 = cpu_to_le16(entry_value) & 0xfff;
364 ((__u16 *)mydata->fatbuf)[off16] &= ~0xfff0;
365 ((__u16 *)mydata->fatbuf)[off16] |= (val1 << 4);
380 * Determine the next free cluster after 'entry' in a FAT (12/16/32) table
381 * and link it to 'entry'. EOC marker is not set on returned entry.
383 static __u32 determine_fatent(fsdata *mydata, __u32 entry)
385 __u32 next_fat, next_entry = entry + 1;
388 next_fat = get_fatent(mydata, next_entry);
390 /* found free entry, link to entry */
391 set_fatent_value(mydata, entry, next_entry);
396 debug("FAT%d: entry: %08x, entry_value: %04x\n",
397 mydata->fatsize, entry, next_entry);
403 * set_sectors() - write data to sectors
405 * Write 'size' bytes from 'buffer' into the specified sector.
407 * @mydata: data to be written
408 * @startsect: sector to be written to
409 * @buffer: data to be written
410 * @size: bytes to be written (but not more than the size of a cluster)
411 * Return: 0 on success, -1 otherwise
414 set_sectors(fsdata *mydata, u32 startsect, u8 *buffer, u32 size)
419 debug("startsect: %d\n", startsect);
421 if ((unsigned long)buffer & (ARCH_DMA_MINALIGN - 1)) {
422 ALLOC_CACHE_ALIGN_BUFFER(__u8, tmpbuf, mydata->sect_size);
424 debug("FAT: Misaligned buffer address (%p)\n", buffer);
426 while (size >= mydata->sect_size) {
427 memcpy(tmpbuf, buffer, mydata->sect_size);
428 ret = disk_write(startsect++, 1, tmpbuf);
430 debug("Error writing data (got %d)\n", ret);
434 buffer += mydata->sect_size;
435 size -= mydata->sect_size;
437 } else if (size >= mydata->sect_size) {
438 nsects = size / mydata->sect_size;
439 ret = disk_write(startsect, nsects, buffer);
441 debug("Error writing data (got %d)\n", ret);
446 buffer += nsects * mydata->sect_size;
447 size -= nsects * mydata->sect_size;
451 ALLOC_CACHE_ALIGN_BUFFER(__u8, tmpbuf, mydata->sect_size);
452 /* Do not leak content of stack */
453 memset(tmpbuf, 0, mydata->sect_size);
454 memcpy(tmpbuf, buffer, size);
455 ret = disk_write(startsect, 1, tmpbuf);
457 debug("Error writing data (got %d)\n", ret);
466 * set_cluster() - write data to cluster
468 * Write 'size' bytes from 'buffer' into the specified cluster.
470 * @mydata: data to be written
471 * @clustnum: cluster to be written to
472 * @buffer: data to be written
473 * @size: bytes to be written (but not more than the size of a cluster)
474 * Return: 0 on success, -1 otherwise
477 set_cluster(fsdata *mydata, u32 clustnum, u8 *buffer, u32 size)
479 return set_sectors(mydata, clust_to_sect(mydata, clustnum),
484 flush_dir(fat_itr *itr)
486 fsdata *mydata = itr->fsdata;
487 u32 startsect, sect_offset, nsects;
489 if (!itr->is_root || mydata->fatsize == 32)
490 return set_cluster(mydata, itr->clust, itr->block,
491 mydata->clust_size * mydata->sect_size);
493 sect_offset = itr->clust * mydata->clust_size;
494 startsect = mydata->rootdir_sect + sect_offset;
495 /* do not write past the end of rootdir */
496 nsects = min_t(u32, mydata->clust_size,
497 mydata->rootdir_size - sect_offset);
499 return set_sectors(mydata, startsect, itr->block,
500 nsects * mydata->sect_size);
504 * Read and modify data on existing and consecutive cluster blocks
507 get_set_cluster(fsdata *mydata, __u32 clustnum, loff_t pos, __u8 *buffer,
508 loff_t size, loff_t *gotsize)
510 static u8 *tmpbuf_cluster;
511 unsigned int bytesperclust = mydata->clust_size * mydata->sect_size;
514 int clustcount, i, ret;
520 if (!tmpbuf_cluster) {
521 tmpbuf_cluster = memalign(ARCH_DMA_MINALIGN, MAX_CLUSTSIZE);
526 assert(pos < bytesperclust);
527 startsect = clust_to_sect(mydata, clustnum);
529 debug("clustnum: %d, startsect: %d, pos: %lld\n",
530 clustnum, startsect, pos);
532 /* partial write at beginning */
534 wsize = min(bytesperclust - pos, size);
535 ret = disk_read(startsect, mydata->clust_size, tmpbuf_cluster);
536 if (ret != mydata->clust_size) {
537 debug("Error reading data (got %d)\n", ret);
541 memcpy(tmpbuf_cluster + pos, buffer, wsize);
542 ret = disk_write(startsect, mydata->clust_size, tmpbuf_cluster);
543 if (ret != mydata->clust_size) {
544 debug("Error writing data (got %d)\n", ret);
552 startsect += mydata->clust_size;
558 /* full-cluster write */
559 if (size >= bytesperclust) {
560 clustcount = lldiv(size, bytesperclust);
562 if (!((unsigned long)buffer & (ARCH_DMA_MINALIGN - 1))) {
563 wsize = clustcount * bytesperclust;
564 ret = disk_write(startsect,
565 clustcount * mydata->clust_size,
567 if (ret != clustcount * mydata->clust_size) {
568 debug("Error writing data (got %d)\n", ret);
576 startsect += clustcount * mydata->clust_size;
578 for (i = 0; i < clustcount; i++) {
579 memcpy(tmpbuf_cluster, buffer, bytesperclust);
580 ret = disk_write(startsect,
583 if (ret != mydata->clust_size) {
584 debug("Error writing data (got %d)\n",
589 size -= bytesperclust;
590 buffer += bytesperclust;
591 *gotsize += bytesperclust;
593 startsect += mydata->clust_size;
598 /* partial write at end */
601 ret = disk_read(startsect, mydata->clust_size, tmpbuf_cluster);
602 if (ret != mydata->clust_size) {
603 debug("Error reading data (got %d)\n", ret);
606 memcpy(tmpbuf_cluster, buffer, wsize);
607 ret = disk_write(startsect, mydata->clust_size, tmpbuf_cluster);
608 if (ret != mydata->clust_size) {
609 debug("Error writing data (got %d)\n", ret);
624 * Find the first empty cluster
626 static int find_empty_cluster(fsdata *mydata)
628 __u32 fat_val, entry = 3;
631 fat_val = get_fatent(mydata, entry);
641 * Allocate a cluster for additional directory entries
643 static int new_dir_table(fat_itr *itr)
645 fsdata *mydata = itr->fsdata;
646 int dir_newclust = 0;
647 unsigned int bytesperclust = mydata->clust_size * mydata->sect_size;
649 dir_newclust = find_empty_cluster(mydata);
650 set_fatent_value(mydata, itr->clust, dir_newclust);
651 if (mydata->fatsize == 32)
652 set_fatent_value(mydata, dir_newclust, 0xffffff8);
653 else if (mydata->fatsize == 16)
654 set_fatent_value(mydata, dir_newclust, 0xfff8);
655 else if (mydata->fatsize == 12)
656 set_fatent_value(mydata, dir_newclust, 0xff8);
658 itr->clust = dir_newclust;
659 itr->next_clust = dir_newclust;
661 if (flush_dirty_fat_buffer(mydata) < 0)
664 memset(itr->block, 0x00, bytesperclust);
666 itr->dent = (dir_entry *)itr->block;
667 itr->last_cluster = 1;
668 itr->remaining = bytesperclust / sizeof(dir_entry) - 1;
674 * Set empty cluster from 'entry' to the end of a file
676 static int clear_fatent(fsdata *mydata, __u32 entry)
680 while (!CHECK_CLUST(entry, mydata->fatsize)) {
681 fat_val = get_fatent(mydata, entry);
683 set_fatent_value(mydata, entry, 0);
690 /* Flush fat buffer */
691 if (flush_dirty_fat_buffer(mydata) < 0)
698 * Set start cluster in directory entry
700 static void set_start_cluster(const fsdata *mydata, dir_entry *dentptr,
703 if (mydata->fatsize == 32)
705 cpu_to_le16((start_cluster & 0xffff0000) >> 16);
706 dentptr->start = cpu_to_le16(start_cluster & 0xffff);
710 * Check whether adding a file makes the file system to
711 * exceed the size of the block device
712 * Return -1 when overflow occurs, otherwise return 0
714 static int check_overflow(fsdata *mydata, __u32 clustnum, loff_t size)
716 __u32 startsect, sect_num, offset;
719 startsect = clust_to_sect(mydata, clustnum);
721 startsect = mydata->rootdir_sect;
723 sect_num = div_u64_rem(size, mydata->sect_size, &offset);
728 if (startsect + sect_num > total_sector)
734 * Write at most 'maxsize' bytes from 'buffer' into
735 * the file associated with 'dentptr'
736 * Update the number of bytes written in *gotsize and return 0
737 * or return -1 on fatal errors.
740 set_contents(fsdata *mydata, dir_entry *dentptr, loff_t pos, __u8 *buffer,
741 loff_t maxsize, loff_t *gotsize)
743 unsigned int bytesperclust = mydata->clust_size * mydata->sect_size;
744 __u32 curclust = START(dentptr);
745 __u32 endclust = 0, newclust = 0;
746 u64 cur_pos, filesize;
747 loff_t offset, actsize, wsize;
750 filesize = pos + maxsize;
752 debug("%llu bytes\n", filesize);
757 if (!CHECK_CLUST(curclust, mydata->fatsize) ||
758 IS_LAST_CLUST(curclust, mydata->fatsize)) {
759 clear_fatent(mydata, curclust);
760 set_start_cluster(mydata, dentptr, 0);
763 debug("curclust: 0x%x\n", curclust);
764 debug("Invalid FAT entry\n");
773 /* go to cluster at pos */
774 cur_pos = bytesperclust;
778 if (IS_LAST_CLUST(curclust, mydata->fatsize))
781 newclust = get_fatent(mydata, curclust);
782 if (!IS_LAST_CLUST(newclust, mydata->fatsize) &&
783 CHECK_CLUST(newclust, mydata->fatsize)) {
784 debug("curclust: 0x%x\n", curclust);
785 debug("Invalid FAT entry\n");
789 cur_pos += bytesperclust;
792 if (IS_LAST_CLUST(curclust, mydata->fatsize)) {
793 assert(pos == cur_pos);
797 assert(pos < cur_pos);
798 cur_pos -= bytesperclust;
801 assert(IS_LAST_CLUST(curclust, mydata->fatsize) ||
802 !CHECK_CLUST(curclust, mydata->fatsize));
805 /* search for allocated consecutive clusters */
806 actsize = bytesperclust;
809 if (filesize <= (cur_pos + actsize))
812 newclust = get_fatent(mydata, endclust);
814 if (newclust != endclust + 1)
816 if (IS_LAST_CLUST(newclust, mydata->fatsize))
818 if (CHECK_CLUST(newclust, mydata->fatsize)) {
819 debug("curclust: 0x%x\n", curclust);
820 debug("Invalid FAT entry\n");
824 actsize += bytesperclust;
828 /* overwrite to <curclust..endclust> */
832 offset = pos - cur_pos;
833 wsize = min_t(unsigned long long, actsize, filesize - cur_pos);
836 if (get_set_cluster(mydata, curclust, offset,
837 buffer, wsize, &actsize)) {
838 printf("Error get-and-setting cluster\n");
843 cur_pos += offset + wsize;
845 if (filesize <= cur_pos)
848 if (IS_LAST_CLUST(newclust, mydata->fatsize))
849 /* no more clusters */
855 if (filesize <= cur_pos) {
857 newclust = get_fatent(mydata, endclust);
858 if (!IS_LAST_CLUST(newclust, mydata->fatsize)) {
859 /* truncate the rest */
860 clear_fatent(mydata, newclust);
862 /* Mark end of file in FAT */
863 if (mydata->fatsize == 12)
865 else if (mydata->fatsize == 16)
867 else if (mydata->fatsize == 32)
868 newclust = 0xfffffff;
869 set_fatent_value(mydata, endclust, newclust);
877 assert(!do_div(cur_pos, bytesperclust));
880 /* allocate and write */
883 /* Assure that curclust is valid */
885 curclust = find_empty_cluster(mydata);
886 set_start_cluster(mydata, dentptr, curclust);
888 newclust = get_fatent(mydata, curclust);
890 if (IS_LAST_CLUST(newclust, mydata->fatsize)) {
891 newclust = determine_fatent(mydata, curclust);
892 set_fatent_value(mydata, curclust, newclust);
895 debug("error: something wrong\n");
900 /* TODO: already partially written */
901 if (check_overflow(mydata, curclust, filesize)) {
902 printf("Error: no space left: %llu\n", filesize);
906 actsize = bytesperclust;
909 /* search for consecutive clusters */
910 while (actsize < filesize) {
911 newclust = determine_fatent(mydata, endclust);
913 if ((newclust - 1) != endclust)
914 /* write to <curclust..endclust> */
917 if (CHECK_CLUST(newclust, mydata->fatsize)) {
918 debug("newclust: 0x%x\n", newclust);
919 debug("Invalid FAT entry\n");
923 actsize += bytesperclust;
926 /* set remaining bytes */
928 if (set_cluster(mydata, curclust, buffer, (u32)actsize) != 0) {
929 debug("error: writing cluster\n");
934 /* Mark end of file in FAT */
935 if (mydata->fatsize == 12)
937 else if (mydata->fatsize == 16)
939 else if (mydata->fatsize == 32)
940 newclust = 0xfffffff;
941 set_fatent_value(mydata, endclust, newclust);
945 if (set_cluster(mydata, curclust, buffer, (u32)actsize) != 0) {
946 debug("error: writing cluster\n");
953 if (CHECK_CLUST(newclust, mydata->fatsize)) {
954 debug("newclust: 0x%x\n", newclust);
955 debug("Invalid FAT entry\n");
958 actsize = bytesperclust;
959 curclust = endclust = newclust;
968 static void fill_dentry(fsdata *mydata, dir_entry *dentptr,
969 const char *filename, __u32 start_cluster, __u32 size, __u8 attr)
971 set_start_cluster(mydata, dentptr, start_cluster);
972 dentptr->size = cpu_to_le32(size);
974 dentptr->attr = attr;
976 set_name(dentptr, filename);
980 * Find a directory entry based on filename or start cluster number
981 * If the directory entry is not found,
982 * the new position for writing a directory entry will be returned
984 static dir_entry *find_directory_entry(fat_itr *itr, char *filename)
988 while (fat_itr_next(itr)) {
989 /* check both long and short name: */
990 if (!strcasecmp(filename, itr->name))
992 else if (itr->name != itr->s_name &&
993 !strcasecmp(filename, itr->s_name))
999 if (itr->dent->name[0] == '\0')
1005 /* allocate a cluster for more entries */
1007 (!itr->is_root || itr->fsdata->fatsize == 32) &&
1009 /* indicate that allocating dent failed */
1015 static int split_filename(char *filename, char **dirname, char **basename)
1017 char *p, *last_slash, *last_slash_cont;
1022 last_slash_cont = NULL;
1024 if (ISDIRDELIM(*p)) {
1026 last_slash_cont = p;
1027 /* continuous slashes */
1028 while (ISDIRDELIM(*p))
1029 last_slash_cont = p++;
1037 if (last_slash_cont == (filename + strlen(filename) - 1)) {
1038 /* remove trailing slashes */
1043 if (last_slash == filename) {
1044 /* avoid ""(null) directory */
1048 *dirname = filename;
1051 *last_slash_cont = '\0';
1052 *basename = last_slash_cont + 1;
1054 *dirname = "/"; /* root by default */
1055 *basename = filename;
1062 * normalize_longname() - check long file name and convert to lower case
1064 * We assume here that the FAT file system is using an 8bit code page.
1065 * Linux typically uses CP437, EDK2 assumes CP1250.
1067 * @l_filename: preallocated buffer receiving the normalized name
1068 * @filename: filename to normalize
1069 * Return: 0 on success, -1 on failure
1071 static int normalize_longname(char *l_filename, const char *filename)
1073 const char *p, illegal[] = "<>:\"/\\|?*";
1075 if (strlen(filename) >= VFAT_MAXLEN_BYTES)
1078 for (p = filename; *p; ++p) {
1079 if ((unsigned char)*p < 0x20)
1081 if (strchr(illegal, *p))
1085 strcpy(l_filename, filename);
1086 downcase(l_filename, VFAT_MAXLEN_BYTES);
1091 int file_fat_write_at(const char *filename, loff_t pos, void *buffer,
1092 loff_t size, loff_t *actwrite)
1095 fsdata datablock = { .fatbuf = NULL, };
1096 fsdata *mydata = &datablock;
1097 fat_itr *itr = NULL;
1099 char *filename_copy, *parent, *basename;
1100 char l_filename[VFAT_MAXLEN_BYTES];
1102 debug("writing %s\n", filename);
1104 filename_copy = strdup(filename);
1108 split_filename(filename_copy, &parent, &basename);
1109 if (!strlen(basename)) {
1114 filename = basename;
1115 if (normalize_longname(l_filename, filename)) {
1116 printf("FAT: illegal filename (%s)\n", filename);
1121 itr = malloc_cache_aligned(sizeof(fat_itr));
1127 ret = fat_itr_root(itr, &datablock);
1131 total_sector = datablock.total_sect;
1133 ret = fat_itr_resolve(itr, parent, TYPE_DIR);
1135 printf("%s: doesn't exist (%d)\n", parent, ret);
1139 retdent = find_directory_entry(itr, l_filename);
1142 if (fat_itr_isdir(itr)) {
1149 /* Append to the end */
1150 pos = FAT2CPU32(retdent->size);
1151 if (pos > retdent->size) {
1152 /* No hole allowed */
1157 /* Update file size in a directory entry */
1158 retdent->size = cpu_to_le32(pos + size);
1160 /* Create a new file */
1163 /* root dir cannot have "." or ".." */
1164 if (!strcmp(l_filename, ".") ||
1165 !strcmp(l_filename, "..")) {
1172 printf("Error: allocating new dir entry\n");
1178 /* No hole allowed */
1183 memset(itr->dent, 0, sizeof(*itr->dent));
1185 /* Calculate checksum for short name */
1186 set_name(itr->dent, filename);
1188 /* Set long name entries */
1189 if (fill_dir_slot(itr, filename)) {
1194 /* Set short name entry */
1195 fill_dentry(itr->fsdata, itr->dent, filename, 0, size, 0x20);
1197 retdent = itr->dent;
1200 ret = set_contents(mydata, retdent, pos, buffer, size, actwrite);
1202 printf("Error: writing contents\n");
1206 debug("attempt to write 0x%llx bytes\n", *actwrite);
1208 /* Flush fat buffer */
1209 ret = flush_dirty_fat_buffer(mydata);
1211 printf("Error: flush fat buffer\n");
1216 /* Write directory table to device */
1217 ret = flush_dir(itr);
1219 printf("Error: writing directory entry\n");
1224 free(filename_copy);
1225 free(mydata->fatbuf);
1230 int file_fat_write(const char *filename, void *buffer, loff_t offset,
1231 loff_t maxsize, loff_t *actwrite)
1233 return file_fat_write_at(filename, offset, buffer, maxsize, actwrite);
1236 static int fat_dir_entries(fat_itr *itr)
1239 fsdata fsdata = { .fatbuf = NULL, }, *mydata = &fsdata;
1240 /* for FATBUFSIZE */
1243 dirs = malloc_cache_aligned(sizeof(fat_itr));
1245 debug("Error: allocating memory\n");
1250 /* duplicate fsdata */
1251 fat_itr_child(dirs, itr);
1252 fsdata = *dirs->fsdata;
1254 /* allocate local fat buffer */
1255 fsdata.fatbuf = malloc_cache_aligned(FATBUFSIZE);
1256 if (!fsdata.fatbuf) {
1257 debug("Error: allocating memory\n");
1261 fsdata.fatbufnum = -1;
1262 dirs->fsdata = &fsdata;
1264 for (count = 0; fat_itr_next(dirs); count++)
1268 free(fsdata.fatbuf);
1273 static int delete_dentry(fat_itr *itr)
1275 fsdata *mydata = itr->fsdata;
1276 dir_entry *dentptr = itr->dent;
1278 /* free cluster blocks */
1279 clear_fatent(mydata, START(dentptr));
1280 if (flush_dirty_fat_buffer(mydata) < 0) {
1281 printf("Error: flush fat buffer\n");
1286 * update a directory entry
1288 * - long file name support
1289 * - find and mark the "new" first invalid entry as name[0]=0x00
1291 memset(dentptr, 0, sizeof(*dentptr));
1292 dentptr->name[0] = 0xe5;
1294 if (flush_dir(itr)) {
1295 printf("error: writing directory entry\n");
1302 int fat_unlink(const char *filename)
1304 fsdata fsdata = { .fatbuf = NULL, };
1305 fat_itr *itr = NULL;
1307 char *filename_copy, *dirname, *basename;
1309 filename_copy = strdup(filename);
1310 if (!filename_copy) {
1311 printf("Error: allocating memory\n");
1315 split_filename(filename_copy, &dirname, &basename);
1317 if (!strcmp(dirname, "/") && !strcmp(basename, "")) {
1318 printf("Error: cannot remove root\n");
1323 itr = malloc_cache_aligned(sizeof(fat_itr));
1325 printf("Error: allocating memory\n");
1330 ret = fat_itr_root(itr, &fsdata);
1334 total_sector = fsdata.total_sect;
1336 ret = fat_itr_resolve(itr, dirname, TYPE_DIR);
1338 printf("%s: doesn't exist (%d)\n", dirname, ret);
1343 if (!find_directory_entry(itr, basename)) {
1344 printf("%s: doesn't exist\n", basename);
1349 if (fat_itr_isdir(itr)) {
1350 n_entries = fat_dir_entries(itr);
1351 if (n_entries < 0) {
1355 if (n_entries > 2) {
1356 printf("Error: directory is not empty: %d\n",
1363 ret = delete_dentry(itr);
1366 free(fsdata.fatbuf);
1368 free(filename_copy);
1373 int fat_mkdir(const char *new_dirname)
1376 fsdata datablock = { .fatbuf = NULL, };
1377 fsdata *mydata = &datablock;
1378 fat_itr *itr = NULL;
1379 char *dirname_copy, *parent, *dirname;
1380 char l_dirname[VFAT_MAXLEN_BYTES];
1383 unsigned int bytesperclust;
1384 dir_entry *dotdent = NULL;
1386 dirname_copy = strdup(new_dirname);
1390 split_filename(dirname_copy, &parent, &dirname);
1391 if (!strlen(dirname)) {
1396 if (normalize_longname(l_dirname, dirname)) {
1397 printf("FAT: illegal filename (%s)\n", dirname);
1402 itr = malloc_cache_aligned(sizeof(fat_itr));
1408 ret = fat_itr_root(itr, &datablock);
1412 total_sector = datablock.total_sect;
1414 ret = fat_itr_resolve(itr, parent, TYPE_DIR);
1416 printf("%s: doesn't exist (%d)\n", parent, ret);
1420 retdent = find_directory_entry(itr, l_dirname);
1423 printf("%s: already exists\n", l_dirname);
1428 /* root dir cannot have "." or ".." */
1429 if (!strcmp(l_dirname, ".") ||
1430 !strcmp(l_dirname, "..")) {
1437 printf("Error: allocating new dir entry\n");
1442 memset(itr->dent, 0, sizeof(*itr->dent));
1444 /* Set short name to set alias checksum field in dir_slot */
1445 set_name(itr->dent, dirname);
1446 fill_dir_slot(itr, dirname);
1448 /* Set attribute as archive for regular file */
1449 fill_dentry(itr->fsdata, itr->dent, dirname, 0, 0,
1450 ATTR_DIR | ATTR_ARCH);
1452 retdent = itr->dent;
1455 /* Default entries */
1456 bytesperclust = mydata->clust_size * mydata->sect_size;
1457 dotdent = malloc_cache_aligned(bytesperclust);
1462 memset(dotdent, 0, bytesperclust);
1464 memcpy(dotdent[0].name, ". ", 8);
1465 memcpy(dotdent[0].ext, " ", 3);
1466 dotdent[0].attr = ATTR_DIR | ATTR_ARCH;
1468 memcpy(dotdent[1].name, ".. ", 8);
1469 memcpy(dotdent[1].ext, " ", 3);
1470 dotdent[1].attr = ATTR_DIR | ATTR_ARCH;
1471 set_start_cluster(mydata, &dotdent[1], itr->start_clust);
1473 ret = set_contents(mydata, retdent, 0, (__u8 *)dotdent,
1474 bytesperclust, &actwrite);
1476 printf("Error: writing contents\n");
1479 /* Write twice for "." */
1480 set_start_cluster(mydata, &dotdent[0], START(retdent));
1481 ret = set_contents(mydata, retdent, 0, (__u8 *)dotdent,
1482 bytesperclust, &actwrite);
1484 printf("Error: writing contents\n");
1488 /* Flush fat buffer */
1489 ret = flush_dirty_fat_buffer(mydata);
1491 printf("Error: flush fat buffer\n");
1495 /* Write directory table to device */
1496 ret = flush_dir(itr);
1498 printf("Error: writing directory entry\n");
1502 free(mydata->fatbuf);