xref: /freebsd/stand/libsa/dosfs.c (revision e7c0cb720898fd36487c4e6b0aff52435084e6bf)
1ca987d46SWarner Losh /*
2ca987d46SWarner Losh  * Copyright (c) 1996, 1998 Robert Nordier
3ca987d46SWarner Losh  * All rights reserved.
4fae4b97cSToomas Soome  * Copyright 2024 MNX Cloud, Inc.
5ca987d46SWarner Losh  *
6ca987d46SWarner Losh  * Redistribution and use in source and binary forms, with or without
7ca987d46SWarner Losh  * modification, are permitted provided that the following conditions
8ca987d46SWarner Losh  * are met:
9ca987d46SWarner Losh  * 1. Redistributions of source code must retain the above copyright
10ca987d46SWarner Losh  *    notice, this list of conditions and the following disclaimer.
11ca987d46SWarner Losh  * 2. Redistributions in binary form must reproduce the above copyright
12ca987d46SWarner Losh  *    notice, this list of conditions and the following disclaimer in
13ca987d46SWarner Losh  *    the documentation and/or other materials provided with the
14ca987d46SWarner Losh  *    distribution.
15ca987d46SWarner Losh  *
16ca987d46SWarner Losh  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR(S) ``AS IS'' AND ANY EXPRESS
17ca987d46SWarner Losh  * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
18ca987d46SWarner Losh  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19ca987d46SWarner Losh  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR(S) BE LIABLE FOR ANY
20ca987d46SWarner Losh  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21ca987d46SWarner Losh  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
22ca987d46SWarner Losh  * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23ca987d46SWarner Losh  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
24ca987d46SWarner Losh  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
25ca987d46SWarner Losh  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
26ca987d46SWarner Losh  * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27ca987d46SWarner Losh  */
28ca987d46SWarner Losh 
29ca987d46SWarner Losh /*
30ca987d46SWarner Losh  * Readonly filesystem for Microsoft FAT12/FAT16/FAT32 filesystems,
31ca987d46SWarner Losh  * also supports VFAT.
32ca987d46SWarner Losh  */
33ca987d46SWarner Losh 
34ca987d46SWarner Losh #include <sys/types.h>
35*e7c0cb72SToomas Soome #include <sys/disk.h>
36ca987d46SWarner Losh #include <string.h>
37ca987d46SWarner Losh #include <stddef.h>
38ca987d46SWarner Losh 
39ca987d46SWarner Losh #include "stand.h"
40ca987d46SWarner Losh 
41ca987d46SWarner Losh #include "dosfs.h"
42ca987d46SWarner Losh 
43b4cb3fe0SToomas Soome typedef struct dos_mnt {
44b4cb3fe0SToomas Soome 	char			*dos_dev;
45b4cb3fe0SToomas Soome 	DOS_FS			*dos_fs;
46b4cb3fe0SToomas Soome 	int			dos_fd;
47b4cb3fe0SToomas Soome 	STAILQ_ENTRY(dos_mnt)	dos_link;
48b4cb3fe0SToomas Soome } dos_mnt_t;
49b4cb3fe0SToomas Soome 
50b4cb3fe0SToomas Soome typedef STAILQ_HEAD(dos_mnt_list, dos_mnt) dos_mnt_list_t;
51b4cb3fe0SToomas Soome static dos_mnt_list_t mnt_list = STAILQ_HEAD_INITIALIZER(mnt_list);
52ca987d46SWarner Losh 
53ca987d46SWarner Losh static int	dos_open(const char *path, struct open_file *fd);
54ca987d46SWarner Losh static int	dos_close(struct open_file *fd);
55ca987d46SWarner Losh static int	dos_read(struct open_file *fd, void *buf, size_t size, size_t *resid);
56ca987d46SWarner Losh static off_t	dos_seek(struct open_file *fd, off_t offset, int whence);
57ca987d46SWarner Losh static int	dos_stat(struct open_file *fd, struct stat *sb);
58ca987d46SWarner Losh static int	dos_readdir(struct open_file *fd, struct dirent *d);
59b4cb3fe0SToomas Soome static int	dos_mount(const char *dev, const char *path, void **data);
60b4cb3fe0SToomas Soome static int	dos_unmount(const char *dev, void *data);
61ca987d46SWarner Losh 
62ca987d46SWarner Losh struct fs_ops dosfs_fsops = {
63b4cb3fe0SToomas Soome 	.fs_name = "dosfs",
64b4cb3fe0SToomas Soome 	.fo_open = dos_open,
65b4cb3fe0SToomas Soome 	.fo_close = dos_close,
66b4cb3fe0SToomas Soome 	.fo_read = dos_read,
67b4cb3fe0SToomas Soome 	.fo_write = null_write,
68b4cb3fe0SToomas Soome 	.fo_seek = dos_seek,
69b4cb3fe0SToomas Soome 	.fo_stat = dos_stat,
70b4cb3fe0SToomas Soome 	.fo_readdir = dos_readdir,
71b4cb3fe0SToomas Soome 	.fo_mount = dos_mount,
72b4cb3fe0SToomas Soome 	.fo_unmount = dos_unmount
73ca987d46SWarner Losh };
74ca987d46SWarner Losh 
75ca987d46SWarner Losh #define LOCLUS    2             /* lowest cluster number */
76ca987d46SWarner Losh #define FATBLKSZ  0x20000       /* size of block in the FAT cache buffer */
77ca987d46SWarner Losh 
78ca987d46SWarner Losh /* DOS "BIOS Parameter Block" */
79ca987d46SWarner Losh typedef struct {
80ca987d46SWarner Losh 	u_char secsiz[2];           /* sector size */
81ca987d46SWarner Losh 	u_char spc;                 /* sectors per cluster */
82ca987d46SWarner Losh 	u_char ressec[2];           /* reserved sectors */
83ca987d46SWarner Losh 	u_char fats;                /* FATs */
84ca987d46SWarner Losh 	u_char dirents[2];          /* root directory entries */
85ca987d46SWarner Losh 	u_char secs[2];             /* total sectors */
86ca987d46SWarner Losh 	u_char media;               /* media descriptor */
87ca987d46SWarner Losh 	u_char spf[2];              /* sectors per FAT */
88ca987d46SWarner Losh 	u_char spt[2];              /* sectors per track */
89ca987d46SWarner Losh 	u_char heads[2];            /* drive heads */
90ca987d46SWarner Losh 	u_char hidsec[4];           /* hidden sectors */
91ca987d46SWarner Losh 	u_char lsecs[4];            /* huge sectors */
92*e7c0cb72SToomas Soome 	union {
93*e7c0cb72SToomas Soome 		struct {
94*e7c0cb72SToomas Soome 			u_char drvnum;		/* Int 13 drive number */
95*e7c0cb72SToomas Soome 			u_char rsvd1;		/* Reserved */
96*e7c0cb72SToomas Soome 			u_char bootsig;		/* Boot signature (0x29) */
97*e7c0cb72SToomas Soome 			u_char volid[4];	/* Volume serial number */
98*e7c0cb72SToomas Soome 			u_char vollab[11];	/* Volume label */
99*e7c0cb72SToomas Soome 			u_char fstype[8];	/* Informational */
100*e7c0cb72SToomas Soome 		} f12_f16;
101*e7c0cb72SToomas Soome 		struct {
102ca987d46SWarner Losh 			u_char lspf[4];		/* huge sectors per FAT */
103ca987d46SWarner Losh 			u_char xflg[2];		/* flags */
104ca987d46SWarner Losh 			u_char vers[2];		/* filesystem version */
105*e7c0cb72SToomas Soome 			u_char rdcl[4];		/* root directory cluster */
106ca987d46SWarner Losh 			u_char infs[2];		/* filesystem info sector */
107ca987d46SWarner Losh 			u_char bkbs[2];		/* backup boot sector */
108*e7c0cb72SToomas Soome 			u_char reserved[12];	/* Reserved */
109*e7c0cb72SToomas Soome 			u_char drvnum;		/* Int 13 drive number */
110*e7c0cb72SToomas Soome 			u_char rsvd1;		/* Reserved */
111*e7c0cb72SToomas Soome 			u_char bootsig;		/* Boot signature (0x29) */
112*e7c0cb72SToomas Soome 			u_char volid[4];	/* Volume serial number */
113*e7c0cb72SToomas Soome 			u_char vollab[11];	/* Volume label */
114*e7c0cb72SToomas Soome 			u_char fstype[8];	/* Informational */
115*e7c0cb72SToomas Soome 		} f32;
116*e7c0cb72SToomas Soome 	} fstype;
117ca987d46SWarner Losh } DOS_BPB;
118ca987d46SWarner Losh 
119*e7c0cb72SToomas Soome typedef struct {
120*e7c0cb72SToomas Soome 	u_char fsi_leadsig[4];		/* Value 0x41615252 */
121*e7c0cb72SToomas Soome 	u_char fsi_reserved1[480];
122*e7c0cb72SToomas Soome 	u_char fsi_structsig[4];	/* Value 0x61417272 */
123*e7c0cb72SToomas Soome 	u_char fsi_free_count[4];	/* Last known free cluster count */
124*e7c0cb72SToomas Soome 	u_char fsi_next_free[4];	/* First free cluster */
125*e7c0cb72SToomas Soome 	u_char fsi_reserved2[12];
126*e7c0cb72SToomas Soome 	u_char fsi_trailsig[4];		/* Value 0xAA550000 */
127*e7c0cb72SToomas Soome } DOS_FSINFO;
128*e7c0cb72SToomas Soome 
129ca987d46SWarner Losh /* Initial portion of DOS boot sector */
130ca987d46SWarner Losh typedef struct {
131ca987d46SWarner Losh 	u_char jmp[3];              /* usually 80x86 'jmp' opcode */
132ca987d46SWarner Losh 	u_char oem[8];              /* OEM name and version */
133ca987d46SWarner Losh 	DOS_BPB bpb;                /* BPB */
134ca987d46SWarner Losh } DOS_BS;
135ca987d46SWarner Losh 
136ca987d46SWarner Losh /* Supply missing "." and ".." root directory entries */
137ca987d46SWarner Losh static const char *const dotstr[2] = {".", ".."};
138ca987d46SWarner Losh static DOS_DE dot[2] = {
139ca987d46SWarner Losh 	{".       ", "   ", FA_DIR, {0, 0, {0, 0}, {0, 0}, {0, 0}, {0, 0}},
140ca987d46SWarner Losh 	    {0, 0}, {0x21, 0}, {0, 0}, {0, 0, 0, 0}},
141ca987d46SWarner Losh 	{"..      ", "   ", FA_DIR, {0, 0, {0, 0}, {0, 0}, {0, 0}, {0, 0}},
142ca987d46SWarner Losh 	    {0, 0}, {0x21, 0}, {0, 0}, {0, 0, 0, 0}}
143ca987d46SWarner Losh };
144ca987d46SWarner Losh 
145ca987d46SWarner Losh /* The usual conversion macros to avoid multiplication and division */
146*e7c0cb72SToomas Soome #define bytsec(fs, n)	((n) >> (fs)->sshift)
147*e7c0cb72SToomas Soome #define secbyt(fs, s)	((s) << (fs)->sshift)
148*e7c0cb72SToomas Soome #define depsec(fs)	(1 << (fs)->dshift)
149*e7c0cb72SToomas Soome #define entsec(fs, e)	((e) >> (fs)->dshift)
150ca987d46SWarner Losh #define bytblk(fs, n)	((n) >> (fs)->bshift)
151ca987d46SWarner Losh #define blkbyt(fs, b)	((b) << (fs)->bshift)
152*e7c0cb72SToomas Soome #define secblk(fs, s)	((s) >> ((fs)->bshift - (fs)->sshift))
153*e7c0cb72SToomas Soome #define blksec(fs, b)	((b) << ((fs)->bshift - (fs)->sshift))
154ca987d46SWarner Losh 
155ca987d46SWarner Losh /* Convert cluster number to offset within filesystem */
156*e7c0cb72SToomas Soome #define blkoff(fs, b)	(secbyt(fs, (fs)->lsndta) + \
157*e7c0cb72SToomas Soome 			blkbyt(fs, (b) - LOCLUS))
158ca987d46SWarner Losh 
159ca987d46SWarner Losh /* Convert cluster number to logical sector number */
160ca987d46SWarner Losh #define blklsn(fs, b)  ((fs)->lsndta + blksec(fs, (b) - LOCLUS))
161ca987d46SWarner Losh 
162ca987d46SWarner Losh /* Convert cluster number to offset within FAT */
163ca987d46SWarner Losh #define fatoff(sz, c)  ((sz) == 12 ? (c) + ((c) >> 1) :  \
164ca987d46SWarner Losh                         (sz) == 16 ? (c) << 1 :          \
165ca987d46SWarner Losh 			(c) << 2)
166ca987d46SWarner Losh 
167ca987d46SWarner Losh /* Does cluster number reference a valid data cluster? */
168ca987d46SWarner Losh #define okclus(fs, c)  ((c) >= LOCLUS && (c) <= (fs)->xclus)
169ca987d46SWarner Losh 
170ca987d46SWarner Losh /* Get start cluster from directory entry */
171fae4b97cSToomas Soome #define stclus(sz, de)  ((sz) != 32 ? (u_int)cv2((de)->clus) :	\
172ca987d46SWarner Losh                          ((u_int)cv2((de)->dex.h_clus) << 16) |	\
173ca987d46SWarner Losh 			 cv2((de)->clus))
174ca987d46SWarner Losh 
175ca987d46SWarner Losh static int parsebs(DOS_FS *, DOS_BS *);
176ca987d46SWarner Losh static int namede(DOS_FS *, const char *, DOS_DE **);
177ca987d46SWarner Losh static int lookup(DOS_FS *, u_int, const char *, DOS_DE **);
178ca987d46SWarner Losh static void cp_xdnm(u_char *, DOS_XDE *);
179ca987d46SWarner Losh static void cp_sfn(u_char *, DOS_DE *);
180ca987d46SWarner Losh static off_t fsize(DOS_FS *, DOS_DE *);
181ca987d46SWarner Losh static int fatcnt(DOS_FS *, u_int);
182ca987d46SWarner Losh static int fatget(DOS_FS *, u_int *);
183ca987d46SWarner Losh static int fatend(u_int, u_int);
184fae4b97cSToomas Soome static int ioread(DOS_FS *, uint64_t, void *, size_t);
185*e7c0cb72SToomas Soome static int ioget(DOS_FS *, daddr_t, void *, size_t);
186ca987d46SWarner Losh 
187ca987d46SWarner Losh static int
dos_read_fatblk(DOS_FS * fs,u_int blknum)188*e7c0cb72SToomas Soome dos_read_fatblk(DOS_FS *fs, u_int blknum)
189ca987d46SWarner Losh {
190ca987d46SWarner Losh 	int err;
191ca987d46SWarner Losh 	size_t io_size;
192ca987d46SWarner Losh 	daddr_t offset_in_fat, max_offset_in_fat;
193ca987d46SWarner Losh 
194ca987d46SWarner Losh 	offset_in_fat = ((daddr_t)blknum) * FATBLKSZ;
195*e7c0cb72SToomas Soome 	max_offset_in_fat = secbyt(fs, (daddr_t)fs->spf);
196ca987d46SWarner Losh 	io_size = FATBLKSZ;
197ca987d46SWarner Losh 	if (offset_in_fat > max_offset_in_fat)
198ca987d46SWarner Losh 		offset_in_fat = max_offset_in_fat;
199ca987d46SWarner Losh 	if (offset_in_fat + io_size > max_offset_in_fat)
200ca987d46SWarner Losh 		io_size = ((size_t)(max_offset_in_fat - offset_in_fat));
201ca987d46SWarner Losh 
202ca987d46SWarner Losh 	if (io_size != 0) {
203*e7c0cb72SToomas Soome 		err = ioget(fs, fs->lsnfat + bytsec(fs, offset_in_fat),
204ca987d46SWarner Losh 		    fs->fatbuf, io_size);
205ca987d46SWarner Losh 		if (err != 0) {
206ca987d46SWarner Losh 			fs->fatbuf_blknum = ((u_int)(-1));
207ca987d46SWarner Losh 			return (err);
208ca987d46SWarner Losh 		}
209ca987d46SWarner Losh 	}
210ca987d46SWarner Losh 	if (io_size < FATBLKSZ)
211ca987d46SWarner Losh 		memset(fs->fatbuf + io_size, 0, FATBLKSZ - io_size);
212ca987d46SWarner Losh 
213ca987d46SWarner Losh 	fs->fatbuf_blknum = blknum;
214ca987d46SWarner Losh 	return (0);
215ca987d46SWarner Losh }
216ca987d46SWarner Losh 
217ca987d46SWarner Losh /*
218ca987d46SWarner Losh  * Mount DOS filesystem
219ca987d46SWarner Losh  */
220ca987d46SWarner Losh static int
dos_mount_impl(DOS_FS * fs,struct open_file * fd)221b4cb3fe0SToomas Soome dos_mount_impl(DOS_FS *fs, struct open_file *fd)
222ca987d46SWarner Losh {
223ca987d46SWarner Losh 	int err;
224*e7c0cb72SToomas Soome 	unsigned secsz;
225ca987d46SWarner Losh 	u_char *buf;
226ca987d46SWarner Losh 
227ca987d46SWarner Losh 	fs->fd = fd;
228ca987d46SWarner Losh 
229*e7c0cb72SToomas Soome 	err = ioctl(fd->f_id, DIOCGSECTORSIZE, &secsz);
230*e7c0cb72SToomas Soome 	if (err != 0) {
231*e7c0cb72SToomas Soome 		return (err);
232*e7c0cb72SToomas Soome 	}
233*e7c0cb72SToomas Soome 
234*e7c0cb72SToomas Soome 	buf = malloc(secsz);
235*e7c0cb72SToomas Soome 	if (buf == NULL)
236ca987d46SWarner Losh 		return (errno);
237*e7c0cb72SToomas Soome 
238*e7c0cb72SToomas Soome 	if ((err = ioget(fs, 0, buf, secsz)) ||
239ca987d46SWarner Losh 	    (err = parsebs(fs, (DOS_BS *)buf))) {
240ca987d46SWarner Losh 		free(buf);
241ca987d46SWarner Losh 		return (err);
242ca987d46SWarner Losh 	}
243*e7c0cb72SToomas Soome 	fs->secbuf = buf;
244ca987d46SWarner Losh 
245*e7c0cb72SToomas Soome 	if ((fs->fatbuf = malloc(FATBLKSZ)) == NULL) {
246*e7c0cb72SToomas Soome 		free(buf);
247ca987d46SWarner Losh 		return (errno);
248*e7c0cb72SToomas Soome 	}
249*e7c0cb72SToomas Soome 	err = dos_read_fatblk(fs, 0);
250ca987d46SWarner Losh 	if (err != 0) {
251*e7c0cb72SToomas Soome 		free(buf);
252ca987d46SWarner Losh 		free(fs->fatbuf);
253ca987d46SWarner Losh 		return (err);
254ca987d46SWarner Losh 	}
255ca987d46SWarner Losh 
256ca987d46SWarner Losh 	fs->root = dot[0];
257ca987d46SWarner Losh 	fs->root.name[0] = ' ';
258ca987d46SWarner Losh 	if (fs->fatsz == 32) {
259ca987d46SWarner Losh 		fs->root.clus[0] = fs->rdcl & 0xff;
260ca987d46SWarner Losh 		fs->root.clus[1] = (fs->rdcl >> 8) & 0xff;
261ca987d46SWarner Losh 		fs->root.dex.h_clus[0] = (fs->rdcl >> 16) & 0xff;
262ca987d46SWarner Losh 		fs->root.dex.h_clus[1] = (fs->rdcl >> 24) & 0xff;
263ca987d46SWarner Losh 	}
264ca987d46SWarner Losh 	return (0);
265ca987d46SWarner Losh }
266ca987d46SWarner Losh 
267b4cb3fe0SToomas Soome static int
dos_mount(const char * dev,const char * path,void ** data)268b4cb3fe0SToomas Soome dos_mount(const char *dev, const char *path, void **data)
269b4cb3fe0SToomas Soome {
270b4cb3fe0SToomas Soome 	char *fs;
271b4cb3fe0SToomas Soome 	dos_mnt_t *mnt;
272b4cb3fe0SToomas Soome 	struct open_file *f;
273b4cb3fe0SToomas Soome 	DOS_FILE *df;
274b4cb3fe0SToomas Soome 
275b4cb3fe0SToomas Soome 	errno = 0;
276b4cb3fe0SToomas Soome 	mnt = calloc(1, sizeof(*mnt));
277b4cb3fe0SToomas Soome 	if (mnt == NULL)
278b4cb3fe0SToomas Soome 		return (errno);
279b4cb3fe0SToomas Soome 	mnt->dos_fd = -1;
280b4cb3fe0SToomas Soome 	mnt->dos_dev = strdup(dev);
281b4cb3fe0SToomas Soome 	if (mnt->dos_dev == NULL)
282b4cb3fe0SToomas Soome 		goto done;
283b4cb3fe0SToomas Soome 
284b4cb3fe0SToomas Soome 	if (asprintf(&fs, "%s%s", dev, path) < 0)
285b4cb3fe0SToomas Soome 		goto done;
286b4cb3fe0SToomas Soome 
287b4cb3fe0SToomas Soome 	mnt->dos_fd = open(fs, O_RDONLY);
288b4cb3fe0SToomas Soome 	free(fs);
289b4cb3fe0SToomas Soome 	if (mnt->dos_fd == -1)
290b4cb3fe0SToomas Soome 		goto done;
291b4cb3fe0SToomas Soome 
292b4cb3fe0SToomas Soome 	f = fd2open_file(mnt->dos_fd);
293b4cb3fe0SToomas Soome 	if (strcmp(f->f_ops->fs_name, "dosfs") == 0) {
294b4cb3fe0SToomas Soome 		df = f->f_fsdata;
295b4cb3fe0SToomas Soome 		mnt->dos_fs = df->fs;
296b4cb3fe0SToomas Soome 		STAILQ_INSERT_TAIL(&mnt_list, mnt, dos_link);
297b4cb3fe0SToomas Soome 	} else {
298b4cb3fe0SToomas Soome                 errno = ENXIO;
299b4cb3fe0SToomas Soome 	}
300b4cb3fe0SToomas Soome 
301b4cb3fe0SToomas Soome done:
302b4cb3fe0SToomas Soome 	if (errno != 0) {
303b4cb3fe0SToomas Soome 		free(mnt->dos_dev);
304b4cb3fe0SToomas Soome 		if (mnt->dos_fd >= 0)
305b4cb3fe0SToomas Soome 			close(mnt->dos_fd);
306b4cb3fe0SToomas Soome 		free(mnt);
307b4cb3fe0SToomas Soome 	} else {
308b4cb3fe0SToomas Soome 		*data = mnt;
309b4cb3fe0SToomas Soome 	}
310b4cb3fe0SToomas Soome 
311b4cb3fe0SToomas Soome 	return (errno);
312b4cb3fe0SToomas Soome }
313b4cb3fe0SToomas Soome 
314b4cb3fe0SToomas Soome static int
dos_unmount(const char * dev __unused,void * data)315b4cb3fe0SToomas Soome dos_unmount(const char *dev __unused, void *data)
316b4cb3fe0SToomas Soome {
317b4cb3fe0SToomas Soome 	dos_mnt_t *mnt = data;
318b4cb3fe0SToomas Soome 
319b4cb3fe0SToomas Soome 	STAILQ_REMOVE(&mnt_list, mnt, dos_mnt, dos_link);
320b4cb3fe0SToomas Soome 	free(mnt->dos_dev);
321b4cb3fe0SToomas Soome 	close(mnt->dos_fd);
322b4cb3fe0SToomas Soome 	free(mnt);
323b4cb3fe0SToomas Soome 	return (0);
324b4cb3fe0SToomas Soome }
325b4cb3fe0SToomas Soome 
326ca987d46SWarner Losh /*
327ca987d46SWarner Losh  * Unmount mounted filesystem
328ca987d46SWarner Losh  */
329ca987d46SWarner Losh static int
dos_unmount_impl(DOS_FS * fs)330b4cb3fe0SToomas Soome dos_unmount_impl(DOS_FS *fs)
331ca987d46SWarner Losh {
332ca987d46SWarner Losh 	if (fs->links)
333ca987d46SWarner Losh 		return (EBUSY);
334*e7c0cb72SToomas Soome 	free(fs->secbuf);
335ca987d46SWarner Losh 	free(fs->fatbuf);
336ca987d46SWarner Losh 	free(fs);
337ca987d46SWarner Losh 	return (0);
338ca987d46SWarner Losh }
339ca987d46SWarner Losh 
340ca987d46SWarner Losh /*
341ca987d46SWarner Losh  * Open DOS file
342ca987d46SWarner Losh  */
343ca987d46SWarner Losh static int
dos_open(const char * path,struct open_file * fd)344ca987d46SWarner Losh dos_open(const char *path, struct open_file *fd)
345ca987d46SWarner Losh {
346ca987d46SWarner Losh 	DOS_DE *de;
347ca987d46SWarner Losh 	DOS_FILE *f;
348*e7c0cb72SToomas Soome 	DOS_FS *fs = NULL;
349b4cb3fe0SToomas Soome 	dos_mnt_t *mnt;
350b4cb3fe0SToomas Soome 	const char *dev;
351ca987d46SWarner Losh 	u_int size, clus;
352ca987d46SWarner Losh 	int err;
353ca987d46SWarner Losh 
354ec9f3e77SWarner Losh 	dev = devformat((struct devdesc *)fd->f_devdata);
355b4cb3fe0SToomas Soome 	STAILQ_FOREACH(mnt, &mnt_list, dos_link) {
356b4cb3fe0SToomas Soome 		if (strcmp(dev, mnt->dos_dev) == 0)
357b4cb3fe0SToomas Soome 			break;
358b4cb3fe0SToomas Soome 	}
359b4cb3fe0SToomas Soome 
360b4cb3fe0SToomas Soome 	if (mnt == NULL) {
361ca987d46SWarner Losh 		/* Allocate mount structure, associate with open */
3620eb736c0SMichael Gmelin 		if ((fs = calloc(1, sizeof(DOS_FS))) == NULL)
363ca987d46SWarner Losh 			return (errno);
364b4cb3fe0SToomas Soome 		if ((err = dos_mount_impl(fs, fd))) {
365ca987d46SWarner Losh 			free(fs);
366ca987d46SWarner Losh 			return (err);
367ca987d46SWarner Losh 		}
368b4cb3fe0SToomas Soome 	} else {
369b4cb3fe0SToomas Soome 		fs = mnt->dos_fs;
370b4cb3fe0SToomas Soome 	}
371ca987d46SWarner Losh 
372ca987d46SWarner Losh 	if ((err = namede(fs, path, &de))) {
373b4cb3fe0SToomas Soome 		if (mnt == NULL)
374b4cb3fe0SToomas Soome 			dos_unmount_impl(fs);
375ca987d46SWarner Losh 		return (err);
376ca987d46SWarner Losh 	}
377ca987d46SWarner Losh 
378ca987d46SWarner Losh 	clus = stclus(fs->fatsz, de);
379ca987d46SWarner Losh 	size = cv4(de->size);
380ca987d46SWarner Losh 
381ca987d46SWarner Losh 	if ((!(de->attr & FA_DIR) && (!clus != !size)) ||
382ca987d46SWarner Losh 	    ((de->attr & FA_DIR) && size) ||
383ca987d46SWarner Losh 	    (clus && !okclus(fs, clus))) {
384b4cb3fe0SToomas Soome 		if (mnt == NULL)
385b4cb3fe0SToomas Soome 			dos_unmount_impl(fs);
386ca987d46SWarner Losh 		return (EINVAL);
387ca987d46SWarner Losh 	}
388b4cb3fe0SToomas Soome 	if ((f = calloc(1, sizeof(DOS_FILE))) == NULL) {
389ca987d46SWarner Losh 		err = errno;
390b4cb3fe0SToomas Soome 		if (mnt == NULL)
391b4cb3fe0SToomas Soome 			dos_unmount_impl(fs);
392ca987d46SWarner Losh 		return (err);
393ca987d46SWarner Losh 	}
394ca987d46SWarner Losh 	f->fs = fs;
395ca987d46SWarner Losh 	fs->links++;
396ca987d46SWarner Losh 	f->de = *de;
397b4cb3fe0SToomas Soome 	fd->f_fsdata = f;
398ca987d46SWarner Losh 	return (0);
399ca987d46SWarner Losh }
400ca987d46SWarner Losh 
401ca987d46SWarner Losh /*
402ca987d46SWarner Losh  * Read from file
403ca987d46SWarner Losh  */
404ca987d46SWarner Losh static int
dos_read(struct open_file * fd,void * buf,size_t nbyte,size_t * resid)405ca987d46SWarner Losh dos_read(struct open_file *fd, void *buf, size_t nbyte, size_t *resid)
406ca987d46SWarner Losh {
407ca987d46SWarner Losh 	off_t size;
408fae4b97cSToomas Soome 	uint64_t off;
409fae4b97cSToomas Soome 	size_t nb;
410fae4b97cSToomas Soome 	u_int clus, c, cnt, n;
411ca987d46SWarner Losh 	DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
412ca987d46SWarner Losh 	int err = 0;
413ca987d46SWarner Losh 
414ca987d46SWarner Losh 	/*
415ca987d46SWarner Losh 	 * as ioget() can be called *a lot*, use twiddle here.
416ca987d46SWarner Losh 	 * also 4 seems to be good value not to slow loading down too much:
4173ec0714dSToomas Soome 	 * with 270MB file (~540k ioget() calls, twiddle can easily waste
4183ec0714dSToomas Soome 	 * 4-5 sec.
419ca987d46SWarner Losh 	 */
420ca987d46SWarner Losh 	twiddle(4);
421fae4b97cSToomas Soome 	nb = nbyte;
422ca987d46SWarner Losh 	if ((size = fsize(f->fs, &f->de)) == -1)
423ca987d46SWarner Losh 		return (EINVAL);
424ca987d46SWarner Losh 	if (nb > (n = size - f->offset))
425ca987d46SWarner Losh 		nb = n;
426ca987d46SWarner Losh 	off = f->offset;
427ca987d46SWarner Losh 	if ((clus = stclus(f->fs->fatsz, &f->de)))
428ca987d46SWarner Losh 		off &= f->fs->bsize - 1;
429ca987d46SWarner Losh 	c = f->c;
430ca987d46SWarner Losh 	cnt = nb;
431ca987d46SWarner Losh 	while (cnt) {
432ca987d46SWarner Losh 		n = 0;
433ca987d46SWarner Losh 		if (!c) {
434ca987d46SWarner Losh 			if ((c = clus))
435ca987d46SWarner Losh 				n = bytblk(f->fs, f->offset);
436ca987d46SWarner Losh 		} else if (!off)
437ca987d46SWarner Losh 			n++;
438ca987d46SWarner Losh 		while (n--) {
439ca987d46SWarner Losh 			if ((err = fatget(f->fs, &c)))
440ca987d46SWarner Losh 				goto out;
441ca987d46SWarner Losh 			if (!okclus(f->fs, c)) {
442ca987d46SWarner Losh 				err = EINVAL;
443ca987d46SWarner Losh 				goto out;
444ca987d46SWarner Losh 			}
445ca987d46SWarner Losh 		}
446ca987d46SWarner Losh 		if (!clus || (n = f->fs->bsize - off) > cnt)
447ca987d46SWarner Losh 			n = cnt;
448fae4b97cSToomas Soome 		if (c != 0)
449fae4b97cSToomas Soome 			off += blkoff(f->fs, (uint64_t)c);
450fae4b97cSToomas Soome 		else
451*e7c0cb72SToomas Soome 			off += secbyt(f->fs, f->fs->lsndir);
452fae4b97cSToomas Soome 		err = ioread(f->fs, off, buf, n);
453fae4b97cSToomas Soome 		if (err != 0)
454ca987d46SWarner Losh 			goto out;
455ca987d46SWarner Losh 		f->offset += n;
456ca987d46SWarner Losh 		f->c = c;
457ca987d46SWarner Losh 		off = 0;
458ca987d46SWarner Losh 		buf = (char *)buf + n;
459ca987d46SWarner Losh 		cnt -= n;
460ca987d46SWarner Losh 	}
461ca987d46SWarner Losh out:
462ca987d46SWarner Losh 	if (resid)
463ca987d46SWarner Losh 		*resid = nbyte - nb + cnt;
464ca987d46SWarner Losh 	return (err);
465ca987d46SWarner Losh }
466ca987d46SWarner Losh 
467ca987d46SWarner Losh /*
468ca987d46SWarner Losh  * Reposition within file
469ca987d46SWarner Losh  */
470ca987d46SWarner Losh static off_t
dos_seek(struct open_file * fd,off_t offset,int whence)471ca987d46SWarner Losh dos_seek(struct open_file *fd, off_t offset, int whence)
472ca987d46SWarner Losh {
473ca987d46SWarner Losh 	off_t off;
474ca987d46SWarner Losh 	u_int size;
475ca987d46SWarner Losh 	DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
476ca987d46SWarner Losh 
477ca987d46SWarner Losh 	size = cv4(f->de.size);
478ca987d46SWarner Losh 	switch (whence) {
479ca987d46SWarner Losh 	case SEEK_SET:
480ca987d46SWarner Losh 		off = 0;
481ca987d46SWarner Losh 		break;
482ca987d46SWarner Losh 	case SEEK_CUR:
483ca987d46SWarner Losh 		off = f->offset;
484ca987d46SWarner Losh 		break;
485ca987d46SWarner Losh 	case SEEK_END:
486ca987d46SWarner Losh 		off = size;
487ca987d46SWarner Losh 		break;
488ca987d46SWarner Losh 	default:
489ca987d46SWarner Losh 		errno = EINVAL;
490ca987d46SWarner Losh 		return (-1);
491ca987d46SWarner Losh 	}
492ca987d46SWarner Losh 	off += offset;
493ca987d46SWarner Losh 	if (off < 0 || off > size) {
494ca987d46SWarner Losh 		errno = EINVAL;
495ca987d46SWarner Losh 		return (-1);
496ca987d46SWarner Losh 	}
497ca987d46SWarner Losh 	f->offset = (u_int)off;
498ca987d46SWarner Losh 	f->c = 0;
499ca987d46SWarner Losh 	return (off);
500ca987d46SWarner Losh }
501ca987d46SWarner Losh 
502ca987d46SWarner Losh /*
503ca987d46SWarner Losh  * Close open file
504ca987d46SWarner Losh  */
505ca987d46SWarner Losh static int
dos_close(struct open_file * fd)506ca987d46SWarner Losh dos_close(struct open_file *fd)
507ca987d46SWarner Losh {
508ca987d46SWarner Losh 	DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
509ca987d46SWarner Losh 	DOS_FS *fs = f->fs;
510ca987d46SWarner Losh 
511ca987d46SWarner Losh 	f->fs->links--;
512ca987d46SWarner Losh 	free(f);
513b4cb3fe0SToomas Soome 	dos_unmount_impl(fs);
514ca987d46SWarner Losh 	return (0);
515ca987d46SWarner Losh }
516ca987d46SWarner Losh 
517ca987d46SWarner Losh /*
518ca987d46SWarner Losh  * Return some stat information on a file.
519ca987d46SWarner Losh  */
520ca987d46SWarner Losh static int
dos_stat(struct open_file * fd,struct stat * sb)521ca987d46SWarner Losh dos_stat(struct open_file *fd, struct stat *sb)
522ca987d46SWarner Losh {
523ca987d46SWarner Losh 	DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
524ca987d46SWarner Losh 
525ca987d46SWarner Losh 	/* only important stuff */
526ca987d46SWarner Losh 	sb->st_mode = f->de.attr & FA_DIR ? S_IFDIR | 0555 : S_IFREG | 0444;
527ca987d46SWarner Losh 	sb->st_nlink = 1;
528ca987d46SWarner Losh 	sb->st_uid = 0;
529ca987d46SWarner Losh 	sb->st_gid = 0;
530ca987d46SWarner Losh 	if ((sb->st_size = fsize(f->fs, &f->de)) == -1)
531ca987d46SWarner Losh 		return (EINVAL);
532ca987d46SWarner Losh 	return (0);
533ca987d46SWarner Losh }
534ca987d46SWarner Losh 
535ca987d46SWarner Losh static int
dos_checksum(unsigned char * name,unsigned char * ext)536513f7db5SToomas Soome dos_checksum(unsigned char *name, unsigned char *ext)
537ca987d46SWarner Losh {
538ca987d46SWarner Losh 	int x, i;
539ca987d46SWarner Losh 	char buf[11];
540ca987d46SWarner Losh 
541ca987d46SWarner Losh 	bcopy(name, buf, 8);
542ca987d46SWarner Losh 	bcopy(ext, buf+8, 3);
543ca987d46SWarner Losh 	x = 0;
544ca987d46SWarner Losh 	for (i = 0; i < 11; i++) {
545ca987d46SWarner Losh 		x = ((x & 1) << 7) | (x >> 1);
546ca987d46SWarner Losh 		x += buf[i];
547ca987d46SWarner Losh 		x &= 0xff;
548ca987d46SWarner Losh 	}
549ca987d46SWarner Losh 	return (x);
550ca987d46SWarner Losh }
551ca987d46SWarner Losh 
552ca987d46SWarner Losh static int
dos_readdir(struct open_file * fd,struct dirent * d)553ca987d46SWarner Losh dos_readdir(struct open_file *fd, struct dirent *d)
554ca987d46SWarner Losh {
555ca987d46SWarner Losh 	/* DOS_FILE *f = (DOS_FILE *)fd->f_fsdata; */
556ca987d46SWarner Losh 	u_char fn[261];
557ca987d46SWarner Losh 	DOS_DIR dd;
558ca987d46SWarner Losh 	size_t res;
559ca987d46SWarner Losh 	u_int chk, x, xdn;
560ca987d46SWarner Losh 	int err;
561ca987d46SWarner Losh 
562ca987d46SWarner Losh 	x = chk = 0;
5633ec0714dSToomas Soome 	for (;;) {
564ca987d46SWarner Losh 		xdn = x;
565ca987d46SWarner Losh 		x = 0;
566ca987d46SWarner Losh 		err = dos_read(fd, &dd, sizeof(dd), &res);
567ca987d46SWarner Losh 		if (err)
568ca987d46SWarner Losh 			return (err);
569ca987d46SWarner Losh 		if (res == sizeof(dd))
570ca987d46SWarner Losh 			return (ENOENT);
571ca987d46SWarner Losh 		if (dd.de.name[0] == 0)
572ca987d46SWarner Losh 			return (ENOENT);
573ca987d46SWarner Losh 
574ca987d46SWarner Losh 		/* Skip deleted entries */
575ca987d46SWarner Losh 		if (dd.de.name[0] == 0xe5)
576ca987d46SWarner Losh 			continue;
577ca987d46SWarner Losh 
578ca987d46SWarner Losh 		/* Check if directory entry is volume label */
579ca987d46SWarner Losh 		if (dd.de.attr & FA_LABEL) {
580ca987d46SWarner Losh 			/*
581ca987d46SWarner Losh 			 * If volume label set, check if the current entry is
582ca987d46SWarner Losh 			 * extended entry (FA_XDE) for long file names.
583ca987d46SWarner Losh 			 */
584ca987d46SWarner Losh 			if ((dd.de.attr & FA_MASK) == FA_XDE) {
585ca987d46SWarner Losh 				/*
586ca987d46SWarner Losh 				 * Read through all following extended entries
587ca987d46SWarner Losh 				 * to get the long file name. 0x40 marks the
588ca987d46SWarner Losh 				 * last entry containing part of long file name.
589ca987d46SWarner Losh 				 */
590ca987d46SWarner Losh 				if (dd.xde.seq & 0x40)
591ca987d46SWarner Losh 					chk = dd.xde.chk;
5923ec0714dSToomas Soome 				else if (dd.xde.seq != xdn - 1 ||
5933ec0714dSToomas Soome 				    dd.xde.chk != chk)
594ca987d46SWarner Losh 					continue;
595ca987d46SWarner Losh 				x = dd.xde.seq & ~0x40;
596ca987d46SWarner Losh 				if (x < 1 || x > 20) {
597ca987d46SWarner Losh 					x = 0;
598ca987d46SWarner Losh 					continue;
599ca987d46SWarner Losh 				}
600ca987d46SWarner Losh 				cp_xdnm(fn, &dd.xde);
601ca987d46SWarner Losh 			} else {
602ca987d46SWarner Losh 				/* skip only volume label entries */
603ca987d46SWarner Losh 				continue;
604ca987d46SWarner Losh 			}
605ca987d46SWarner Losh 		} else {
606ca987d46SWarner Losh 			if (xdn == 1) {
607ca987d46SWarner Losh 				x = dos_checksum(dd.de.name, dd.de.ext);
608ca987d46SWarner Losh 				if (x == chk)
609ca987d46SWarner Losh 					break;
610ca987d46SWarner Losh 			} else {
611ca987d46SWarner Losh 				cp_sfn(fn, &dd.de);
612ca987d46SWarner Losh 				break;
613ca987d46SWarner Losh 			}
614ca987d46SWarner Losh 			x = 0;
615ca987d46SWarner Losh 		}
616ca987d46SWarner Losh 	}
617ca987d46SWarner Losh 
618ca987d46SWarner Losh 	d->d_fileno = (dd.de.clus[1] << 8) + dd.de.clus[0];
619ca987d46SWarner Losh 	d->d_reclen = sizeof(*d);
620ca987d46SWarner Losh 	d->d_type = (dd.de.attr & FA_DIR) ? DT_DIR : DT_REG;
621ca987d46SWarner Losh 	memcpy(d->d_name, fn, sizeof(d->d_name));
622ca987d46SWarner Losh 	return (0);
623ca987d46SWarner Losh }
624ca987d46SWarner Losh 
625ca987d46SWarner Losh /*
626ca987d46SWarner Losh  * Parse DOS boot sector
627ca987d46SWarner Losh  */
628ca987d46SWarner Losh static int
parsebs(DOS_FS * fs,DOS_BS * bs)629ca987d46SWarner Losh parsebs(DOS_FS *fs, DOS_BS *bs)
630ca987d46SWarner Losh {
631*e7c0cb72SToomas Soome 	u_int sc, RootDirSectors;
632ca987d46SWarner Losh 
633*e7c0cb72SToomas Soome 	if (bs->bpb.media < 0xf0)
634ca987d46SWarner Losh 		return (EINVAL);
635*e7c0cb72SToomas Soome 
636*e7c0cb72SToomas Soome 	/* Check supported sector sizes */
637*e7c0cb72SToomas Soome 	switch (cv2(bs->bpb.secsiz)) {
638*e7c0cb72SToomas Soome 	case 512:
639*e7c0cb72SToomas Soome 	case 1024:
640*e7c0cb72SToomas Soome 	case 2048:
641*e7c0cb72SToomas Soome 	case 4096:
642*e7c0cb72SToomas Soome 		fs->sshift = ffs(cv2(bs->bpb.secsiz)) - 1;
643*e7c0cb72SToomas Soome 		break;
644*e7c0cb72SToomas Soome 
645*e7c0cb72SToomas Soome 	default:
646ca987d46SWarner Losh 		return (EINVAL);
647ca987d46SWarner Losh 	}
648*e7c0cb72SToomas Soome 
649*e7c0cb72SToomas Soome 	if (!(fs->spc = bs->bpb.spc) || fs->spc & (fs->spc - 1))
650ca987d46SWarner Losh 		return (EINVAL);
651*e7c0cb72SToomas Soome 	fs->bsize = secbyt(fs, fs->spc);
652*e7c0cb72SToomas Soome 	fs->bshift = ffs(fs->bsize) - 1;
653*e7c0cb72SToomas Soome 	fs->dshift = ffs(secbyt(fs, 1) / sizeof (DOS_DE)) - 1;
654*e7c0cb72SToomas Soome 	fs->dirents = cv2(bs->bpb.dirents);
655*e7c0cb72SToomas Soome 	fs->spf = cv2(bs->bpb.spf);
656*e7c0cb72SToomas Soome 	fs->lsnfat = cv2(bs->bpb.ressec);
657*e7c0cb72SToomas Soome 
658*e7c0cb72SToomas Soome 	if (fs->spf != 0) {
659*e7c0cb72SToomas Soome 		if (bs->bpb.fats != 2)
660*e7c0cb72SToomas Soome 			return (EINVAL);
661*e7c0cb72SToomas Soome 		if (fs->dirents == 0)
662*e7c0cb72SToomas Soome 			return (EINVAL);
663*e7c0cb72SToomas Soome 	} else {
664*e7c0cb72SToomas Soome 		fs->spf = cv4(bs->bpb.fstype.f32.lspf);
665*e7c0cb72SToomas Soome 		if (fs->spf == 0)
666*e7c0cb72SToomas Soome 			return (EINVAL);
667*e7c0cb72SToomas Soome 		if (bs->bpb.fats == 0 || bs->bpb.fats > 16)
668*e7c0cb72SToomas Soome 			return (EINVAL);
669*e7c0cb72SToomas Soome 		fs->rdcl = cv4(bs->bpb.fstype.f32.rdcl);
670*e7c0cb72SToomas Soome 		if (fs->rdcl < LOCLUS)
671*e7c0cb72SToomas Soome 			return (EINVAL);
672*e7c0cb72SToomas Soome 	}
673*e7c0cb72SToomas Soome 
674*e7c0cb72SToomas Soome 	RootDirSectors = ((fs->dirents * sizeof (DOS_DE)) +
675*e7c0cb72SToomas Soome 	    (secbyt(fs, 1) - 1)) / secbyt(fs, 1);
676*e7c0cb72SToomas Soome 
677ca987d46SWarner Losh 	fs->lsndir = fs->lsnfat + fs->spf * bs->bpb.fats;
678*e7c0cb72SToomas Soome 	fs->lsndta = fs->lsndir + RootDirSectors;
679ca987d46SWarner Losh 	if (!(sc = cv2(bs->bpb.secs)) && !(sc = cv4(bs->bpb.lsecs)))
680ca987d46SWarner Losh 		return (EINVAL);
681ca987d46SWarner Losh 	if (fs->lsndta > sc)
682ca987d46SWarner Losh 		return (EINVAL);
683ca987d46SWarner Losh 	if ((fs->xclus = secblk(fs, sc - fs->lsndta) + 1) < LOCLUS)
684ca987d46SWarner Losh 		return (EINVAL);
685ca987d46SWarner Losh 	fs->fatsz = fs->dirents ? fs->xclus < 0xff6 ? 12 : 16 : 32;
686*e7c0cb72SToomas Soome 	sc = (secbyt(fs, fs->spf) << 1) / (fs->fatsz >> 2) - 1;
687ca987d46SWarner Losh 	if (fs->xclus > sc)
688ca987d46SWarner Losh 		fs->xclus = sc;
689ca987d46SWarner Losh 	return (0);
690ca987d46SWarner Losh }
691ca987d46SWarner Losh 
692ca987d46SWarner Losh /*
693ca987d46SWarner Losh  * Return directory entry from path
694ca987d46SWarner Losh  */
695ca987d46SWarner Losh static int
namede(DOS_FS * fs,const char * path,DOS_DE ** dep)696ca987d46SWarner Losh namede(DOS_FS *fs, const char *path, DOS_DE **dep)
697ca987d46SWarner Losh {
698ca987d46SWarner Losh 	char name[256];
699ca987d46SWarner Losh 	DOS_DE *de;
700ca987d46SWarner Losh 	char *s;
701ca987d46SWarner Losh 	size_t n;
702ca987d46SWarner Losh 	int err;
703ca987d46SWarner Losh 
704ca987d46SWarner Losh 	err = 0;
705ca987d46SWarner Losh 	de = &fs->root;
706ca987d46SWarner Losh 	while (*path) {
707ca987d46SWarner Losh 		while (*path == '/')
708ca987d46SWarner Losh 			path++;
709ca987d46SWarner Losh 		if (*path == '\0')
710ca987d46SWarner Losh 			break;
711ca987d46SWarner Losh 		if (!(s = strchr(path, '/')))
712ca987d46SWarner Losh 			s = strchr(path, 0);
713ca987d46SWarner Losh 		if ((n = s - path) > 255)
714ca987d46SWarner Losh 			return (ENAMETOOLONG);
715ca987d46SWarner Losh 		memcpy(name, path, n);
716ca987d46SWarner Losh 		name[n] = 0;
717ca987d46SWarner Losh 		path = s;
718ca987d46SWarner Losh 		if (!(de->attr & FA_DIR))
719ca987d46SWarner Losh 			return (ENOTDIR);
720ca987d46SWarner Losh 		if ((err = lookup(fs, stclus(fs->fatsz, de), name, &de)))
721ca987d46SWarner Losh 			return (err);
722ca987d46SWarner Losh 	}
723ca987d46SWarner Losh 	*dep = de;
724ca987d46SWarner Losh 	return (0);
725ca987d46SWarner Losh }
726ca987d46SWarner Losh 
727ca987d46SWarner Losh /*
728ca987d46SWarner Losh  * Lookup path segment
729ca987d46SWarner Losh  */
730ca987d46SWarner Losh static int
lookup(DOS_FS * fs,u_int clus,const char * name,DOS_DE ** dep)731ca987d46SWarner Losh lookup(DOS_FS *fs, u_int clus, const char *name, DOS_DE **dep)
732ca987d46SWarner Losh {
733*e7c0cb72SToomas Soome 	DOS_DIR *dir;
734ca987d46SWarner Losh 	u_char lfn[261];
735ca987d46SWarner Losh 	u_char sfn[13];
736ca987d46SWarner Losh 	u_int nsec, lsec, xdn, chk, sec, ent, x;
737ca987d46SWarner Losh 	int err, ok;
738ca987d46SWarner Losh 
739ca987d46SWarner Losh 	if (!clus)
740ca987d46SWarner Losh 		for (ent = 0; ent < 2; ent++)
741ca987d46SWarner Losh 			if (!strcasecmp(name, dotstr[ent])) {
742ca987d46SWarner Losh 				*dep = dot + ent;
743ca987d46SWarner Losh 				return (0);
744ca987d46SWarner Losh 		}
745ca987d46SWarner Losh 	if (!clus && fs->fatsz == 32)
746ca987d46SWarner Losh 		clus = fs->rdcl;
747*e7c0cb72SToomas Soome 	nsec = !clus ? entsec(fs, fs->dirents) : fs->spc;
748ca987d46SWarner Losh 	lsec = 0;
749ca987d46SWarner Losh 	xdn = chk = 0;
750*e7c0cb72SToomas Soome 	dir = (DOS_DIR *)fs->secbuf;
751ca987d46SWarner Losh 	for (;;) {
752ca987d46SWarner Losh 		if (!clus && !lsec)
753ca987d46SWarner Losh 			lsec = fs->lsndir;
754ca987d46SWarner Losh 		else if (okclus(fs, clus))
755ca987d46SWarner Losh 			lsec = blklsn(fs, clus);
756ca987d46SWarner Losh 		else
757ca987d46SWarner Losh 			return (EINVAL);
758ca987d46SWarner Losh 		for (sec = 0; sec < nsec; sec++) {
759*e7c0cb72SToomas Soome 			if ((err = ioget(fs, lsec + sec, dir,
760*e7c0cb72SToomas Soome 			    secbyt(fs, 1))))
761ca987d46SWarner Losh 				return (err);
762*e7c0cb72SToomas Soome 			for (ent = 0; ent < depsec(fs); ent++) {
763ca987d46SWarner Losh 				if (!*dir[ent].de.name)
764ca987d46SWarner Losh 					return (ENOENT);
765ca987d46SWarner Losh 				if (*dir[ent].de.name != 0xe5) {
7663ec0714dSToomas Soome 					if ((dir[ent].de.attr & FA_MASK) ==
7673ec0714dSToomas Soome 					    FA_XDE) {
768ca987d46SWarner Losh 						x = dir[ent].xde.seq;
769ca987d46SWarner Losh 						if (x & 0x40 || (x + 1 == xdn &&
770ca987d46SWarner Losh 						    dir[ent].xde.chk == chk)) {
771ca987d46SWarner Losh 							if (x & 0x40) {
772ca987d46SWarner Losh 								chk = dir[ent].xde.chk;
773ca987d46SWarner Losh 								x &= ~0x40;
774ca987d46SWarner Losh 							}
775ca987d46SWarner Losh 							if (x >= 1 && x <= 20) {
776ca987d46SWarner Losh 								cp_xdnm(lfn, &dir[ent].xde);
777ca987d46SWarner Losh 								xdn = x;
778ca987d46SWarner Losh 								continue;
779ca987d46SWarner Losh 							}
780ca987d46SWarner Losh 						}
7813ec0714dSToomas Soome 					} else if (!(dir[ent].de.attr &
7823ec0714dSToomas Soome 					    FA_LABEL)) {
783ca987d46SWarner Losh 						if ((ok = xdn == 1)) {
7843ec0714dSToomas Soome 							x = dos_checksum(
7853ec0714dSToomas Soome 							    dir[ent].de.name,
7863ec0714dSToomas Soome 							    dir[ent].de.ext);
787ca987d46SWarner Losh 							ok = chk == x &&
7883ec0714dSToomas Soome 							!strcasecmp(name,
7893ec0714dSToomas Soome 							    (const char *)lfn);
790ca987d46SWarner Losh 						}
791ca987d46SWarner Losh 						if (!ok) {
7923ec0714dSToomas Soome 							cp_sfn(sfn,
7933ec0714dSToomas Soome 							    &dir[ent].de);
7943ec0714dSToomas Soome 							ok = !strcasecmp(name,
7953ec0714dSToomas Soome 							    (const char *)sfn);
796ca987d46SWarner Losh 						}
797ca987d46SWarner Losh 						if (ok) {
798ca987d46SWarner Losh 							*dep = &dir[ent].de;
799ca987d46SWarner Losh 							return (0);
800ca987d46SWarner Losh 						}
801ca987d46SWarner Losh 					}
802ca987d46SWarner Losh 				}
803ca987d46SWarner Losh 				xdn = 0;
804ca987d46SWarner Losh 			}
805ca987d46SWarner Losh 		}
806ca987d46SWarner Losh 		if (!clus)
807ca987d46SWarner Losh 			break;
808ca987d46SWarner Losh 		if ((err = fatget(fs, &clus)))
809ca987d46SWarner Losh 			return (err);
810ca987d46SWarner Losh 		if (fatend(fs->fatsz, clus))
811ca987d46SWarner Losh 			break;
812ca987d46SWarner Losh 	}
813ca987d46SWarner Losh 	return (ENOENT);
814ca987d46SWarner Losh }
815ca987d46SWarner Losh 
816ca987d46SWarner Losh /*
817ca987d46SWarner Losh  * Copy name from extended directory entry
818ca987d46SWarner Losh  */
819ca987d46SWarner Losh static void
cp_xdnm(u_char * lfn,DOS_XDE * xde)820ca987d46SWarner Losh cp_xdnm(u_char *lfn, DOS_XDE *xde)
821ca987d46SWarner Losh {
822ca987d46SWarner Losh 	static struct {
823ca987d46SWarner Losh 		u_int off;
824ca987d46SWarner Losh 		u_int dim;
825ca987d46SWarner Losh 	} ix[3] = {
826ca987d46SWarner Losh 		{offsetof(DOS_XDE, name1), sizeof(xde->name1) / 2},
827ca987d46SWarner Losh 		{offsetof(DOS_XDE, name2), sizeof(xde->name2) / 2},
828ca987d46SWarner Losh 		{offsetof(DOS_XDE, name3), sizeof(xde->name3) / 2}
829ca987d46SWarner Losh 	};
830ca987d46SWarner Losh 	u_char *p;
831ca987d46SWarner Losh 	u_int n, x, c;
832ca987d46SWarner Losh 
833ca987d46SWarner Losh 	lfn += 13 * ((xde->seq & ~0x40) - 1);
834ca987d46SWarner Losh 	for (n = 0; n < 3; n++)
835ca987d46SWarner Losh 		for (p = (u_char *)xde + ix[n].off, x = ix[n].dim; x;
836ca987d46SWarner Losh 		    p += 2, x--) {
837ca987d46SWarner Losh 			if ((c = cv2(p)) && (c < 32 || c > 127))
838ca987d46SWarner Losh 				c = '?';
839ca987d46SWarner Losh 			if (!(*lfn++ = c))
840ca987d46SWarner Losh 				return;
841ca987d46SWarner Losh 		}
842ca987d46SWarner Losh 	if (xde->seq & 0x40)
843ca987d46SWarner Losh 		*lfn = 0;
844ca987d46SWarner Losh }
845ca987d46SWarner Losh 
846ca987d46SWarner Losh /*
847ca987d46SWarner Losh  * Copy short filename
848ca987d46SWarner Losh  */
849ca987d46SWarner Losh static void
cp_sfn(u_char * sfn,DOS_DE * de)850ca987d46SWarner Losh cp_sfn(u_char *sfn, DOS_DE *de)
851ca987d46SWarner Losh {
852ca987d46SWarner Losh 	u_char *p;
853ca987d46SWarner Losh 	int j, i;
854ca987d46SWarner Losh 
855ca987d46SWarner Losh 	p = sfn;
856ca987d46SWarner Losh 	if (*de->name != ' ') {
8573ec0714dSToomas Soome 		for (j = 7; de->name[j] == ' '; j--)
8583ec0714dSToomas Soome 			;
859ca987d46SWarner Losh 		for (i = 0; i <= j; i++)
860ca987d46SWarner Losh 			*p++ = de->name[i];
861ca987d46SWarner Losh 		if (*de->ext != ' ') {
862ca987d46SWarner Losh 			*p++ = '.';
8633ec0714dSToomas Soome 			for (j = 2; de->ext[j] == ' '; j--)
8643ec0714dSToomas Soome 				;
865ca987d46SWarner Losh 			for (i = 0; i <= j; i++)
866ca987d46SWarner Losh 				*p++ = de->ext[i];
867ca987d46SWarner Losh 		}
868ca987d46SWarner Losh 	}
869ca987d46SWarner Losh 	*p = 0;
870ca987d46SWarner Losh 	if (*sfn == 5)
871ca987d46SWarner Losh 		*sfn = 0xe5;
872ca987d46SWarner Losh }
873ca987d46SWarner Losh 
874ca987d46SWarner Losh /*
875ca987d46SWarner Losh  * Return size of file in bytes
876ca987d46SWarner Losh  */
877ca987d46SWarner Losh static off_t
fsize(DOS_FS * fs,DOS_DE * de)878ca987d46SWarner Losh fsize(DOS_FS *fs, DOS_DE *de)
879ca987d46SWarner Losh {
880ca987d46SWarner Losh 	u_long size;
881ca987d46SWarner Losh 	u_int c;
882ca987d46SWarner Losh 	int n;
883ca987d46SWarner Losh 
884ca987d46SWarner Losh 	if (!(size = cv4(de->size)) && de->attr & FA_DIR) {
88579a0d14fSToomas Soome 		if (!(c = stclus(fs->fatsz, de))) {
886ca987d46SWarner Losh 			size = fs->dirents * sizeof(DOS_DE);
8873ec0714dSToomas Soome 		} else {
888ca987d46SWarner Losh 			if ((n = fatcnt(fs, c)) == -1)
889ca987d46SWarner Losh 				return (n);
890ca987d46SWarner Losh 			size = blkbyt(fs, n);
891ca987d46SWarner Losh 		}
892ca987d46SWarner Losh 	}
893ca987d46SWarner Losh 	return (size);
894ca987d46SWarner Losh }
895ca987d46SWarner Losh 
896ca987d46SWarner Losh /*
897ca987d46SWarner Losh  * Count number of clusters in chain
898ca987d46SWarner Losh  */
899ca987d46SWarner Losh static int
fatcnt(DOS_FS * fs,u_int c)900ca987d46SWarner Losh fatcnt(DOS_FS *fs, u_int c)
901ca987d46SWarner Losh {
902ca987d46SWarner Losh 	int n;
903ca987d46SWarner Losh 
904ca987d46SWarner Losh 	for (n = 0; okclus(fs, c); n++)
905ca987d46SWarner Losh 		if (fatget(fs, &c))
906ca987d46SWarner Losh 			return (-1);
907ca987d46SWarner Losh 	return (fatend(fs->fatsz, c) ? n : -1);
908ca987d46SWarner Losh }
909ca987d46SWarner Losh 
910ca987d46SWarner Losh /*
911ca987d46SWarner Losh  * Get next cluster in cluster chain. Use in core fat cache unless
912ca987d46SWarner Losh  * the number of current 128K block in FAT has changed.
913ca987d46SWarner Losh  */
914ca987d46SWarner Losh static int
fatget(DOS_FS * fs,u_int * c)915ca987d46SWarner Losh fatget(DOS_FS *fs, u_int *c)
916ca987d46SWarner Losh {
917ca987d46SWarner Losh 	u_int val_in, val_out, offset, blknum, nbyte;
918ca987d46SWarner Losh 	const u_char *p_entry;
919ca987d46SWarner Losh 	int err;
920ca987d46SWarner Losh 
921ca987d46SWarner Losh 	/* check input value to prevent overflow in fatoff() */
922ca987d46SWarner Losh 	val_in = *c;
923ca987d46SWarner Losh 	if (val_in & 0xf0000000)
924ca987d46SWarner Losh 		return (EINVAL);
925ca987d46SWarner Losh 
926ca987d46SWarner Losh 	/* ensure that current 128K FAT block is cached */
927ca987d46SWarner Losh 	offset = fatoff(fs->fatsz, val_in);
928ca987d46SWarner Losh 	nbyte = fs->fatsz != 32 ? 2 : 4;
929*e7c0cb72SToomas Soome 	if (offset + nbyte > secbyt(fs, fs->spf))
930ca987d46SWarner Losh 		return (EINVAL);
931ca987d46SWarner Losh 	blknum = offset / FATBLKSZ;
932ca987d46SWarner Losh 	offset %= FATBLKSZ;
933ca987d46SWarner Losh 	if (offset + nbyte > FATBLKSZ)
934ca987d46SWarner Losh 		return (EINVAL);
935ca987d46SWarner Losh 	if (blknum != fs->fatbuf_blknum) {
936*e7c0cb72SToomas Soome 		err = dos_read_fatblk(fs, blknum);
937ca987d46SWarner Losh 		if (err != 0)
938ca987d46SWarner Losh 			return (err);
939ca987d46SWarner Losh 	}
940ca987d46SWarner Losh 	p_entry = fs->fatbuf + offset;
941ca987d46SWarner Losh 
942ca987d46SWarner Losh 	/* extract cluster number from FAT entry */
943ca987d46SWarner Losh 	switch (fs->fatsz) {
944ca987d46SWarner Losh 	case 32:
945ca987d46SWarner Losh 		val_out = cv4(p_entry);
946ca987d46SWarner Losh 		val_out &= 0x0fffffff;
947ca987d46SWarner Losh 		break;
948ca987d46SWarner Losh 	case 16:
949ca987d46SWarner Losh 		val_out = cv2(p_entry);
950ca987d46SWarner Losh 		break;
951ca987d46SWarner Losh 	case 12:
952ca987d46SWarner Losh 		val_out = cv2(p_entry);
953ca987d46SWarner Losh 		if (val_in & 1)
954ca987d46SWarner Losh 			val_out >>= 4;
955ca987d46SWarner Losh 		else
956ca987d46SWarner Losh 			val_out &= 0xfff;
957ca987d46SWarner Losh 		break;
958ca987d46SWarner Losh 	default:
959ca987d46SWarner Losh 		return (EINVAL);
960ca987d46SWarner Losh 	}
961ca987d46SWarner Losh 	*c = val_out;
962ca987d46SWarner Losh 	return (0);
963ca987d46SWarner Losh }
964ca987d46SWarner Losh 
965ca987d46SWarner Losh /*
966ca987d46SWarner Losh  * Is cluster an end-of-chain marker?
967ca987d46SWarner Losh  */
968ca987d46SWarner Losh static int
fatend(u_int sz,u_int c)969ca987d46SWarner Losh fatend(u_int sz, u_int c)
970ca987d46SWarner Losh {
971ca987d46SWarner Losh 	return (c > (sz == 12 ? 0xff7U : sz == 16 ? 0xfff7U : 0xffffff7));
972ca987d46SWarner Losh }
973ca987d46SWarner Losh 
974ca987d46SWarner Losh /*
975ca987d46SWarner Losh  * Offset-based I/O primitive
976ca987d46SWarner Losh  */
977ca987d46SWarner Losh static int
ioread(DOS_FS * fs,uint64_t offset,void * buf,size_t nbyte)978fae4b97cSToomas Soome ioread(DOS_FS *fs, uint64_t offset, void *buf, size_t nbyte)
979ca987d46SWarner Losh {
980ca987d46SWarner Losh 	char *s;
981*e7c0cb72SToomas Soome 	size_t n, secsiz;
982ca987d46SWarner Losh 	int err;
983fae4b97cSToomas Soome 	uint64_t off;
984ca987d46SWarner Losh 
985*e7c0cb72SToomas Soome 	secsiz = secbyt(fs, 1);
986ca987d46SWarner Losh 	s = buf;
987*e7c0cb72SToomas Soome 	if ((off = offset & (secsiz - 1))) {
988ca987d46SWarner Losh 		offset -= off;
989*e7c0cb72SToomas Soome 		if ((n = secsiz - off) > nbyte)
990ca987d46SWarner Losh 			n = nbyte;
991*e7c0cb72SToomas Soome 		err = ioget(fs, bytsec(fs, offset), fs->secbuf, secsiz);
9923ec0714dSToomas Soome 		if (err != 0)
993ca987d46SWarner Losh 			return (err);
994*e7c0cb72SToomas Soome 		memcpy(s, fs->secbuf + off, n);
995*e7c0cb72SToomas Soome 		offset += secsiz;
996ca987d46SWarner Losh 		s += n;
997ca987d46SWarner Losh 		nbyte -= n;
998ca987d46SWarner Losh 	}
999*e7c0cb72SToomas Soome 	n = nbyte & (secsiz - 1);
1000ca987d46SWarner Losh 	if (nbyte -= n) {
1001*e7c0cb72SToomas Soome 		if ((err = ioget(fs, bytsec(fs, offset), s, nbyte)))
1002ca987d46SWarner Losh 			return (err);
1003ca987d46SWarner Losh 		offset += nbyte;
1004ca987d46SWarner Losh 		s += nbyte;
1005ca987d46SWarner Losh 	}
10063ec0714dSToomas Soome 	if (n != 0) {
1007*e7c0cb72SToomas Soome 		err = ioget(fs, bytsec(fs, offset), fs->secbuf, secsiz);
10083ec0714dSToomas Soome 		if (err != 0)
1009ca987d46SWarner Losh 			return (err);
1010*e7c0cb72SToomas Soome 		memcpy(s, fs->secbuf, n);
1011ca987d46SWarner Losh 	}
1012ca987d46SWarner Losh 	return (0);
1013ca987d46SWarner Losh }
1014ca987d46SWarner Losh 
1015ca987d46SWarner Losh /*
1016*e7c0cb72SToomas Soome  * Sector-based I/O primitive. Note, since strategy functions are operating
1017*e7c0cb72SToomas Soome  * in terms of 512B sectors, we need to do necessary conversion here.
1018ca987d46SWarner Losh  */
1019ca987d46SWarner Losh static int
ioget(DOS_FS * fs,daddr_t lsec,void * buf,size_t size)1020*e7c0cb72SToomas Soome ioget(DOS_FS *fs, daddr_t lsec, void *buf, size_t size)
1021ca987d46SWarner Losh {
1022ca987d46SWarner Losh 	size_t rsize;
1023ca987d46SWarner Losh 	int rv;
1024*e7c0cb72SToomas Soome 	struct open_file *fd = fs->fd;
1025ca987d46SWarner Losh 
1026ca987d46SWarner Losh 	/* Make sure we get full read or error. */
1027ca987d46SWarner Losh 	rsize = 0;
1028*e7c0cb72SToomas Soome 	/* convert native sector number to 512B sector number. */
1029*e7c0cb72SToomas Soome 	lsec = secbyt(fs, lsec) >> 9;
1030ca987d46SWarner Losh 	rv = (fd->f_dev->dv_strategy)(fd->f_devdata, F_READ, lsec,
1031ca987d46SWarner Losh 	    size, buf, &rsize);
1032ca987d46SWarner Losh 	if ((rv == 0) && (size != rsize))
1033ca987d46SWarner Losh 		rv = EIO;
1034ca987d46SWarner Losh 	return (rv);
1035ca987d46SWarner Losh }
1036