Deleted Added
sdiff udiff text old ( 203874 ) new ( 209364 )
full compact
boot.c (203874) boot.c (209364)
1/*
2 * Copyright (C) 1995, 1997 Wolfgang Solfrank
3 * Copyright (c) 1995 Martin Husemann
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright

--- 14 unchanged lines hidden (view full) ---

23 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
24 */
25
26
27#include <sys/cdefs.h>
28#ifndef lint
29__RCSID("$NetBSD: boot.c,v 1.9 2003/07/24 19:25:46 ws Exp $");
30static const char rcsid[] =
1/*
2 * Copyright (C) 1995, 1997 Wolfgang Solfrank
3 * Copyright (c) 1995 Martin Husemann
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright

--- 14 unchanged lines hidden (view full) ---

23 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
24 */
25
26
27#include <sys/cdefs.h>
28#ifndef lint
29__RCSID("$NetBSD: boot.c,v 1.9 2003/07/24 19:25:46 ws Exp $");
30static const char rcsid[] =
31 "$FreeBSD: head/sbin/fsck_msdosfs/boot.c 203874 2010-02-14 12:31:28Z kib $";
31 "$FreeBSD: head/sbin/fsck_msdosfs/boot.c 209364 2010-06-20 09:40:54Z brian $";
32#endif /* not lint */
33
34#include <stdlib.h>
35#include <string.h>
36#include <stdio.h>
37#include <unistd.h>
38
39#include "ext.h"
40#include "fsutil.h"
41
42int
43readboot(int dosfs, struct bootblock *boot)
44{
45 u_char block[DOSBOOTBLOCKSIZE];
46 u_char fsinfo[2 * DOSBOOTBLOCKSIZE];
47 u_char backup[DOSBOOTBLOCKSIZE];
48 int ret = FSOK;
49 int i;
50
32#endif /* not lint */
33
34#include <stdlib.h>
35#include <string.h>
36#include <stdio.h>
37#include <unistd.h>
38
39#include "ext.h"
40#include "fsutil.h"
41
42int
43readboot(int dosfs, struct bootblock *boot)
44{
45 u_char block[DOSBOOTBLOCKSIZE];
46 u_char fsinfo[2 * DOSBOOTBLOCKSIZE];
47 u_char backup[DOSBOOTBLOCKSIZE];
48 int ret = FSOK;
49 int i;
50
51 if ((size_t)read(dosfs, block, sizeof block) != sizeof block) {
51 if (read(dosfs, block, sizeof block) != sizeof block) {
52 perror("could not read boot block");
53 return FSFATAL;
54 }
55
56 if (block[510] != 0x55 || block[511] != 0xaa) {
52 perror("could not read boot block");
53 return FSFATAL;
54 }
55
56 if (block[510] != 0x55 || block[511] != 0xaa) {
57 pfatal("Invalid signature in boot block: %02x%02x", block[511], block[510]);
57 pfatal("Invalid signature in boot block: %02x%02x",
58 block[511], block[510]);
58 return FSFATAL;
59 }
60
61 memset(boot, 0, sizeof *boot);
62 boot->ValidFat = -1;
63
64 /* decode bios parameter block */
65 boot->bpbBytesPerSec = block[11] + (block[12] << 8);
66 boot->bpbSecPerClust = block[13];
67 boot->bpbResSectors = block[14] + (block[15] << 8);
68 boot->bpbFATs = block[16];
69 boot->bpbRootDirEnts = block[17] + (block[18] << 8);
70 boot->bpbSectors = block[19] + (block[20] << 8);
71 boot->bpbMedia = block[21];
72 boot->bpbFATsmall = block[22] + (block[23] << 8);
73 boot->SecPerTrack = block[24] + (block[25] << 8);
74 boot->bpbHeads = block[26] + (block[27] << 8);
59 return FSFATAL;
60 }
61
62 memset(boot, 0, sizeof *boot);
63 boot->ValidFat = -1;
64
65 /* decode bios parameter block */
66 boot->bpbBytesPerSec = block[11] + (block[12] << 8);
67 boot->bpbSecPerClust = block[13];
68 boot->bpbResSectors = block[14] + (block[15] << 8);
69 boot->bpbFATs = block[16];
70 boot->bpbRootDirEnts = block[17] + (block[18] << 8);
71 boot->bpbSectors = block[19] + (block[20] << 8);
72 boot->bpbMedia = block[21];
73 boot->bpbFATsmall = block[22] + (block[23] << 8);
74 boot->SecPerTrack = block[24] + (block[25] << 8);
75 boot->bpbHeads = block[26] + (block[27] << 8);
75 boot->bpbHiddenSecs = block[28] + (block[29] << 8) + (block[30] << 16) + (block[31] << 24);
76 boot->bpbHugeSectors = block[32] + (block[33] << 8) + (block[34] << 16) + (block[35] << 24);
76 boot->bpbHiddenSecs = block[28] + (block[29] << 8) +
77 (block[30] << 16) + (block[31] << 24);
78 boot->bpbHugeSectors = block[32] + (block[33] << 8) +
79 (block[34] << 16) + (block[35] << 24);
77
78 boot->FATsecs = boot->bpbFATsmall;
79
80 if (!boot->bpbRootDirEnts)
81 boot->flags |= FAT32;
82 if (boot->flags & FAT32) {
83 boot->FATsecs = block[36] + (block[37] << 8)
84 + (block[38] << 16) + (block[39] << 24);

--- 7 unchanged lines hidden (view full) ---

92 block[43], block[42]);
93 return FSFATAL;
94 }
95 boot->bpbRootClust = block[44] + (block[45] << 8)
96 + (block[46] << 16) + (block[47] << 24);
97 boot->bpbFSInfo = block[48] + (block[49] << 8);
98 boot->bpbBackup = block[50] + (block[51] << 8);
99
80
81 boot->FATsecs = boot->bpbFATsmall;
82
83 if (!boot->bpbRootDirEnts)
84 boot->flags |= FAT32;
85 if (boot->flags & FAT32) {
86 boot->FATsecs = block[36] + (block[37] << 8)
87 + (block[38] << 16) + (block[39] << 24);

--- 7 unchanged lines hidden (view full) ---

95 block[43], block[42]);
96 return FSFATAL;
97 }
98 boot->bpbRootClust = block[44] + (block[45] << 8)
99 + (block[46] << 16) + (block[47] << 24);
100 boot->bpbFSInfo = block[48] + (block[49] << 8);
101 boot->bpbBackup = block[50] + (block[51] << 8);
102
100 if (lseek(dosfs, boot->bpbFSInfo * boot->bpbBytesPerSec, SEEK_SET)
101 != boot->bpbFSInfo * boot->bpbBytesPerSec
102 || read(dosfs, fsinfo, sizeof fsinfo)
103 != sizeof fsinfo) {
103 if (lseek(dosfs, boot->bpbFSInfo * boot->bpbBytesPerSec,
104 SEEK_SET) != boot->bpbFSInfo * boot->bpbBytesPerSec
105 || read(dosfs, fsinfo, sizeof fsinfo) != sizeof fsinfo) {
104 perror("could not read fsinfo block");
105 return FSFATAL;
106 }
107 if (memcmp(fsinfo, "RRaA", 4)
108 || memcmp(fsinfo + 0x1e4, "rrAa", 4)
109 || fsinfo[0x1fc]
110 || fsinfo[0x1fd]
111 || fsinfo[0x1fe] != 0x55

--- 7 unchanged lines hidden (view full) ---

119 memcpy(fsinfo, "RRaA", 4);
120 memcpy(fsinfo + 0x1e4, "rrAa", 4);
121 fsinfo[0x1fc] = fsinfo[0x1fd] = 0;
122 fsinfo[0x1fe] = 0x55;
123 fsinfo[0x1ff] = 0xaa;
124 fsinfo[0x3fc] = fsinfo[0x3fd] = 0;
125 fsinfo[0x3fe] = 0x55;
126 fsinfo[0x3ff] = 0xaa;
106 perror("could not read fsinfo block");
107 return FSFATAL;
108 }
109 if (memcmp(fsinfo, "RRaA", 4)
110 || memcmp(fsinfo + 0x1e4, "rrAa", 4)
111 || fsinfo[0x1fc]
112 || fsinfo[0x1fd]
113 || fsinfo[0x1fe] != 0x55

--- 7 unchanged lines hidden (view full) ---

121 memcpy(fsinfo, "RRaA", 4);
122 memcpy(fsinfo + 0x1e4, "rrAa", 4);
123 fsinfo[0x1fc] = fsinfo[0x1fd] = 0;
124 fsinfo[0x1fe] = 0x55;
125 fsinfo[0x1ff] = 0xaa;
126 fsinfo[0x3fc] = fsinfo[0x3fd] = 0;
127 fsinfo[0x3fe] = 0x55;
128 fsinfo[0x3ff] = 0xaa;
127 if (lseek(dosfs, boot->bpbFSInfo * boot->bpbBytesPerSec, SEEK_SET)
129 if (lseek(dosfs, boot->bpbFSInfo *
130 boot->bpbBytesPerSec, SEEK_SET)
128 != boot->bpbFSInfo * boot->bpbBytesPerSec
129 || write(dosfs, fsinfo, sizeof fsinfo)
130 != sizeof fsinfo) {
131 perror("Unable to write bpbFSInfo");
132 return FSFATAL;
133 }
134 ret = FSBOOTMOD;
135 } else
136 boot->bpbFSInfo = 0;
137 }
138 if (boot->bpbFSInfo) {
139 boot->FSFree = fsinfo[0x1e8] + (fsinfo[0x1e9] << 8)
140 + (fsinfo[0x1ea] << 16)
141 + (fsinfo[0x1eb] << 24);
142 boot->FSNext = fsinfo[0x1ec] + (fsinfo[0x1ed] << 8)
143 + (fsinfo[0x1ee] << 16)
144 + (fsinfo[0x1ef] << 24);
145 }
146
131 != boot->bpbFSInfo * boot->bpbBytesPerSec
132 || write(dosfs, fsinfo, sizeof fsinfo)
133 != sizeof fsinfo) {
134 perror("Unable to write bpbFSInfo");
135 return FSFATAL;
136 }
137 ret = FSBOOTMOD;
138 } else
139 boot->bpbFSInfo = 0;
140 }
141 if (boot->bpbFSInfo) {
142 boot->FSFree = fsinfo[0x1e8] + (fsinfo[0x1e9] << 8)
143 + (fsinfo[0x1ea] << 16)
144 + (fsinfo[0x1eb] << 24);
145 boot->FSNext = fsinfo[0x1ec] + (fsinfo[0x1ed] << 8)
146 + (fsinfo[0x1ee] << 16)
147 + (fsinfo[0x1ef] << 24);
148 }
149
147 if (lseek(dosfs, boot->bpbBackup * boot->bpbBytesPerSec, SEEK_SET)
150 if (lseek(dosfs, boot->bpbBackup * boot->bpbBytesPerSec,
151 SEEK_SET)
148 != boot->bpbBackup * boot->bpbBytesPerSec
149 || read(dosfs, backup, sizeof backup) != sizeof backup) {
150 perror("could not read backup bootblock");
151 return FSFATAL;
152 }
153 backup[65] = block[65]; /* XXX */
154 if (memcmp(block + 11, backup + 11, 79)) {
155 /*

--- 11 unchanged lines hidden (view full) ---

167 if (block[i] != backup[i])
168 pfatal("\ti=%d\tprimary 0x%02x\tbackup 0x%02x\n",
169 i, block[i], backup[i]);
170 }
171 }
172 /* Check backup bpbFSInfo? XXX */
173 }
174
152 != boot->bpbBackup * boot->bpbBytesPerSec
153 || read(dosfs, backup, sizeof backup) != sizeof backup) {
154 perror("could not read backup bootblock");
155 return FSFATAL;
156 }
157 backup[65] = block[65]; /* XXX */
158 if (memcmp(block + 11, backup + 11, 79)) {
159 /*

--- 11 unchanged lines hidden (view full) ---

171 if (block[i] != backup[i])
172 pfatal("\ti=%d\tprimary 0x%02x\tbackup 0x%02x\n",
173 i, block[i], backup[i]);
174 }
175 }
176 /* Check backup bpbFSInfo? XXX */
177 }
178
175 boot->ClusterOffset = (boot->bpbRootDirEnts * 32 + boot->bpbBytesPerSec - 1)
176 / boot->bpbBytesPerSec
177 + boot->bpbResSectors
178 + boot->bpbFATs * boot->FATsecs
179 - CLUST_FIRST * boot->bpbSecPerClust;
179 boot->ClusterOffset = (boot->bpbRootDirEnts * 32 +
180 boot->bpbBytesPerSec - 1) / boot->bpbBytesPerSec +
181 boot->bpbResSectors + boot->bpbFATs * boot->FATsecs -
182 CLUST_FIRST * boot->bpbSecPerClust;
180
181 if (boot->bpbBytesPerSec % DOSBOOTBLOCKSIZE != 0) {
182 pfatal("Invalid sector size: %u", boot->bpbBytesPerSec);
183 return FSFATAL;
184 }
185 if (boot->bpbSecPerClust == 0) {
186 pfatal("Invalid cluster size: %u", boot->bpbSecPerClust);
187 return FSFATAL;
188 }
189 if (boot->bpbSectors) {
190 boot->bpbHugeSectors = 0;
191 boot->NumSectors = boot->bpbSectors;
192 } else
193 boot->NumSectors = boot->bpbHugeSectors;
183
184 if (boot->bpbBytesPerSec % DOSBOOTBLOCKSIZE != 0) {
185 pfatal("Invalid sector size: %u", boot->bpbBytesPerSec);
186 return FSFATAL;
187 }
188 if (boot->bpbSecPerClust == 0) {
189 pfatal("Invalid cluster size: %u", boot->bpbSecPerClust);
190 return FSFATAL;
191 }
192 if (boot->bpbSectors) {
193 boot->bpbHugeSectors = 0;
194 boot->NumSectors = boot->bpbSectors;
195 } else
196 boot->NumSectors = boot->bpbHugeSectors;
194 boot->NumClusters = (boot->NumSectors - boot->ClusterOffset) / boot->bpbSecPerClust;
197 boot->NumClusters = (boot->NumSectors - boot->ClusterOffset) /
198 boot->bpbSecPerClust;
195
196 if (boot->flags&FAT32)
197 boot->ClustMask = CLUST32_MASK;
198 else if (boot->NumClusters < (CLUST_RSRVD&CLUST12_MASK))
199 boot->ClustMask = CLUST12_MASK;
200 else if (boot->NumClusters < (CLUST_RSRVD&CLUST16_MASK))
201 boot->ClustMask = CLUST16_MASK;
202 else {

--- 69 unchanged lines hidden --- 		199
200 if (boot->flags&FAT32)
201 boot->ClustMask = CLUST32_MASK;
202 else if (boot->NumClusters < (CLUST_RSRVD&CLUST12_MASK))
203 boot->ClustMask = CLUST12_MASK;
204 else if (boot->NumClusters < (CLUST_RSRVD&CLUST16_MASK))
205 boot->ClustMask = CLUST16_MASK;
206 else {

--- 69 unchanged lines hidden ---