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