xref: /aosp_15_r20/external/exfatprogs/lib/libexfat.c (revision 508ec739de867a7549a0b8584942a00612dc5f1c)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *   Copyright (C) 2019 Namjae Jeon <[email protected]>
4  */
5 
6 #include <sys/types.h>
7 #include <sys/stat.h>
8 #include <sys/ioctl.h>
9 #include <sys/sysmacros.h>
10 #include <unistd.h>
11 #include <fcntl.h>
12 #include <stdlib.h>
13 #include <stdio.h>
14 #include <string.h>
15 #include <errno.h>
16 #include <wchar.h>
17 #include <limits.h>
18 #include <assert.h>
19 
20 #include "exfat_ondisk.h"
21 #include "libexfat.h"
22 #include "version.h"
23 #include "exfat_fs.h"
24 #include "exfat_dir.h"
25 
26 unsigned int print_level  = EXFAT_INFO;
27 
exfat_bitmap_set_range(struct exfat * exfat,char * bitmap,clus_t start_clus,clus_t count)28 void exfat_bitmap_set_range(struct exfat *exfat, char *bitmap,
29 			    clus_t start_clus, clus_t count)
30 {
31 	clus_t clus;
32 
33 	if (!exfat_heap_clus(exfat, start_clus) ||
34 	    !exfat_heap_clus(exfat, start_clus + count - 1))
35 		return;
36 
37 	clus = start_clus;
38 	while (clus < start_clus + count) {
39 		exfat_bitmap_set(bitmap, clus);
40 		clus++;
41 	}
42 }
43 
exfat_bitmap_find_bit(struct exfat * exfat,char * bmap,clus_t start_clu,clus_t * next,int bit)44 static int exfat_bitmap_find_bit(struct exfat *exfat, char *bmap,
45 				 clus_t start_clu, clus_t *next,
46 				 int bit)
47 {
48 	clus_t last_clu;
49 
50 	last_clu = le32_to_cpu(exfat->bs->bsx.clu_count) +
51 		EXFAT_FIRST_CLUSTER;
52 	while (start_clu < last_clu) {
53 		if (!!exfat_bitmap_get(bmap, start_clu) == bit) {
54 			*next = start_clu;
55 			return 0;
56 		}
57 		start_clu++;
58 	}
59 	return 1;
60 }
61 
exfat_bitmap_find_zero(struct exfat * exfat,char * bmap,clus_t start_clu,clus_t * next)62 int exfat_bitmap_find_zero(struct exfat *exfat, char *bmap,
63 			   clus_t start_clu, clus_t *next)
64 {
65 	return exfat_bitmap_find_bit(exfat, bmap,
66 				     start_clu, next, 0);
67 }
68 
exfat_bitmap_find_one(struct exfat * exfat,char * bmap,clus_t start_clu,clus_t * next)69 int exfat_bitmap_find_one(struct exfat *exfat, char *bmap,
70 			  clus_t start_clu, clus_t *next)
71 {
72 	return exfat_bitmap_find_bit(exfat, bmap,
73 				     start_clu, next, 1);
74 }
75 
exfat_bad_char(wchar_t w)76 wchar_t exfat_bad_char(wchar_t w)
77 {
78 	return (w < 0x0020)
79 		|| (w == '*') || (w == '?') || (w == '<') || (w == '>')
80 		|| (w == '|') || (w == '"') || (w == ':') || (w == '/')
81 		|| (w == '\\');
82 }
83 
boot_calc_checksum(unsigned char * sector,unsigned short size,bool is_boot_sec,__le32 * checksum)84 void boot_calc_checksum(unsigned char *sector, unsigned short size,
85 		bool is_boot_sec, __le32 *checksum)
86 {
87 	unsigned int index;
88 
89 	if (is_boot_sec) {
90 		for (index = 0; index < size; index++) {
91 			if ((index == 106) || (index == 107) || (index == 112))
92 				continue;
93 			*checksum = ((*checksum & 1) ? 0x80000000 : 0) +
94 				(*checksum >> 1) + sector[index];
95 		}
96 	} else {
97 		for (index = 0; index < size; index++) {
98 			*checksum = ((*checksum & 1) ? 0x80000000 : 0) +
99 				(*checksum >> 1) + sector[index];
100 		}
101 	}
102 }
103 
show_version(void)104 void show_version(void)
105 {
106 	printf("exfatprogs version : %s\n", EXFAT_PROGS_VERSION);
107 }
108 
sector_size_bits(unsigned int size)109 static inline unsigned int sector_size_bits(unsigned int size)
110 {
111 	unsigned int bits = 8;
112 
113 	do {
114 		bits++;
115 		size >>= 1;
116 	} while (size > 256);
117 
118 	return bits;
119 }
120 
exfat_set_default_cluster_size(struct exfat_blk_dev * bd,struct exfat_user_input * ui)121 static void exfat_set_default_cluster_size(struct exfat_blk_dev *bd,
122 		struct exfat_user_input *ui)
123 {
124 	if (256 * MB >= bd->size)
125 		ui->cluster_size = 4 * KB;
126 	else if (32 * GB >= bd->size)
127 		ui->cluster_size = 32 * KB;
128 	else
129 		ui->cluster_size = 128 * KB;
130 }
131 
init_user_input(struct exfat_user_input * ui)132 void init_user_input(struct exfat_user_input *ui)
133 {
134 	memset(ui, 0, sizeof(struct exfat_user_input));
135 	ui->writeable = true;
136 	ui->quick = true;
137 }
138 
exfat_get_blk_dev_info(struct exfat_user_input * ui,struct exfat_blk_dev * bd)139 int exfat_get_blk_dev_info(struct exfat_user_input *ui,
140 		struct exfat_blk_dev *bd)
141 {
142 	int fd, ret = -1;
143 	off_t blk_dev_size;
144 	struct stat st;
145 	unsigned long long blk_dev_offset = 0;
146 
147 	fd = open(ui->dev_name, ui->writeable ? O_RDWR|O_EXCL : O_RDONLY);
148 	if (fd < 0) {
149 		exfat_err("open failed : %s, %s\n", ui->dev_name,
150 			strerror(errno));
151 		return -1;
152 	}
153 	blk_dev_size = lseek(fd, 0, SEEK_END);
154 	if (blk_dev_size <= 0) {
155 		exfat_err("invalid block device size(%s)\n",
156 			ui->dev_name);
157 		ret = blk_dev_size;
158 		close(fd);
159 		goto out;
160 	}
161 
162 	if (fstat(fd, &st) == 0 && S_ISBLK(st.st_mode)) {
163 		char pathname[sizeof("/sys/dev/block/4294967295:4294967295/start")];
164 		FILE *fp;
165 
166 		snprintf(pathname, sizeof(pathname), "/sys/dev/block/%u:%u/start",
167 			major(st.st_rdev), minor(st.st_rdev));
168 		fp = fopen(pathname, "r");
169 		if (fp != NULL) {
170 			if (fscanf(fp, "%llu", &blk_dev_offset) == 1) {
171 				/*
172 				 * Linux kernel always reports partition offset
173 				 * in 512-byte units, regardless of sector size
174 				 */
175 				blk_dev_offset <<= 9;
176 			}
177 			fclose(fp);
178 		}
179 	}
180 
181 	bd->dev_fd = fd;
182 	bd->offset = blk_dev_offset;
183 	bd->size = blk_dev_size;
184 	if (!ui->cluster_size)
185 		exfat_set_default_cluster_size(bd, ui);
186 
187 	if (!ui->boundary_align)
188 		ui->boundary_align = DEFAULT_BOUNDARY_ALIGNMENT;
189 
190 	if (ioctl(fd, BLKSSZGET, &bd->sector_size) < 0)
191 		bd->sector_size = DEFAULT_SECTOR_SIZE;
192 	bd->sector_size_bits = sector_size_bits(bd->sector_size);
193 	bd->num_sectors = blk_dev_size / bd->sector_size;
194 	bd->num_clusters = blk_dev_size / ui->cluster_size;
195 
196 	exfat_debug("Block device name : %s\n", ui->dev_name);
197 	exfat_debug("Block device offset : %llu\n", bd->offset);
198 	exfat_debug("Block device size : %llu\n", bd->size);
199 	exfat_debug("Block sector size : %u\n", bd->sector_size);
200 	exfat_debug("Number of the sectors : %llu\n",
201 		bd->num_sectors);
202 	exfat_debug("Number of the clusters : %u\n",
203 		bd->num_clusters);
204 
205 	ret = 0;
206 	bd->dev_fd = fd;
207 out:
208 	return ret;
209 }
210 
exfat_read(int fd,void * buf,size_t size,off_t offset)211 ssize_t exfat_read(int fd, void *buf, size_t size, off_t offset)
212 {
213 	return pread(fd, buf, size, offset);
214 }
215 
exfat_write(int fd,void * buf,size_t size,off_t offset)216 ssize_t exfat_write(int fd, void *buf, size_t size, off_t offset)
217 {
218 	return pwrite(fd, buf, size, offset);
219 }
220 
exfat_utf16_len(const __le16 * str,size_t max_size)221 size_t exfat_utf16_len(const __le16 *str, size_t max_size)
222 {
223 	size_t i = 0;
224 
225 	while (le16_to_cpu(str[i]) && i < max_size)
226 		i++;
227 	return i;
228 }
229 
exfat_utf16_enc(const char * in_str,__u16 * out_str,size_t out_size)230 ssize_t exfat_utf16_enc(const char *in_str, __u16 *out_str, size_t out_size)
231 {
232 	size_t mbs_len, out_len, i;
233 	wchar_t *wcs;
234 
235 	mbs_len = mbstowcs(NULL, in_str, 0);
236 	if (mbs_len == (size_t)-1) {
237 		if (errno == EINVAL || errno == EILSEQ)
238 			exfat_err("invalid character sequence in current locale\n");
239 		return -errno;
240 	}
241 
242 	wcs = calloc(mbs_len+1, sizeof(wchar_t));
243 	if (!wcs)
244 		return -ENOMEM;
245 
246 	/* First convert multibyte char* string to wchar_t* string */
247 	if (mbstowcs(wcs, in_str, mbs_len+1) == (size_t)-1) {
248 		if (errno == EINVAL || errno == EILSEQ)
249 			exfat_err("invalid character sequence in current locale\n");
250 		free(wcs);
251 		return -errno;
252 	}
253 
254 	/* Convert wchar_t* string (sequence of code points) to UTF-16 string */
255 	for (i = 0, out_len = 0; i < mbs_len; i++) {
256 		if (2*(out_len+1) > out_size ||
257 		    (wcs[i] >= 0x10000 && 2*(out_len+2) > out_size)) {
258 			exfat_err("input string is too long\n");
259 			free(wcs);
260 			return -E2BIG;
261 		}
262 
263 		/* Encode code point above Plane0 as UTF-16 surrogate pair */
264 		if (wcs[i] >= 0x10000) {
265 			out_str[out_len++] =
266 			  cpu_to_le16(((wcs[i] - 0x10000) >> 10) + 0xD800);
267 			wcs[i] = ((wcs[i] - 0x10000) & 0x3FF) + 0xDC00;
268 		}
269 
270 		out_str[out_len++] = cpu_to_le16(wcs[i]);
271 	}
272 
273 	free(wcs);
274 	return 2*out_len;
275 }
276 
exfat_utf16_dec(const __u16 * in_str,size_t in_len,char * out_str,size_t out_size)277 ssize_t exfat_utf16_dec(const __u16 *in_str, size_t in_len,
278 			char *out_str, size_t out_size)
279 {
280 	size_t wcs_len, out_len, c_len, i;
281 	char c_str[MB_LEN_MAX];
282 	wchar_t *wcs;
283 	mbstate_t ps;
284 	wchar_t w;
285 
286 	wcs = calloc(in_len/2+1, sizeof(wchar_t));
287 	if (!wcs)
288 		return -ENOMEM;
289 
290 	/* First convert UTF-16 string to wchar_t* string */
291 	for (i = 0, wcs_len = 0; i < in_len/2; i++, wcs_len++) {
292 		wcs[wcs_len] = le16_to_cpu(in_str[i]);
293 		/*
294 		 * If wchar_t can store code point above Plane0
295 		 * then unpack UTF-16 surrogate pair to code point
296 		 */
297 #if WCHAR_MAX >= 0x10FFFF
298 		if (wcs[wcs_len] >= 0xD800 && wcs[wcs_len] <= 0xDBFF &&
299 		    i+1 < in_len/2) {
300 			w = le16_to_cpu(in_str[i+1]);
301 			if (w >= 0xDC00 && w <= 0xDFFF) {
302 				wcs[wcs_len] = 0x10000 +
303 					       ((wcs[wcs_len] - 0xD800) << 10) +
304 					       (w - 0xDC00);
305 				i++;
306 			}
307 		}
308 #endif
309 	}
310 
311 	memset(&ps, 0, sizeof(ps));
312 
313 	/* And then convert wchar_t* string to multibyte char* string */
314 	for (i = 0, out_len = 0, c_len = 0; i <= wcs_len; i++) {
315 		c_len = wcrtomb(c_str, wcs[i], &ps);
316 		/*
317 		 * If character is non-representable in current locale then
318 		 * try to store it as Unicode replacement code point U+FFFD
319 		 */
320 		if (c_len == (size_t)-1 && errno == EILSEQ)
321 			c_len = wcrtomb(c_str, 0xFFFD, &ps);
322 		/* If U+FFFD is also non-representable, try question mark */
323 		if (c_len == (size_t)-1 && errno == EILSEQ)
324 			c_len = wcrtomb(c_str, L'?', &ps);
325 		/* If also (7bit) question mark fails then we cannot do more */
326 		if (c_len == (size_t)-1) {
327 			exfat_err("invalid UTF-16 sequence\n");
328 			free(wcs);
329 			return -errno;
330 		}
331 		if (out_len+c_len > out_size) {
332 			exfat_err("input string is too long\n");
333 			free(wcs);
334 			return -E2BIG;
335 		}
336 		memcpy(out_str+out_len, c_str, c_len);
337 		out_len += c_len;
338 	}
339 
340 	free(wcs);
341 
342 	/* Last iteration of above loop should have produced null byte */
343 	if (c_len == 0 || out_str[out_len-1] != 0) {
344 		exfat_err("invalid UTF-16 sequence\n");
345 		return -errno;
346 	}
347 
348 	return out_len-1;
349 }
350 
exfat_get_root_entry_offset(struct exfat_blk_dev * bd)351 off_t exfat_get_root_entry_offset(struct exfat_blk_dev *bd)
352 {
353 	struct pbr *bs;
354 	int nbytes;
355 	unsigned int cluster_size, sector_size;
356 	off_t root_clu_off;
357 
358 	bs = (struct pbr *)malloc(EXFAT_MAX_SECTOR_SIZE);
359 	if (!bs) {
360 		exfat_err("failed to allocate memory\n");
361 		return -ENOMEM;
362 	}
363 
364 	nbytes = exfat_read(bd->dev_fd, bs, EXFAT_MAX_SECTOR_SIZE, 0);
365 	if (nbytes != EXFAT_MAX_SECTOR_SIZE) {
366 		exfat_err("boot sector read failed: %d\n", errno);
367 		free(bs);
368 		return -1;
369 	}
370 
371 	if (memcmp(bs->bpb.oem_name, "EXFAT   ", 8) != 0) {
372 		exfat_err("Bad fs_name in boot sector, which does not describe a valid exfat filesystem\n");
373 		free(bs);
374 		return -1;
375 	}
376 
377 	sector_size = 1 << bs->bsx.sect_size_bits;
378 	cluster_size = (1 << bs->bsx.sect_per_clus_bits) * sector_size;
379 	root_clu_off = le32_to_cpu(bs->bsx.clu_offset) * sector_size +
380 		(le32_to_cpu(bs->bsx.root_cluster) - EXFAT_RESERVED_CLUSTERS) *
381 		cluster_size;
382 	free(bs);
383 
384 	return root_clu_off;
385 }
386 
exfat_conv_volume_label(struct exfat_dentry * vol_entry)387 char *exfat_conv_volume_label(struct exfat_dentry *vol_entry)
388 {
389 	char *volume_label;
390 	__le16 disk_label[VOLUME_LABEL_MAX_LEN];
391 
392 	volume_label = malloc(VOLUME_LABEL_BUFFER_SIZE);
393 	if (!volume_label)
394 		return NULL;
395 
396 	memcpy(disk_label, vol_entry->vol_label, sizeof(disk_label));
397 	memset(volume_label, 0, VOLUME_LABEL_BUFFER_SIZE);
398 	if (exfat_utf16_dec(disk_label, vol_entry->vol_char_cnt*2,
399 		volume_label, VOLUME_LABEL_BUFFER_SIZE) < 0) {
400 		exfat_err("failed to decode volume label\n");
401 		free(volume_label);
402 		return NULL;
403 	}
404 
405 	return volume_label;
406 }
407 
exfat_read_volume_label(struct exfat * exfat)408 int exfat_read_volume_label(struct exfat *exfat)
409 {
410 	struct exfat_dentry *dentry;
411 	int err;
412 	__le16 disk_label[VOLUME_LABEL_MAX_LEN];
413 	struct exfat_lookup_filter filter = {
414 		.in.type = EXFAT_VOLUME,
415 		.in.filter = NULL,
416 	};
417 
418 	err = exfat_lookup_dentry_set(exfat, exfat->root, &filter);
419 	if (err)
420 		return err;
421 
422 	dentry = filter.out.dentry_set;
423 
424 	if (dentry->vol_char_cnt == 0)
425 		goto out;
426 
427 	if (dentry->vol_char_cnt > VOLUME_LABEL_MAX_LEN) {
428 		exfat_err("too long label. %d\n", dentry->vol_char_cnt);
429 		err = -EINVAL;
430 		goto out;
431 	}
432 
433 	memcpy(disk_label, dentry->vol_label, sizeof(disk_label));
434 	if (exfat_utf16_dec(disk_label, dentry->vol_char_cnt*2,
435 		exfat->volume_label, sizeof(exfat->volume_label)) < 0) {
436 		exfat_err("failed to decode volume label\n");
437 		err = -EINVAL;
438 		goto out;
439 	}
440 
441 	exfat_info("label: %s\n", exfat->volume_label);
442 out:
443 	free(filter.out.dentry_set);
444 	return err;
445 }
446 
exfat_set_volume_label(struct exfat * exfat,char * label_input)447 int exfat_set_volume_label(struct exfat *exfat, char *label_input)
448 {
449 	struct exfat_dentry *pvol;
450 	struct exfat_dentry_loc loc;
451 	__u16 volume_label[VOLUME_LABEL_MAX_LEN];
452 	int volume_label_len, dcount, err;
453 
454 	struct exfat_lookup_filter filter = {
455 		.in.type = EXFAT_VOLUME,
456 		.in.filter = NULL,
457 	};
458 
459 	err = exfat_lookup_dentry_set(exfat, exfat->root, &filter);
460 	if (!err) {
461 		pvol = filter.out.dentry_set;
462 		dcount = filter.out.dentry_count;
463 		memset(pvol->vol_label, 0, sizeof(pvol->vol_label));
464 	} else {
465 		pvol = calloc(sizeof(struct exfat_dentry), 1);
466 		if (!pvol)
467 			return -ENOMEM;
468 
469 		dcount = 1;
470 		pvol->type = EXFAT_VOLUME;
471 	}
472 
473 	volume_label_len = exfat_utf16_enc(label_input,
474 			volume_label, sizeof(volume_label));
475 	if (volume_label_len < 0) {
476 		exfat_err("failed to encode volume label\n");
477 		free(pvol);
478 		return -1;
479 	}
480 
481 	memcpy(pvol->vol_label, volume_label, volume_label_len);
482 	pvol->vol_char_cnt = volume_label_len/2;
483 
484 	loc.parent = exfat->root;
485 	loc.file_offset = filter.out.file_offset;
486 	loc.dev_offset = filter.out.dev_offset;
487 	err = exfat_add_dentry_set(exfat, &loc, pvol, dcount, false);
488 	exfat_info("new label: %s\n", label_input);
489 
490 	free(pvol);
491 
492 	return err;
493 }
494 
exfat_read_sector(struct exfat_blk_dev * bd,void * buf,unsigned int sec_off)495 int exfat_read_sector(struct exfat_blk_dev *bd, void *buf, unsigned int sec_off)
496 {
497 	int ret;
498 	unsigned long long offset =
499 		(unsigned long long)sec_off * bd->sector_size;
500 
501 	ret = pread(bd->dev_fd, buf, bd->sector_size, offset);
502 	if (ret < 0) {
503 		exfat_err("read failed, sec_off : %u\n", sec_off);
504 		return -1;
505 	}
506 	return 0;
507 }
508 
exfat_write_sector(struct exfat_blk_dev * bd,void * buf,unsigned int sec_off)509 int exfat_write_sector(struct exfat_blk_dev *bd, void *buf,
510 		unsigned int sec_off)
511 {
512 	int bytes;
513 	unsigned long long offset =
514 		(unsigned long long)sec_off * bd->sector_size;
515 
516 	bytes = pwrite(bd->dev_fd, buf, bd->sector_size, offset);
517 	if (bytes != (int)bd->sector_size) {
518 		exfat_err("write failed, sec_off : %u, bytes : %d\n", sec_off,
519 			bytes);
520 		return -1;
521 	}
522 	return 0;
523 }
524 
exfat_write_checksum_sector(struct exfat_blk_dev * bd,unsigned int checksum,bool is_backup)525 int exfat_write_checksum_sector(struct exfat_blk_dev *bd,
526 		unsigned int checksum, bool is_backup)
527 {
528 	__le32 *checksum_buf;
529 	int ret = 0;
530 	unsigned int i;
531 	unsigned int sec_idx = CHECKSUM_SEC_IDX;
532 
533 	checksum_buf = malloc(bd->sector_size);
534 	if (!checksum_buf)
535 		return -1;
536 
537 	if (is_backup)
538 		sec_idx += BACKUP_BOOT_SEC_IDX;
539 
540 	for (i = 0; i < bd->sector_size / sizeof(int); i++)
541 		checksum_buf[i] = cpu_to_le32(checksum);
542 
543 	ret = exfat_write_sector(bd, checksum_buf, sec_idx);
544 	if (ret) {
545 		exfat_err("checksum sector write failed\n");
546 		goto free;
547 	}
548 
549 free:
550 	free(checksum_buf);
551 	return ret;
552 }
553 
exfat_show_volume_serial(int fd)554 int exfat_show_volume_serial(int fd)
555 {
556 	struct pbr *ppbr;
557 	int ret;
558 
559 	ppbr = malloc(EXFAT_MAX_SECTOR_SIZE);
560 	if (!ppbr) {
561 		exfat_err("Cannot allocate pbr: out of memory\n");
562 		return -1;
563 	}
564 
565 	/* read main boot sector */
566 	ret = exfat_read(fd, (char *)ppbr, EXFAT_MAX_SECTOR_SIZE, 0);
567 	if (ret < 0) {
568 		exfat_err("main boot sector read failed\n");
569 		ret = -1;
570 		goto free_ppbr;
571 	}
572 
573 	if (memcmp(ppbr->bpb.oem_name, "EXFAT   ", 8) != 0) {
574 		exfat_err("Bad fs_name in boot sector, which does not describe a valid exfat filesystem\n");
575 		ret = -1;
576 		goto free_ppbr;
577 	}
578 
579 	exfat_info("volume serial : 0x%x\n", ppbr->bsx.vol_serial);
580 
581 free_ppbr:
582 	free(ppbr);
583 	return ret;
584 }
585 
exfat_update_boot_checksum(struct exfat_blk_dev * bd,bool is_backup)586 static int exfat_update_boot_checksum(struct exfat_blk_dev *bd, bool is_backup)
587 {
588 	unsigned int checksum = 0;
589 	int ret, sec_idx, backup_sec_idx = 0;
590 	unsigned char *buf;
591 
592 	buf = malloc(bd->sector_size);
593 	if (!buf) {
594 		exfat_err("Cannot allocate pbr: out of memory\n");
595 		return -1;
596 	}
597 
598 	if (is_backup)
599 		backup_sec_idx = BACKUP_BOOT_SEC_IDX;
600 
601 	for (sec_idx = BOOT_SEC_IDX; sec_idx < CHECKSUM_SEC_IDX; sec_idx++) {
602 		bool is_boot_sec = false;
603 
604 		ret = exfat_read_sector(bd, buf, sec_idx + backup_sec_idx);
605 		if (ret < 0) {
606 			exfat_err("sector(%d) read failed\n", sec_idx);
607 			ret = -1;
608 			goto free_buf;
609 		}
610 
611 		if (sec_idx == BOOT_SEC_IDX)
612 			is_boot_sec = true;
613 
614 		boot_calc_checksum(buf, bd->sector_size, is_boot_sec,
615 			&checksum);
616 	}
617 
618 	ret = exfat_write_checksum_sector(bd, checksum, is_backup);
619 
620 free_buf:
621 	free(buf);
622 
623 	return ret;
624 }
625 
exfat_set_volume_serial(struct exfat_blk_dev * bd,struct exfat_user_input * ui)626 int exfat_set_volume_serial(struct exfat_blk_dev *bd,
627 		struct exfat_user_input *ui)
628 {
629 	int ret;
630 	struct pbr *ppbr;
631 
632 	ppbr = malloc(EXFAT_MAX_SECTOR_SIZE);
633 	if (!ppbr) {
634 		exfat_err("Cannot allocate pbr: out of memory\n");
635 		return -1;
636 	}
637 
638 	/* read main boot sector */
639 	ret = exfat_read(bd->dev_fd, (char *)ppbr, EXFAT_MAX_SECTOR_SIZE,
640 			BOOT_SEC_IDX);
641 	if (ret < 0) {
642 		exfat_err("main boot sector read failed\n");
643 		ret = -1;
644 		goto free_ppbr;
645 	}
646 
647 	if (memcmp(ppbr->bpb.oem_name, "EXFAT   ", 8) != 0) {
648 		exfat_err("Bad fs_name in boot sector, which does not describe a valid exfat filesystem\n");
649 		ret = -1;
650 		goto free_ppbr;
651 	}
652 
653 	bd->sector_size = 1 << ppbr->bsx.sect_size_bits;
654 	ppbr->bsx.vol_serial = ui->volume_serial;
655 
656 	/* update main boot sector */
657 	ret = exfat_write_sector(bd, (char *)ppbr, BOOT_SEC_IDX);
658 	if (ret < 0) {
659 		exfat_err("main boot sector write failed\n");
660 		ret = -1;
661 		goto free_ppbr;
662 	}
663 
664 	/* update backup boot sector */
665 	ret = exfat_write_sector(bd, (char *)ppbr, BACKUP_BOOT_SEC_IDX);
666 	if (ret < 0) {
667 		exfat_err("backup boot sector write failed\n");
668 		ret = -1;
669 		goto free_ppbr;
670 	}
671 
672 	ret = exfat_update_boot_checksum(bd, 0);
673 	if (ret < 0) {
674 		exfat_err("main checksum update failed\n");
675 		goto free_ppbr;
676 	}
677 
678 	ret = exfat_update_boot_checksum(bd, 1);
679 	if (ret < 0)
680 		exfat_err("backup checksum update failed\n");
681 free_ppbr:
682 	free(ppbr);
683 
684 	exfat_info("New volume serial : 0x%x\n", ui->volume_serial);
685 
686 	return ret;
687 }
688 
exfat_clus_to_blk_dev_off(struct exfat_blk_dev * bd,unsigned int clu_off_sectnr,unsigned int clu)689 unsigned int exfat_clus_to_blk_dev_off(struct exfat_blk_dev *bd,
690 		unsigned int clu_off_sectnr, unsigned int clu)
691 {
692 	return clu_off_sectnr * bd->sector_size +
693 		(clu - EXFAT_RESERVED_CLUSTERS) * bd->cluster_size;
694 }
695 
exfat_get_next_clus(struct exfat * exfat,clus_t clus,clus_t * next)696 int exfat_get_next_clus(struct exfat *exfat, clus_t clus, clus_t *next)
697 {
698 	off_t offset;
699 
700 	*next = EXFAT_EOF_CLUSTER;
701 
702 	if (!exfat_heap_clus(exfat, clus))
703 		return -EINVAL;
704 
705 	offset = (off_t)le32_to_cpu(exfat->bs->bsx.fat_offset) <<
706 				exfat->bs->bsx.sect_size_bits;
707 	offset += sizeof(clus_t) * clus;
708 
709 	if (exfat_read(exfat->blk_dev->dev_fd, next, sizeof(*next), offset)
710 			!= sizeof(*next))
711 		return -EIO;
712 	*next = le32_to_cpu(*next);
713 	return 0;
714 }
715 
exfat_get_inode_next_clus(struct exfat * exfat,struct exfat_inode * node,clus_t clus,clus_t * next)716 int exfat_get_inode_next_clus(struct exfat *exfat, struct exfat_inode *node,
717 			      clus_t clus, clus_t *next)
718 {
719 	*next = EXFAT_EOF_CLUSTER;
720 
721 	if (node->is_contiguous) {
722 		if (!exfat_heap_clus(exfat, clus))
723 			return -EINVAL;
724 		*next = clus + 1;
725 		return 0;
726 	}
727 
728 	return exfat_get_next_clus(exfat, clus, next);
729 }
730 
exfat_set_fat(struct exfat * exfat,clus_t clus,clus_t next_clus)731 int exfat_set_fat(struct exfat *exfat, clus_t clus, clus_t next_clus)
732 {
733 	off_t offset;
734 
735 	offset = le32_to_cpu(exfat->bs->bsx.fat_offset) <<
736 		exfat->bs->bsx.sect_size_bits;
737 	offset += sizeof(clus_t) * clus;
738 
739 	if (exfat_write(exfat->blk_dev->dev_fd, &next_clus, sizeof(next_clus),
740 			offset) != sizeof(next_clus))
741 		return -EIO;
742 	return 0;
743 }
744 
exfat_s2o(struct exfat * exfat,off_t sect)745 off_t exfat_s2o(struct exfat *exfat, off_t sect)
746 {
747 	return sect << exfat->bs->bsx.sect_size_bits;
748 }
749 
exfat_c2o(struct exfat * exfat,unsigned int clus)750 off_t exfat_c2o(struct exfat *exfat, unsigned int clus)
751 {
752 	assert(clus >= EXFAT_FIRST_CLUSTER);
753 
754 	return exfat_s2o(exfat, le32_to_cpu(exfat->bs->bsx.clu_offset) +
755 				((off_t)(clus - EXFAT_FIRST_CLUSTER) <<
756 				 exfat->bs->bsx.sect_per_clus_bits));
757 }
758 
exfat_o2c(struct exfat * exfat,off_t device_offset,unsigned int * clu,unsigned int * offset)759 int exfat_o2c(struct exfat *exfat, off_t device_offset,
760 	      unsigned int *clu, unsigned int *offset)
761 {
762 	off_t heap_offset;
763 
764 	heap_offset = exfat_s2o(exfat, le32_to_cpu(exfat->bs->bsx.clu_offset));
765 	if (device_offset < heap_offset)
766 		return -ERANGE;
767 
768 	*clu = (unsigned int)((device_offset - heap_offset) /
769 			      exfat->clus_size) + EXFAT_FIRST_CLUSTER;
770 	if (!exfat_heap_clus(exfat, *clu))
771 		return -ERANGE;
772 	*offset = (device_offset - heap_offset) % exfat->clus_size;
773 	return 0;
774 }
775 
exfat_heap_clus(struct exfat * exfat,clus_t clus)776 bool exfat_heap_clus(struct exfat *exfat, clus_t clus)
777 {
778 	return clus >= EXFAT_FIRST_CLUSTER &&
779 		(clus - EXFAT_FIRST_CLUSTER) < exfat->clus_count;
780 }
781 
exfat_root_clus_count(struct exfat * exfat)782 int exfat_root_clus_count(struct exfat *exfat)
783 {
784 	struct exfat_inode *node = exfat->root;
785 	clus_t clus, next;
786 	int clus_count = 0;
787 
788 	if (!exfat_heap_clus(exfat, node->first_clus))
789 		return -EIO;
790 
791 	clus = node->first_clus;
792 	do {
793 		if (exfat_bitmap_get(exfat->alloc_bitmap, clus))
794 			return -EINVAL;
795 
796 		exfat_bitmap_set(exfat->alloc_bitmap, clus);
797 
798 		if (exfat_get_inode_next_clus(exfat, node, clus, &next)) {
799 			exfat_err("ERROR: failed to read the fat entry of root");
800 			return -EIO;
801 		}
802 
803 		if (next != EXFAT_EOF_CLUSTER && !exfat_heap_clus(exfat, next))
804 			return -EINVAL;
805 
806 		clus = next;
807 		clus_count++;
808 	} while (clus != EXFAT_EOF_CLUSTER);
809 
810 	node->size = clus_count * exfat->clus_size;
811 	return 0;
812 }
813 
read_boot_sect(struct exfat_blk_dev * bdev,struct pbr ** bs)814 int read_boot_sect(struct exfat_blk_dev *bdev, struct pbr **bs)
815 {
816 	struct pbr *pbr;
817 	int err = 0;
818 	unsigned int sect_size, clu_size;
819 
820 	pbr = malloc(sizeof(struct pbr));
821 
822 	if (exfat_read(bdev->dev_fd, pbr, sizeof(*pbr), 0) !=
823 	    (ssize_t)sizeof(*pbr)) {
824 		exfat_err("failed to read a boot sector\n");
825 		err = -EIO;
826 		goto err;
827 	}
828 
829 	err = -EINVAL;
830 	if (memcmp(pbr->bpb.oem_name, "EXFAT   ", 8) != 0) {
831 		exfat_err("failed to find exfat file system\n");
832 		goto err;
833 	}
834 
835 	sect_size = 1 << pbr->bsx.sect_size_bits;
836 	clu_size = 1 << (pbr->bsx.sect_size_bits +
837 			 pbr->bsx.sect_per_clus_bits);
838 
839 	if (sect_size < 512 || sect_size > 4 * KB) {
840 		exfat_err("too small or big sector size: %d\n",
841 			  sect_size);
842 		goto err;
843 	}
844 
845 	if (clu_size < sect_size || clu_size > 32 * MB) {
846 		exfat_err("too small or big cluster size: %d\n",
847 			  clu_size);
848 		goto err;
849 	}
850 
851 	*bs = pbr;
852 	return 0;
853 err:
854 	free(pbr);
855 	return err;
856 }
857