1*479ab7f0SSascha Wildner /*
2*479ab7f0SSascha Wildner * Copyright (c) 1996, 1998 Robert Nordier
3*479ab7f0SSascha Wildner * All rights reserved.
4*479ab7f0SSascha Wildner *
5*479ab7f0SSascha Wildner * Redistribution and use in source and binary forms, with or without
6*479ab7f0SSascha Wildner * modification, are permitted provided that the following conditions
7*479ab7f0SSascha Wildner * are met:
8*479ab7f0SSascha Wildner * 1. Redistributions of source code must retain the above copyright
9*479ab7f0SSascha Wildner * notice, this list of conditions and the following disclaimer.
10*479ab7f0SSascha Wildner * 2. Redistributions in binary form must reproduce the above copyright
11*479ab7f0SSascha Wildner * notice, this list of conditions and the following disclaimer in
12*479ab7f0SSascha Wildner * the documentation and/or other materials provided with the
13*479ab7f0SSascha Wildner * distribution.
14*479ab7f0SSascha Wildner *
15*479ab7f0SSascha Wildner * THIS SOFTWARE IS PROVIDED BY THE AUTHOR(S) ``AS IS'' AND ANY EXPRESS
16*479ab7f0SSascha Wildner * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
17*479ab7f0SSascha Wildner * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18*479ab7f0SSascha Wildner * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR(S) BE LIABLE FOR ANY
19*479ab7f0SSascha Wildner * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20*479ab7f0SSascha Wildner * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
21*479ab7f0SSascha Wildner * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
22*479ab7f0SSascha Wildner * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
23*479ab7f0SSascha Wildner * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
24*479ab7f0SSascha Wildner * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
25*479ab7f0SSascha Wildner * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26*479ab7f0SSascha Wildner *
27*479ab7f0SSascha Wildner * $FreeBSD: src/lib/libstand/dosfs.c,v 1.4.2.1 2000/05/04 13:47:49 ps Exp $
28*479ab7f0SSascha Wildner * $DragonFly: src/lib/libstand/dosfs.c,v 1.2 2003/06/17 04:26:51 dillon Exp $
29*479ab7f0SSascha Wildner */
30*479ab7f0SSascha Wildner
31*479ab7f0SSascha Wildner /*
32*479ab7f0SSascha Wildner * Readonly filesystem for Microsoft FAT12/FAT16/FAT32 filesystems,
33*479ab7f0SSascha Wildner * also supports VFAT.
34*479ab7f0SSascha Wildner */
35*479ab7f0SSascha Wildner
36*479ab7f0SSascha Wildner #include <sys/types.h>
37*479ab7f0SSascha Wildner #include <string.h>
38*479ab7f0SSascha Wildner #include <stddef.h>
39*479ab7f0SSascha Wildner
40*479ab7f0SSascha Wildner #include "stand.h"
41*479ab7f0SSascha Wildner
42*479ab7f0SSascha Wildner #include "dosfs.h"
43*479ab7f0SSascha Wildner
44*479ab7f0SSascha Wildner
45*479ab7f0SSascha Wildner static int dos_open(const char *path, struct open_file *fd);
46*479ab7f0SSascha Wildner static int dos_close(struct open_file *fd);
47*479ab7f0SSascha Wildner static int dos_read(struct open_file *fd, void *buf, size_t size, size_t *resid);
48*479ab7f0SSascha Wildner static off_t dos_seek(struct open_file *fd, off_t offset, int whence);
49*479ab7f0SSascha Wildner static int dos_stat(struct open_file *fd, struct stat *sb);
50*479ab7f0SSascha Wildner static int dos_readdir(struct open_file *fd, struct dirent *d);
51*479ab7f0SSascha Wildner
52*479ab7f0SSascha Wildner struct fs_ops dosfs_fsops = {
53*479ab7f0SSascha Wildner "dosfs",
54*479ab7f0SSascha Wildner dos_open,
55*479ab7f0SSascha Wildner dos_close,
56*479ab7f0SSascha Wildner dos_read,
57*479ab7f0SSascha Wildner null_write,
58*479ab7f0SSascha Wildner dos_seek,
59*479ab7f0SSascha Wildner dos_stat,
60*479ab7f0SSascha Wildner dos_readdir
61*479ab7f0SSascha Wildner };
62*479ab7f0SSascha Wildner
63*479ab7f0SSascha Wildner #define SECSIZ 512 /* sector size */
64*479ab7f0SSascha Wildner #define SSHIFT 9 /* SECSIZ shift */
65*479ab7f0SSascha Wildner #define DEPSEC 16 /* directory entries per sector */
66*479ab7f0SSascha Wildner #define DSHIFT 4 /* DEPSEC shift */
67*479ab7f0SSascha Wildner #define LOCLUS 2 /* lowest cluster number */
68*479ab7f0SSascha Wildner
69*479ab7f0SSascha Wildner /* DOS "BIOS Parameter Block" */
70*479ab7f0SSascha Wildner typedef struct {
71*479ab7f0SSascha Wildner u_char secsiz[2]; /* sector size */
72*479ab7f0SSascha Wildner u_char spc; /* sectors per cluster */
73*479ab7f0SSascha Wildner u_char ressec[2]; /* reserved sectors */
74*479ab7f0SSascha Wildner u_char fats; /* FATs */
75*479ab7f0SSascha Wildner u_char dirents[2]; /* root directory entries */
76*479ab7f0SSascha Wildner u_char secs[2]; /* total sectors */
77*479ab7f0SSascha Wildner u_char media; /* media descriptor */
78*479ab7f0SSascha Wildner u_char spf[2]; /* sectors per FAT */
79*479ab7f0SSascha Wildner u_char spt[2]; /* sectors per track */
80*479ab7f0SSascha Wildner u_char heads[2]; /* drive heads */
81*479ab7f0SSascha Wildner u_char hidsec[4]; /* hidden sectors */
82*479ab7f0SSascha Wildner u_char lsecs[4]; /* huge sectors */
83*479ab7f0SSascha Wildner u_char lspf[4]; /* huge sectors per FAT */
84*479ab7f0SSascha Wildner u_char xflg[2]; /* flags */
85*479ab7f0SSascha Wildner u_char vers[2]; /* filesystem version */
86*479ab7f0SSascha Wildner u_char rdcl[4]; /* root directory start cluster */
87*479ab7f0SSascha Wildner u_char infs[2]; /* filesystem info sector */
88*479ab7f0SSascha Wildner u_char bkbs[2]; /* backup boot sector */
89*479ab7f0SSascha Wildner } DOS_BPB;
90*479ab7f0SSascha Wildner
91*479ab7f0SSascha Wildner /* Initial portion of DOS boot sector */
92*479ab7f0SSascha Wildner typedef struct {
93*479ab7f0SSascha Wildner u_char jmp[3]; /* usually 80x86 'jmp' opcode */
94*479ab7f0SSascha Wildner u_char oem[8]; /* OEM name and version */
95*479ab7f0SSascha Wildner DOS_BPB bpb; /* BPB */
96*479ab7f0SSascha Wildner } DOS_BS;
97*479ab7f0SSascha Wildner
98*479ab7f0SSascha Wildner /* Supply missing "." and ".." root directory entries */
99*479ab7f0SSascha Wildner static const char *const dotstr[2] = {".", ".."};
100*479ab7f0SSascha Wildner static DOS_DE dot[2] = {
101*479ab7f0SSascha Wildner {". ", " ", FA_DIR, {0, 0, {0, 0}, {0, 0}, {0, 0}, {0, 0}},
102*479ab7f0SSascha Wildner {0, 0}, {0x21, 0}, {0, 0}, {0, 0, 0, 0}},
103*479ab7f0SSascha Wildner {".. ", " ", FA_DIR, {0, 0, {0, 0}, {0, 0}, {0, 0}, {0, 0}},
104*479ab7f0SSascha Wildner {0, 0}, {0x21, 0}, {0, 0}, {0, 0, 0, 0}}
105*479ab7f0SSascha Wildner };
106*479ab7f0SSascha Wildner
107*479ab7f0SSascha Wildner /* The usual conversion macros to avoid multiplication and division */
108*479ab7f0SSascha Wildner #define bytsec(n) ((n) >> SSHIFT)
109*479ab7f0SSascha Wildner #define secbyt(s) ((s) << SSHIFT)
110*479ab7f0SSascha Wildner #define entsec(e) ((e) >> DSHIFT)
111*479ab7f0SSascha Wildner #define bytblk(fs, n) ((n) >> (fs)->bshift)
112*479ab7f0SSascha Wildner #define blkbyt(fs, b) ((b) << (fs)->bshift)
113*479ab7f0SSascha Wildner #define secblk(fs, s) ((s) >> ((fs)->bshift - SSHIFT))
114*479ab7f0SSascha Wildner #define blksec(fs, b) ((b) << ((fs)->bshift - SSHIFT))
115*479ab7f0SSascha Wildner
116*479ab7f0SSascha Wildner /* Convert cluster number to offset within filesystem */
117*479ab7f0SSascha Wildner #define blkoff(fs, b) (secbyt((fs)->lsndta) + blkbyt(fs, (b) - LOCLUS))
118*479ab7f0SSascha Wildner
119*479ab7f0SSascha Wildner /* Convert cluster number to logical sector number */
120*479ab7f0SSascha Wildner #define blklsn(fs, b) ((fs)->lsndta + blksec(fs, (b) - LOCLUS))
121*479ab7f0SSascha Wildner
122*479ab7f0SSascha Wildner /* Convert cluster number to offset within FAT */
123*479ab7f0SSascha Wildner #define fatoff(sz, c) ((sz) == 12 ? (c) + ((c) >> 1) : \
124*479ab7f0SSascha Wildner (sz) == 16 ? (c) << 1 : \
125*479ab7f0SSascha Wildner (c) << 2)
126*479ab7f0SSascha Wildner
127*479ab7f0SSascha Wildner /* Does cluster number reference a valid data cluster? */
128*479ab7f0SSascha Wildner #define okclus(fs, c) ((c) >= LOCLUS && (c) <= (fs)->xclus)
129*479ab7f0SSascha Wildner
130*479ab7f0SSascha Wildner /* Get start cluster from directory entry */
131*479ab7f0SSascha Wildner #define stclus(sz, de) ((sz) != 32 ? cv2((de)->clus) : \
132*479ab7f0SSascha Wildner ((u_int)cv2((de)->dex.h_clus) << 16) | \
133*479ab7f0SSascha Wildner cv2((de)->clus))
134*479ab7f0SSascha Wildner
135*479ab7f0SSascha Wildner static int dosunmount(DOS_FS *);
136*479ab7f0SSascha Wildner static int parsebs(DOS_FS *, DOS_BS *);
137*479ab7f0SSascha Wildner static int namede(DOS_FS *, const char *, DOS_DE **);
138*479ab7f0SSascha Wildner static int lookup(DOS_FS *, u_int, const char *, DOS_DE **);
139*479ab7f0SSascha Wildner static void cp_xdnm(u_char *, DOS_XDE *);
140*479ab7f0SSascha Wildner static void cp_sfn(u_char *, DOS_DE *);
141*479ab7f0SSascha Wildner static off_t fsize(DOS_FS *, DOS_DE *);
142*479ab7f0SSascha Wildner static int fatcnt(DOS_FS *, u_int);
143*479ab7f0SSascha Wildner static int fatget(DOS_FS *, u_int *);
144*479ab7f0SSascha Wildner static int fatend(u_int, u_int);
145*479ab7f0SSascha Wildner static int ioread(DOS_FS *, u_int, void *, u_int);
146*479ab7f0SSascha Wildner static int iobuf(DOS_FS *, u_int);
147*479ab7f0SSascha Wildner static int ioget(struct open_file *, u_int, void *, u_int);
148*479ab7f0SSascha Wildner
149*479ab7f0SSascha Wildner /*
150*479ab7f0SSascha Wildner * Mount DOS filesystem
151*479ab7f0SSascha Wildner */
152*479ab7f0SSascha Wildner static int
dos_mount(DOS_FS * fs,struct open_file * fd)153*479ab7f0SSascha Wildner dos_mount(DOS_FS *fs, struct open_file *fd)
154*479ab7f0SSascha Wildner {
155*479ab7f0SSascha Wildner int err;
156*479ab7f0SSascha Wildner
157*479ab7f0SSascha Wildner bzero(fs, sizeof(DOS_FS));
158*479ab7f0SSascha Wildner fs->fd = fd;
159*479ab7f0SSascha Wildner if ((err = !(fs->buf = malloc(SECSIZ)) ? errno : 0) ||
160*479ab7f0SSascha Wildner (err = ioget(fs->fd, 0, fs->buf, 1)) ||
161*479ab7f0SSascha Wildner (err = parsebs(fs, (DOS_BS *)fs->buf))) {
162*479ab7f0SSascha Wildner (void)dosunmount(fs);
163*479ab7f0SSascha Wildner return(err);
164*479ab7f0SSascha Wildner }
165*479ab7f0SSascha Wildner fs->root = dot[0];
166*479ab7f0SSascha Wildner fs->root.name[0] = ' ';
167*479ab7f0SSascha Wildner if (fs->fatsz == 32) {
168*479ab7f0SSascha Wildner fs->root.clus[0] = fs->rdcl & 0xff;
169*479ab7f0SSascha Wildner fs->root.clus[1] = (fs->rdcl >> 8) & 0xff;
170*479ab7f0SSascha Wildner fs->root.dex.h_clus[0] = (fs->rdcl >> 16) & 0xff;
171*479ab7f0SSascha Wildner fs->root.dex.h_clus[1] = (fs->rdcl >> 24) & 0xff;
172*479ab7f0SSascha Wildner }
173*479ab7f0SSascha Wildner return 0;
174*479ab7f0SSascha Wildner }
175*479ab7f0SSascha Wildner
176*479ab7f0SSascha Wildner /*
177*479ab7f0SSascha Wildner * Unmount mounted filesystem
178*479ab7f0SSascha Wildner */
179*479ab7f0SSascha Wildner static int
dos_unmount(DOS_FS * fs)180*479ab7f0SSascha Wildner dos_unmount(DOS_FS *fs)
181*479ab7f0SSascha Wildner {
182*479ab7f0SSascha Wildner int err;
183*479ab7f0SSascha Wildner
184*479ab7f0SSascha Wildner if (fs->links)
185*479ab7f0SSascha Wildner return(EBUSY);
186*479ab7f0SSascha Wildner if ((err = dosunmount(fs)))
187*479ab7f0SSascha Wildner return(err);
188*479ab7f0SSascha Wildner return 0;
189*479ab7f0SSascha Wildner }
190*479ab7f0SSascha Wildner
191*479ab7f0SSascha Wildner /*
192*479ab7f0SSascha Wildner * Common code shared by dos_mount() and dos_unmount()
193*479ab7f0SSascha Wildner */
194*479ab7f0SSascha Wildner static int
dosunmount(DOS_FS * fs)195*479ab7f0SSascha Wildner dosunmount(DOS_FS *fs)
196*479ab7f0SSascha Wildner {
197*479ab7f0SSascha Wildner if (fs->buf)
198*479ab7f0SSascha Wildner free(fs->buf);
199*479ab7f0SSascha Wildner free(fs);
200*479ab7f0SSascha Wildner return(0);
201*479ab7f0SSascha Wildner }
202*479ab7f0SSascha Wildner
203*479ab7f0SSascha Wildner /*
204*479ab7f0SSascha Wildner * Open DOS file
205*479ab7f0SSascha Wildner */
206*479ab7f0SSascha Wildner static int
dos_open(const char * path,struct open_file * fd)207*479ab7f0SSascha Wildner dos_open(const char *path, struct open_file *fd)
208*479ab7f0SSascha Wildner {
209*479ab7f0SSascha Wildner DOS_DE *de;
210*479ab7f0SSascha Wildner DOS_FILE *f;
211*479ab7f0SSascha Wildner DOS_FS *fs;
212*479ab7f0SSascha Wildner u_int size, clus;
213*479ab7f0SSascha Wildner int err = 0;
214*479ab7f0SSascha Wildner
215*479ab7f0SSascha Wildner /* Allocate mount structure, associate with open */
216*479ab7f0SSascha Wildner fs = malloc(sizeof(DOS_FS));
217*479ab7f0SSascha Wildner
218*479ab7f0SSascha Wildner if ((err = dos_mount(fs, fd)))
219*479ab7f0SSascha Wildner goto out;
220*479ab7f0SSascha Wildner
221*479ab7f0SSascha Wildner if ((err = namede(fs, path, &de)))
222*479ab7f0SSascha Wildner goto out;
223*479ab7f0SSascha Wildner
224*479ab7f0SSascha Wildner clus = stclus(fs->fatsz, de);
225*479ab7f0SSascha Wildner size = cv4(de->size);
226*479ab7f0SSascha Wildner
227*479ab7f0SSascha Wildner if ((!(de->attr & FA_DIR) && (!clus != !size)) ||
228*479ab7f0SSascha Wildner ((de->attr & FA_DIR) && size) ||
229*479ab7f0SSascha Wildner (clus && !okclus(fs, clus))) {
230*479ab7f0SSascha Wildner err = EINVAL;
231*479ab7f0SSascha Wildner goto out;
232*479ab7f0SSascha Wildner }
233*479ab7f0SSascha Wildner f = malloc(sizeof(DOS_FILE));
234*479ab7f0SSascha Wildner bzero(f, sizeof(DOS_FILE));
235*479ab7f0SSascha Wildner f->fs = fs;
236*479ab7f0SSascha Wildner fs->links++;
237*479ab7f0SSascha Wildner f->de = *de;
238*479ab7f0SSascha Wildner fd->f_fsdata = (void *)f;
239*479ab7f0SSascha Wildner
240*479ab7f0SSascha Wildner out:
241*479ab7f0SSascha Wildner return(err);
242*479ab7f0SSascha Wildner }
243*479ab7f0SSascha Wildner
244*479ab7f0SSascha Wildner /*
245*479ab7f0SSascha Wildner * Read from file
246*479ab7f0SSascha Wildner */
247*479ab7f0SSascha Wildner static int
dos_read(struct open_file * fd,void * buf,size_t nbyte,size_t * resid)248*479ab7f0SSascha Wildner dos_read(struct open_file *fd, void *buf, size_t nbyte, size_t *resid)
249*479ab7f0SSascha Wildner {
250*479ab7f0SSascha Wildner off_t size;
251*479ab7f0SSascha Wildner u_int nb, off, clus, c, cnt, n;
252*479ab7f0SSascha Wildner DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
253*479ab7f0SSascha Wildner int err = 0;
254*479ab7f0SSascha Wildner
255*479ab7f0SSascha Wildner nb = (u_int)nbyte;
256*479ab7f0SSascha Wildner if ((size = fsize(f->fs, &f->de)) == -1)
257*479ab7f0SSascha Wildner return EINVAL;
258*479ab7f0SSascha Wildner if (nb > (n = size - f->offset))
259*479ab7f0SSascha Wildner nb = n;
260*479ab7f0SSascha Wildner off = f->offset;
261*479ab7f0SSascha Wildner if ((clus = stclus(f->fs->fatsz, &f->de)))
262*479ab7f0SSascha Wildner off &= f->fs->bsize - 1;
263*479ab7f0SSascha Wildner c = f->c;
264*479ab7f0SSascha Wildner cnt = nb;
265*479ab7f0SSascha Wildner while (cnt) {
266*479ab7f0SSascha Wildner n = 0;
267*479ab7f0SSascha Wildner if (!c) {
268*479ab7f0SSascha Wildner if ((c = clus))
269*479ab7f0SSascha Wildner n = bytblk(f->fs, f->offset);
270*479ab7f0SSascha Wildner } else if (!off)
271*479ab7f0SSascha Wildner n++;
272*479ab7f0SSascha Wildner while (n--) {
273*479ab7f0SSascha Wildner if ((err = fatget(f->fs, &c)))
274*479ab7f0SSascha Wildner goto out;
275*479ab7f0SSascha Wildner if (!okclus(f->fs, c)) {
276*479ab7f0SSascha Wildner err = EINVAL;
277*479ab7f0SSascha Wildner goto out;
278*479ab7f0SSascha Wildner }
279*479ab7f0SSascha Wildner }
280*479ab7f0SSascha Wildner if (!clus || (n = f->fs->bsize - off) > cnt)
281*479ab7f0SSascha Wildner n = cnt;
282*479ab7f0SSascha Wildner if ((err = ioread(f->fs, (c ? blkoff(f->fs, c) :
283*479ab7f0SSascha Wildner secbyt(f->fs->lsndir)) + off,
284*479ab7f0SSascha Wildner buf, n)))
285*479ab7f0SSascha Wildner goto out;
286*479ab7f0SSascha Wildner f->offset += n;
287*479ab7f0SSascha Wildner f->c = c;
288*479ab7f0SSascha Wildner off = 0;
289*479ab7f0SSascha Wildner buf += n;
290*479ab7f0SSascha Wildner cnt -= n;
291*479ab7f0SSascha Wildner }
292*479ab7f0SSascha Wildner out:
293*479ab7f0SSascha Wildner if (resid)
294*479ab7f0SSascha Wildner *resid = nbyte - nb + cnt;
295*479ab7f0SSascha Wildner return(err);
296*479ab7f0SSascha Wildner }
297*479ab7f0SSascha Wildner
298*479ab7f0SSascha Wildner /*
299*479ab7f0SSascha Wildner * Reposition within file
300*479ab7f0SSascha Wildner */
301*479ab7f0SSascha Wildner static off_t
dos_seek(struct open_file * fd,off_t offset,int whence)302*479ab7f0SSascha Wildner dos_seek(struct open_file *fd, off_t offset, int whence)
303*479ab7f0SSascha Wildner {
304*479ab7f0SSascha Wildner off_t off;
305*479ab7f0SSascha Wildner u_int size;
306*479ab7f0SSascha Wildner DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
307*479ab7f0SSascha Wildner
308*479ab7f0SSascha Wildner size = cv4(f->de.size);
309*479ab7f0SSascha Wildner switch (whence) {
310*479ab7f0SSascha Wildner case SEEK_SET:
311*479ab7f0SSascha Wildner off = 0;
312*479ab7f0SSascha Wildner break;
313*479ab7f0SSascha Wildner case SEEK_CUR:
314*479ab7f0SSascha Wildner off = f->offset;
315*479ab7f0SSascha Wildner break;
316*479ab7f0SSascha Wildner case SEEK_END:
317*479ab7f0SSascha Wildner off = size;
318*479ab7f0SSascha Wildner break;
319*479ab7f0SSascha Wildner default:
320*479ab7f0SSascha Wildner return(-1);
321*479ab7f0SSascha Wildner }
322*479ab7f0SSascha Wildner off += offset;
323*479ab7f0SSascha Wildner if (off < 0 || off > size)
324*479ab7f0SSascha Wildner return(-1);
325*479ab7f0SSascha Wildner f->offset = (u_int)off;
326*479ab7f0SSascha Wildner f->c = 0;
327*479ab7f0SSascha Wildner return(off);
328*479ab7f0SSascha Wildner }
329*479ab7f0SSascha Wildner
330*479ab7f0SSascha Wildner /*
331*479ab7f0SSascha Wildner * Close open file
332*479ab7f0SSascha Wildner */
333*479ab7f0SSascha Wildner static int
dos_close(struct open_file * fd)334*479ab7f0SSascha Wildner dos_close(struct open_file *fd)
335*479ab7f0SSascha Wildner {
336*479ab7f0SSascha Wildner DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
337*479ab7f0SSascha Wildner DOS_FS *fs;
338*479ab7f0SSascha Wildner
339*479ab7f0SSascha Wildner fd->f_fsdata = NULL;
340*479ab7f0SSascha Wildner if (f) {
341*479ab7f0SSascha Wildner fs = f->fs;
342*479ab7f0SSascha Wildner f->fs = NULL;
343*479ab7f0SSascha Wildner fs->links--;
344*479ab7f0SSascha Wildner free(f);
345*479ab7f0SSascha Wildner dos_unmount(fs);
346*479ab7f0SSascha Wildner }
347*479ab7f0SSascha Wildner return 0;
348*479ab7f0SSascha Wildner }
349*479ab7f0SSascha Wildner
350*479ab7f0SSascha Wildner /*
351*479ab7f0SSascha Wildner * Return some stat information on a file.
352*479ab7f0SSascha Wildner */
353*479ab7f0SSascha Wildner static int
dos_stat(struct open_file * fd,struct stat * sb)354*479ab7f0SSascha Wildner dos_stat(struct open_file *fd, struct stat *sb)
355*479ab7f0SSascha Wildner {
356*479ab7f0SSascha Wildner DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
357*479ab7f0SSascha Wildner
358*479ab7f0SSascha Wildner /* only important stuff */
359*479ab7f0SSascha Wildner sb->st_mode = f->de.attr & FA_DIR ? S_IFDIR | 0555 : S_IFREG | 0444;
360*479ab7f0SSascha Wildner sb->st_nlink = 1;
361*479ab7f0SSascha Wildner sb->st_uid = 0;
362*479ab7f0SSascha Wildner sb->st_gid = 0;
363*479ab7f0SSascha Wildner if ((sb->st_size = fsize(f->fs, &f->de)) == -1)
364*479ab7f0SSascha Wildner return EINVAL;
365*479ab7f0SSascha Wildner return (0);
366*479ab7f0SSascha Wildner }
367*479ab7f0SSascha Wildner
368*479ab7f0SSascha Wildner static int
dos_readdir(struct open_file * fd,struct dirent * d)369*479ab7f0SSascha Wildner dos_readdir(struct open_file *fd, struct dirent *d)
370*479ab7f0SSascha Wildner {
371*479ab7f0SSascha Wildner /* DOS_FILE *f = (DOS_FILE *)fd->f_fsdata; */
372*479ab7f0SSascha Wildner u_char fn[261];
373*479ab7f0SSascha Wildner DOS_DIR dd;
374*479ab7f0SSascha Wildner size_t res;
375*479ab7f0SSascha Wildner u_int chk, i, x, xdn;
376*479ab7f0SSascha Wildner int err;
377*479ab7f0SSascha Wildner
378*479ab7f0SSascha Wildner x = chk = 0;
379*479ab7f0SSascha Wildner while (1) {
380*479ab7f0SSascha Wildner xdn = x;
381*479ab7f0SSascha Wildner x = 0;
382*479ab7f0SSascha Wildner err = dos_read(fd, &dd, sizeof(dd), &res);
383*479ab7f0SSascha Wildner if (err)
384*479ab7f0SSascha Wildner return (err);
385*479ab7f0SSascha Wildner if (res == sizeof(dd))
386*479ab7f0SSascha Wildner return (ENOENT);
387*479ab7f0SSascha Wildner if (dd.de.name[0] == 0)
388*479ab7f0SSascha Wildner return (ENOENT);
389*479ab7f0SSascha Wildner
390*479ab7f0SSascha Wildner /* Skip deleted entries */
391*479ab7f0SSascha Wildner if (dd.de.name[0] == 0xe5)
392*479ab7f0SSascha Wildner continue;
393*479ab7f0SSascha Wildner
394*479ab7f0SSascha Wildner /* Check if directory entry is volume label */
395*479ab7f0SSascha Wildner if (dd.de.attr & FA_LABEL) {
396*479ab7f0SSascha Wildner /*
397*479ab7f0SSascha Wildner * If volume label set, check if the current entry is
398*479ab7f0SSascha Wildner * extended entry (FA_XDE) for long file names.
399*479ab7f0SSascha Wildner */
400*479ab7f0SSascha Wildner if ((dd.de.attr & FA_MASK) == FA_XDE) {
401*479ab7f0SSascha Wildner /*
402*479ab7f0SSascha Wildner * Read through all following extended entries
403*479ab7f0SSascha Wildner * to get the long file name. 0x40 marks the
404*479ab7f0SSascha Wildner * last entry containing part of long file name.
405*479ab7f0SSascha Wildner */
406*479ab7f0SSascha Wildner if (dd.xde.seq & 0x40)
407*479ab7f0SSascha Wildner chk = dd.xde.chk;
408*479ab7f0SSascha Wildner else if (dd.xde.seq != xdn - 1 || dd.xde.chk != chk)
409*479ab7f0SSascha Wildner continue;
410*479ab7f0SSascha Wildner x = dd.xde.seq & ~0x40;
411*479ab7f0SSascha Wildner if (x < 1 || x > 20) {
412*479ab7f0SSascha Wildner x = 0;
413*479ab7f0SSascha Wildner continue;
414*479ab7f0SSascha Wildner }
415*479ab7f0SSascha Wildner cp_xdnm(fn, &dd.xde);
416*479ab7f0SSascha Wildner } else {
417*479ab7f0SSascha Wildner /* skip only volume label entries */
418*479ab7f0SSascha Wildner continue;
419*479ab7f0SSascha Wildner }
420*479ab7f0SSascha Wildner } else {
421*479ab7f0SSascha Wildner if (xdn == 1) {
422*479ab7f0SSascha Wildner x = 0;
423*479ab7f0SSascha Wildner for (i = 0; i < 11; i++) {
424*479ab7f0SSascha Wildner x = ((x & 1) << 7) | (x >> 1);
425*479ab7f0SSascha Wildner x += (i < 8) ? dd.de.name[i] : dd.de.ext[i-8];
426*479ab7f0SSascha Wildner x &= 0xff;
427*479ab7f0SSascha Wildner }
428*479ab7f0SSascha Wildner if (x == chk)
429*479ab7f0SSascha Wildner break;
430*479ab7f0SSascha Wildner } else {
431*479ab7f0SSascha Wildner cp_sfn(fn, &dd.de);
432*479ab7f0SSascha Wildner break;
433*479ab7f0SSascha Wildner }
434*479ab7f0SSascha Wildner x = 0;
435*479ab7f0SSascha Wildner }
436*479ab7f0SSascha Wildner }
437*479ab7f0SSascha Wildner
438*479ab7f0SSascha Wildner d->d_fileno = (dd.de.clus[1] << 8) + dd.de.clus[0];
439*479ab7f0SSascha Wildner d->d_type = (dd.de.attr & FA_DIR) ? DT_DIR : DT_REG;
440*479ab7f0SSascha Wildner memcpy(d->d_name, fn, sizeof(d->d_name));
441*479ab7f0SSascha Wildner return(0);
442*479ab7f0SSascha Wildner }
443*479ab7f0SSascha Wildner
444*479ab7f0SSascha Wildner /*
445*479ab7f0SSascha Wildner * Parse DOS boot sector
446*479ab7f0SSascha Wildner */
447*479ab7f0SSascha Wildner static int
parsebs(DOS_FS * fs,DOS_BS * bs)448*479ab7f0SSascha Wildner parsebs(DOS_FS *fs, DOS_BS *bs)
449*479ab7f0SSascha Wildner {
450*479ab7f0SSascha Wildner u_int sc;
451*479ab7f0SSascha Wildner
452*479ab7f0SSascha Wildner if ((bs->jmp[0] != 0x69 &&
453*479ab7f0SSascha Wildner bs->jmp[0] != 0xe9 &&
454*479ab7f0SSascha Wildner (bs->jmp[0] != 0xeb || bs->jmp[2] != 0x90)) ||
455*479ab7f0SSascha Wildner bs->bpb.media < 0xf0)
456*479ab7f0SSascha Wildner return EINVAL;
457*479ab7f0SSascha Wildner if (cv2(bs->bpb.secsiz) != SECSIZ)
458*479ab7f0SSascha Wildner return EINVAL;
459*479ab7f0SSascha Wildner if (!(fs->spc = bs->bpb.spc) || fs->spc & (fs->spc - 1))
460*479ab7f0SSascha Wildner return EINVAL;
461*479ab7f0SSascha Wildner fs->bsize = secbyt(fs->spc);
462*479ab7f0SSascha Wildner fs->bshift = ffs(fs->bsize) - 1;
463*479ab7f0SSascha Wildner if ((fs->spf = cv2(bs->bpb.spf))) {
464*479ab7f0SSascha Wildner if (bs->bpb.fats != 2)
465*479ab7f0SSascha Wildner return EINVAL;
466*479ab7f0SSascha Wildner if (!(fs->dirents = cv2(bs->bpb.dirents)))
467*479ab7f0SSascha Wildner return EINVAL;
468*479ab7f0SSascha Wildner } else {
469*479ab7f0SSascha Wildner if (!(fs->spf = cv4(bs->bpb.lspf)))
470*479ab7f0SSascha Wildner return EINVAL;
471*479ab7f0SSascha Wildner if (!bs->bpb.fats || bs->bpb.fats > 16)
472*479ab7f0SSascha Wildner return EINVAL;
473*479ab7f0SSascha Wildner if ((fs->rdcl = cv4(bs->bpb.rdcl)) < LOCLUS)
474*479ab7f0SSascha Wildner return EINVAL;
475*479ab7f0SSascha Wildner }
476*479ab7f0SSascha Wildner if (!(fs->lsnfat = cv2(bs->bpb.ressec)))
477*479ab7f0SSascha Wildner return EINVAL;
478*479ab7f0SSascha Wildner fs->lsndir = fs->lsnfat + fs->spf * bs->bpb.fats;
479*479ab7f0SSascha Wildner fs->lsndta = fs->lsndir + entsec(fs->dirents);
480*479ab7f0SSascha Wildner if (!(sc = cv2(bs->bpb.secs)) && !(sc = cv4(bs->bpb.lsecs)))
481*479ab7f0SSascha Wildner return EINVAL;
482*479ab7f0SSascha Wildner if (fs->lsndta > sc)
483*479ab7f0SSascha Wildner return EINVAL;
484*479ab7f0SSascha Wildner if ((fs->xclus = secblk(fs, sc - fs->lsndta) + 1) < LOCLUS)
485*479ab7f0SSascha Wildner return EINVAL;
486*479ab7f0SSascha Wildner fs->fatsz = fs->dirents ? fs->xclus < 0xff6 ? 12 : 16 : 32;
487*479ab7f0SSascha Wildner sc = (secbyt(fs->spf) << 1) / (fs->fatsz >> 2) - 1;
488*479ab7f0SSascha Wildner if (fs->xclus > sc)
489*479ab7f0SSascha Wildner fs->xclus = sc;
490*479ab7f0SSascha Wildner return 0;
491*479ab7f0SSascha Wildner }
492*479ab7f0SSascha Wildner
493*479ab7f0SSascha Wildner /*
494*479ab7f0SSascha Wildner * Return directory entry from path
495*479ab7f0SSascha Wildner */
496*479ab7f0SSascha Wildner static int
namede(DOS_FS * fs,const char * path,DOS_DE ** dep)497*479ab7f0SSascha Wildner namede(DOS_FS *fs, const char *path, DOS_DE **dep)
498*479ab7f0SSascha Wildner {
499*479ab7f0SSascha Wildner char name[256];
500*479ab7f0SSascha Wildner DOS_DE *de;
501*479ab7f0SSascha Wildner char *s;
502*479ab7f0SSascha Wildner size_t n;
503*479ab7f0SSascha Wildner int err;
504*479ab7f0SSascha Wildner
505*479ab7f0SSascha Wildner err = 0;
506*479ab7f0SSascha Wildner de = &fs->root;
507*479ab7f0SSascha Wildner while (*path) {
508*479ab7f0SSascha Wildner while (*path == '/')
509*479ab7f0SSascha Wildner path++;
510*479ab7f0SSascha Wildner if (*path == '\0')
511*479ab7f0SSascha Wildner break;
512*479ab7f0SSascha Wildner if (!(s = strchr(path, '/')))
513*479ab7f0SSascha Wildner s = strchr(path, 0);
514*479ab7f0SSascha Wildner if ((n = s - path) > 255)
515*479ab7f0SSascha Wildner return ENAMETOOLONG;
516*479ab7f0SSascha Wildner memcpy(name, path, n);
517*479ab7f0SSascha Wildner name[n] = 0;
518*479ab7f0SSascha Wildner path = s;
519*479ab7f0SSascha Wildner if (!(de->attr & FA_DIR))
520*479ab7f0SSascha Wildner return ENOTDIR;
521*479ab7f0SSascha Wildner if ((err = lookup(fs, stclus(fs->fatsz, de), name, &de)))
522*479ab7f0SSascha Wildner return err;
523*479ab7f0SSascha Wildner }
524*479ab7f0SSascha Wildner *dep = de;
525*479ab7f0SSascha Wildner return 0;
526*479ab7f0SSascha Wildner }
527*479ab7f0SSascha Wildner
528*479ab7f0SSascha Wildner /*
529*479ab7f0SSascha Wildner * Lookup path segment
530*479ab7f0SSascha Wildner */
531*479ab7f0SSascha Wildner static int
lookup(DOS_FS * fs,u_int clus,const char * name,DOS_DE ** dep)532*479ab7f0SSascha Wildner lookup(DOS_FS *fs, u_int clus, const char *name, DOS_DE **dep)
533*479ab7f0SSascha Wildner {
534*479ab7f0SSascha Wildner static DOS_DIR dir[DEPSEC];
535*479ab7f0SSascha Wildner u_char lfn[261];
536*479ab7f0SSascha Wildner u_char sfn[13];
537*479ab7f0SSascha Wildner u_int nsec, lsec, xdn, chk, sec, ent, x;
538*479ab7f0SSascha Wildner int err, ok, i;
539*479ab7f0SSascha Wildner
540*479ab7f0SSascha Wildner if (!clus)
541*479ab7f0SSascha Wildner for (ent = 0; ent < 2; ent++)
542*479ab7f0SSascha Wildner if (!strcasecmp(name, dotstr[ent])) {
543*479ab7f0SSascha Wildner *dep = dot + ent;
544*479ab7f0SSascha Wildner return 0;
545*479ab7f0SSascha Wildner }
546*479ab7f0SSascha Wildner if (!clus && fs->fatsz == 32)
547*479ab7f0SSascha Wildner clus = fs->rdcl;
548*479ab7f0SSascha Wildner nsec = !clus ? entsec(fs->dirents) : fs->spc;
549*479ab7f0SSascha Wildner lsec = 0;
550*479ab7f0SSascha Wildner xdn = chk = 0;
551*479ab7f0SSascha Wildner for (;;) {
552*479ab7f0SSascha Wildner if (!clus && !lsec)
553*479ab7f0SSascha Wildner lsec = fs->lsndir;
554*479ab7f0SSascha Wildner else if (okclus(fs, clus))
555*479ab7f0SSascha Wildner lsec = blklsn(fs, clus);
556*479ab7f0SSascha Wildner else
557*479ab7f0SSascha Wildner return EINVAL;
558*479ab7f0SSascha Wildner for (sec = 0; sec < nsec; sec++) {
559*479ab7f0SSascha Wildner if ((err = ioget(fs->fd, lsec + sec, dir, 1)))
560*479ab7f0SSascha Wildner return err;
561*479ab7f0SSascha Wildner for (ent = 0; ent < DEPSEC; ent++) {
562*479ab7f0SSascha Wildner if (!*dir[ent].de.name)
563*479ab7f0SSascha Wildner return ENOENT;
564*479ab7f0SSascha Wildner if (*dir[ent].de.name != 0xe5) {
565*479ab7f0SSascha Wildner if ((dir[ent].de.attr & FA_MASK) == FA_XDE) {
566*479ab7f0SSascha Wildner x = dir[ent].xde.seq;
567*479ab7f0SSascha Wildner if (x & 0x40 || (x + 1 == xdn &&
568*479ab7f0SSascha Wildner dir[ent].xde.chk == chk)) {
569*479ab7f0SSascha Wildner if (x & 0x40) {
570*479ab7f0SSascha Wildner chk = dir[ent].xde.chk;
571*479ab7f0SSascha Wildner x &= ~0x40;
572*479ab7f0SSascha Wildner }
573*479ab7f0SSascha Wildner if (x >= 1 && x <= 20) {
574*479ab7f0SSascha Wildner cp_xdnm(lfn, &dir[ent].xde);
575*479ab7f0SSascha Wildner xdn = x;
576*479ab7f0SSascha Wildner continue;
577*479ab7f0SSascha Wildner }
578*479ab7f0SSascha Wildner }
579*479ab7f0SSascha Wildner } else if (!(dir[ent].de.attr & FA_LABEL)) {
580*479ab7f0SSascha Wildner if ((ok = xdn == 1)) {
581*479ab7f0SSascha Wildner for (x = 0, i = 0; i < 11; i++)
582*479ab7f0SSascha Wildner x = ((((x & 1) << 7) | (x >> 1)) +
583*479ab7f0SSascha Wildner ((i < 8) ? dir[ent].de.name[i] :
584*479ab7f0SSascha Wildner dir[ent].de.ext[i - 8])
585*479ab7f0SSascha Wildner ) & 0xff;
586*479ab7f0SSascha Wildner ok = chk == x &&
587*479ab7f0SSascha Wildner !strcasecmp(name, (const char *)lfn);
588*479ab7f0SSascha Wildner }
589*479ab7f0SSascha Wildner if (!ok) {
590*479ab7f0SSascha Wildner cp_sfn(sfn, &dir[ent].de);
591*479ab7f0SSascha Wildner ok = !strcasecmp(name, (const char *)sfn);
592*479ab7f0SSascha Wildner }
593*479ab7f0SSascha Wildner if (ok) {
594*479ab7f0SSascha Wildner *dep = &dir[ent].de;
595*479ab7f0SSascha Wildner return 0;
596*479ab7f0SSascha Wildner }
597*479ab7f0SSascha Wildner }
598*479ab7f0SSascha Wildner }
599*479ab7f0SSascha Wildner xdn = 0;
600*479ab7f0SSascha Wildner }
601*479ab7f0SSascha Wildner }
602*479ab7f0SSascha Wildner if (!clus)
603*479ab7f0SSascha Wildner break;
604*479ab7f0SSascha Wildner if ((err = fatget(fs, &clus)))
605*479ab7f0SSascha Wildner return err;
606*479ab7f0SSascha Wildner if (fatend(fs->fatsz, clus))
607*479ab7f0SSascha Wildner break;
608*479ab7f0SSascha Wildner }
609*479ab7f0SSascha Wildner return ENOENT;
610*479ab7f0SSascha Wildner }
611*479ab7f0SSascha Wildner
612*479ab7f0SSascha Wildner /*
613*479ab7f0SSascha Wildner * Copy name from extended directory entry
614*479ab7f0SSascha Wildner */
615*479ab7f0SSascha Wildner static void
cp_xdnm(u_char * lfn,DOS_XDE * xde)616*479ab7f0SSascha Wildner cp_xdnm(u_char *lfn, DOS_XDE *xde)
617*479ab7f0SSascha Wildner {
618*479ab7f0SSascha Wildner static struct {
619*479ab7f0SSascha Wildner u_int off;
620*479ab7f0SSascha Wildner u_int dim;
621*479ab7f0SSascha Wildner } ix[3] = {
622*479ab7f0SSascha Wildner {offsetof(DOS_XDE, name1), sizeof(xde->name1) / 2},
623*479ab7f0SSascha Wildner {offsetof(DOS_XDE, name2), sizeof(xde->name2) / 2},
624*479ab7f0SSascha Wildner {offsetof(DOS_XDE, name3), sizeof(xde->name3) / 2}
625*479ab7f0SSascha Wildner };
626*479ab7f0SSascha Wildner u_char *p;
627*479ab7f0SSascha Wildner u_int n, x, c;
628*479ab7f0SSascha Wildner
629*479ab7f0SSascha Wildner lfn += 13 * ((xde->seq & ~0x40) - 1);
630*479ab7f0SSascha Wildner for (n = 0; n < 3; n++)
631*479ab7f0SSascha Wildner for (p = (u_char *)xde + ix[n].off, x = ix[n].dim; x;
632*479ab7f0SSascha Wildner p += 2, x--) {
633*479ab7f0SSascha Wildner if ((c = cv2(p)) && (c < 32 || c > 127))
634*479ab7f0SSascha Wildner c = '?';
635*479ab7f0SSascha Wildner if (!(*lfn++ = c))
636*479ab7f0SSascha Wildner return;
637*479ab7f0SSascha Wildner }
638*479ab7f0SSascha Wildner if (xde->seq & 0x40)
639*479ab7f0SSascha Wildner *lfn = 0;
640*479ab7f0SSascha Wildner }
641*479ab7f0SSascha Wildner
642*479ab7f0SSascha Wildner /*
643*479ab7f0SSascha Wildner * Copy short filename
644*479ab7f0SSascha Wildner */
645*479ab7f0SSascha Wildner static void
cp_sfn(u_char * sfn,DOS_DE * de)646*479ab7f0SSascha Wildner cp_sfn(u_char *sfn, DOS_DE *de)
647*479ab7f0SSascha Wildner {
648*479ab7f0SSascha Wildner u_char *p;
649*479ab7f0SSascha Wildner int j, i;
650*479ab7f0SSascha Wildner
651*479ab7f0SSascha Wildner p = sfn;
652*479ab7f0SSascha Wildner if (*de->name != ' ') {
653*479ab7f0SSascha Wildner for (j = 7; de->name[j] == ' '; j--);
654*479ab7f0SSascha Wildner for (i = 0; i <= j; i++)
655*479ab7f0SSascha Wildner *p++ = de->name[i];
656*479ab7f0SSascha Wildner if (*de->ext != ' ') {
657*479ab7f0SSascha Wildner *p++ = '.';
658*479ab7f0SSascha Wildner for (j = 2; de->ext[j] == ' '; j--);
659*479ab7f0SSascha Wildner for (i = 0; i <= j; i++)
660*479ab7f0SSascha Wildner *p++ = de->ext[i];
661*479ab7f0SSascha Wildner }
662*479ab7f0SSascha Wildner }
663*479ab7f0SSascha Wildner *p = 0;
664*479ab7f0SSascha Wildner if (*sfn == 5)
665*479ab7f0SSascha Wildner *sfn = 0xe5;
666*479ab7f0SSascha Wildner }
667*479ab7f0SSascha Wildner
668*479ab7f0SSascha Wildner /*
669*479ab7f0SSascha Wildner * Return size of file in bytes
670*479ab7f0SSascha Wildner */
671*479ab7f0SSascha Wildner static off_t
fsize(DOS_FS * fs,DOS_DE * de)672*479ab7f0SSascha Wildner fsize(DOS_FS *fs, DOS_DE *de)
673*479ab7f0SSascha Wildner {
674*479ab7f0SSascha Wildner u_long size;
675*479ab7f0SSascha Wildner u_int c;
676*479ab7f0SSascha Wildner int n;
677*479ab7f0SSascha Wildner
678*479ab7f0SSascha Wildner if (!(size = cv4(de->size)) && de->attr & FA_DIR) {
679*479ab7f0SSascha Wildner if (!(c = cv2(de->clus)))
680*479ab7f0SSascha Wildner size = fs->dirents * sizeof(DOS_DE);
681*479ab7f0SSascha Wildner else {
682*479ab7f0SSascha Wildner if ((n = fatcnt(fs, c)) == -1)
683*479ab7f0SSascha Wildner return n;
684*479ab7f0SSascha Wildner size = blkbyt(fs, n);
685*479ab7f0SSascha Wildner }
686*479ab7f0SSascha Wildner }
687*479ab7f0SSascha Wildner return size;
688*479ab7f0SSascha Wildner }
689*479ab7f0SSascha Wildner
690*479ab7f0SSascha Wildner /*
691*479ab7f0SSascha Wildner * Count number of clusters in chain
692*479ab7f0SSascha Wildner */
693*479ab7f0SSascha Wildner static int
fatcnt(DOS_FS * fs,u_int c)694*479ab7f0SSascha Wildner fatcnt(DOS_FS *fs, u_int c)
695*479ab7f0SSascha Wildner {
696*479ab7f0SSascha Wildner int n;
697*479ab7f0SSascha Wildner
698*479ab7f0SSascha Wildner for (n = 0; okclus(fs, c); n++)
699*479ab7f0SSascha Wildner if (fatget(fs, &c))
700*479ab7f0SSascha Wildner return -1;
701*479ab7f0SSascha Wildner return fatend(fs->fatsz, c) ? n : -1;
702*479ab7f0SSascha Wildner }
703*479ab7f0SSascha Wildner
704*479ab7f0SSascha Wildner /*
705*479ab7f0SSascha Wildner * Get next cluster in cluster chain
706*479ab7f0SSascha Wildner */
707*479ab7f0SSascha Wildner static int
fatget(DOS_FS * fs,u_int * c)708*479ab7f0SSascha Wildner fatget(DOS_FS *fs, u_int *c)
709*479ab7f0SSascha Wildner {
710*479ab7f0SSascha Wildner u_char buf[4];
711*479ab7f0SSascha Wildner u_int x;
712*479ab7f0SSascha Wildner int err;
713*479ab7f0SSascha Wildner
714*479ab7f0SSascha Wildner err = ioread(fs, secbyt(fs->lsnfat) + fatoff(fs->fatsz, *c), buf,
715*479ab7f0SSascha Wildner fs->fatsz != 32 ? 2 : 4);
716*479ab7f0SSascha Wildner if (err)
717*479ab7f0SSascha Wildner return err;
718*479ab7f0SSascha Wildner x = fs->fatsz != 32 ? cv2(buf) : cv4(buf);
719*479ab7f0SSascha Wildner *c = fs->fatsz == 12 ? *c & 1 ? x >> 4 : x & 0xfff : x;
720*479ab7f0SSascha Wildner return 0;
721*479ab7f0SSascha Wildner }
722*479ab7f0SSascha Wildner
723*479ab7f0SSascha Wildner /*
724*479ab7f0SSascha Wildner * Is cluster an end-of-chain marker?
725*479ab7f0SSascha Wildner */
726*479ab7f0SSascha Wildner static int
fatend(u_int sz,u_int c)727*479ab7f0SSascha Wildner fatend(u_int sz, u_int c)
728*479ab7f0SSascha Wildner {
729*479ab7f0SSascha Wildner return c > (sz == 12 ? 0xff7U : sz == 16 ? 0xfff7U : 0xffffff7);
730*479ab7f0SSascha Wildner }
731*479ab7f0SSascha Wildner
732*479ab7f0SSascha Wildner /*
733*479ab7f0SSascha Wildner * Offset-based I/O primitive
734*479ab7f0SSascha Wildner */
735*479ab7f0SSascha Wildner static int
ioread(DOS_FS * fs,u_int offset,void * buf,u_int nbyte)736*479ab7f0SSascha Wildner ioread(DOS_FS *fs, u_int offset, void *buf, u_int nbyte)
737*479ab7f0SSascha Wildner {
738*479ab7f0SSascha Wildner char *s;
739*479ab7f0SSascha Wildner u_int off, n;
740*479ab7f0SSascha Wildner int err;
741*479ab7f0SSascha Wildner
742*479ab7f0SSascha Wildner s = buf;
743*479ab7f0SSascha Wildner if ((off = offset & (SECSIZ - 1))) {
744*479ab7f0SSascha Wildner offset -= off;
745*479ab7f0SSascha Wildner if ((err = iobuf(fs, bytsec(offset))))
746*479ab7f0SSascha Wildner return err;
747*479ab7f0SSascha Wildner offset += SECSIZ;
748*479ab7f0SSascha Wildner if ((n = SECSIZ - off) > nbyte)
749*479ab7f0SSascha Wildner n = nbyte;
750*479ab7f0SSascha Wildner memcpy(s, fs->buf + off, n);
751*479ab7f0SSascha Wildner s += n;
752*479ab7f0SSascha Wildner nbyte -= n;
753*479ab7f0SSascha Wildner }
754*479ab7f0SSascha Wildner n = nbyte & (SECSIZ - 1);
755*479ab7f0SSascha Wildner if (nbyte -= n) {
756*479ab7f0SSascha Wildner if ((err = ioget(fs->fd, bytsec(offset), s, bytsec(nbyte))))
757*479ab7f0SSascha Wildner return err;
758*479ab7f0SSascha Wildner offset += nbyte;
759*479ab7f0SSascha Wildner s += nbyte;
760*479ab7f0SSascha Wildner }
761*479ab7f0SSascha Wildner if (n) {
762*479ab7f0SSascha Wildner if ((err = iobuf(fs, bytsec(offset))))
763*479ab7f0SSascha Wildner return err;
764*479ab7f0SSascha Wildner memcpy(s, fs->buf, n);
765*479ab7f0SSascha Wildner }
766*479ab7f0SSascha Wildner return 0;
767*479ab7f0SSascha Wildner }
768*479ab7f0SSascha Wildner
769*479ab7f0SSascha Wildner /*
770*479ab7f0SSascha Wildner * Buffered sector-based I/O primitive
771*479ab7f0SSascha Wildner */
772*479ab7f0SSascha Wildner static int
iobuf(DOS_FS * fs,u_int lsec)773*479ab7f0SSascha Wildner iobuf(DOS_FS *fs, u_int lsec)
774*479ab7f0SSascha Wildner {
775*479ab7f0SSascha Wildner int err;
776*479ab7f0SSascha Wildner
777*479ab7f0SSascha Wildner if (fs->bufsec != lsec) {
778*479ab7f0SSascha Wildner if ((err = ioget(fs->fd, lsec, fs->buf, 1)))
779*479ab7f0SSascha Wildner return err;
780*479ab7f0SSascha Wildner fs->bufsec = lsec;
781*479ab7f0SSascha Wildner }
782*479ab7f0SSascha Wildner return 0;
783*479ab7f0SSascha Wildner }
784*479ab7f0SSascha Wildner
785*479ab7f0SSascha Wildner /*
786*479ab7f0SSascha Wildner * Sector-based I/O primitive
787*479ab7f0SSascha Wildner */
788*479ab7f0SSascha Wildner static int
ioget(struct open_file * fd,u_int lsec,void * buf,u_int nsec)789*479ab7f0SSascha Wildner ioget(struct open_file *fd, u_int lsec, void *buf, u_int nsec)
790*479ab7f0SSascha Wildner {
791*479ab7f0SSascha Wildner int err;
792*479ab7f0SSascha Wildner
793*479ab7f0SSascha Wildner twiddle();
794*479ab7f0SSascha Wildner if ((err = (fd->f_dev->dv_strategy)(fd->f_devdata, F_READ, lsec,
795*479ab7f0SSascha Wildner secbyt(nsec), buf, NULL)))
796*479ab7f0SSascha Wildner return(err);
797*479ab7f0SSascha Wildner return(0);
798*479ab7f0SSascha Wildner }
799