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 --- |