Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)
[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]
FreeBSD/Linux Kernel Cross Reference
sys/geom/part/g_part_pc98.c
Version:
- FREEBSD - FREEBSD-13-STABLE - FREEBSD-13-0 - FREEBSD-12-STABLE - FREEBSD-12-0 - FREEBSD-11-STABLE - FREEBSD-11-0 - FREEBSD-10-STABLE - FREEBSD-10-0 - FREEBSD-9-STABLE - FREEBSD-9-0 - FREEBSD-8-STABLE - FREEBSD-8-0 - FREEBSD-7-STABLE - FREEBSD-7-0 - FREEBSD-6-STABLE - FREEBSD-6-0 - FREEBSD-5-STABLE - FREEBSD-5-0 - FREEBSD-4-STABLE - FREEBSD-3-STABLE - FREEBSD22 - l41 - OPENBSD - linux-2.6 - MK84 - PLAN9 - xnu-8792
SearchContext: - none - 3 - 10
SearchContext: - none - 3 - 10
1 /*- 2 * Copyright (c) 2008 Marcel Moolenaar 3 * All rights reserved. 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 * 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 */ 26 27 #include <sys/cdefs.h> 28 __FBSDID("$FreeBSD: releng/8.0/sys/geom/part/g_part_pc98.c 190537 2009-03-30 01:03:58Z marcel $"); 29 30 #include <sys/param.h> 31 #include <sys/bio.h> 32 #include <sys/diskpc98.h> 33 #include <sys/endian.h> 34 #include <sys/kernel.h> 35 #include <sys/kobj.h> 36 #include <sys/limits.h> 37 #include <sys/lock.h> 38 #include <sys/malloc.h> 39 #include <sys/mutex.h> 40 #include <sys/queue.h> 41 #include <sys/sbuf.h> 42 #include <sys/systm.h> 43 #include <geom/geom.h> 44 #include <geom/part/g_part.h> 45 46 #include "g_part_if.h" 47 48 #define SECSIZE 512 49 50 struct g_part_pc98_table { 51 struct g_part_table base; 52 u_char boot[SECSIZE]; 53 u_char table[SECSIZE]; 54 }; 55 56 struct g_part_pc98_entry { 57 struct g_part_entry base; 58 struct pc98_partition ent; 59 }; 60 61 static int g_part_pc98_add(struct g_part_table *, struct g_part_entry *, 62 struct g_part_parms *); 63 static int g_part_pc98_bootcode(struct g_part_table *, struct g_part_parms *); 64 static int g_part_pc98_create(struct g_part_table *, struct g_part_parms *); 65 static int g_part_pc98_destroy(struct g_part_table *, struct g_part_parms *); 66 static void g_part_pc98_dumpconf(struct g_part_table *, struct g_part_entry *, 67 struct sbuf *, const char *); 68 static int g_part_pc98_dumpto(struct g_part_table *, struct g_part_entry *); 69 static int g_part_pc98_modify(struct g_part_table *, struct g_part_entry *, 70 struct g_part_parms *); 71 static const char *g_part_pc98_name(struct g_part_table *, struct g_part_entry *, 72 char *, size_t); 73 static int g_part_pc98_probe(struct g_part_table *, struct g_consumer *); 74 static int g_part_pc98_read(struct g_part_table *, struct g_consumer *); 75 static int g_part_pc98_setunset(struct g_part_table *, struct g_part_entry *, 76 const char *, unsigned int); 77 static const char *g_part_pc98_type(struct g_part_table *, 78 struct g_part_entry *, char *, size_t); 79 static int g_part_pc98_write(struct g_part_table *, struct g_consumer *); 80 81 static kobj_method_t g_part_pc98_methods[] = { 82 KOBJMETHOD(g_part_add, g_part_pc98_add), 83 KOBJMETHOD(g_part_bootcode, g_part_pc98_bootcode), 84 KOBJMETHOD(g_part_create, g_part_pc98_create), 85 KOBJMETHOD(g_part_destroy, g_part_pc98_destroy), 86 KOBJMETHOD(g_part_dumpconf, g_part_pc98_dumpconf), 87 KOBJMETHOD(g_part_dumpto, g_part_pc98_dumpto), 88 KOBJMETHOD(g_part_modify, g_part_pc98_modify), 89 KOBJMETHOD(g_part_name, g_part_pc98_name), 90 KOBJMETHOD(g_part_probe, g_part_pc98_probe), 91 KOBJMETHOD(g_part_read, g_part_pc98_read), 92 KOBJMETHOD(g_part_setunset, g_part_pc98_setunset), 93 KOBJMETHOD(g_part_type, g_part_pc98_type), 94 KOBJMETHOD(g_part_write, g_part_pc98_write), 95 { 0, 0 } 96 }; 97 98 static struct g_part_scheme g_part_pc98_scheme = { 99 "PC98", 100 g_part_pc98_methods, 101 sizeof(struct g_part_pc98_table), 102 .gps_entrysz = sizeof(struct g_part_pc98_entry), 103 .gps_minent = NDOSPART, 104 .gps_maxent = NDOSPART, 105 .gps_bootcodesz = SECSIZE, 106 }; 107 G_PART_SCHEME_DECLARE(g_part_pc98); 108 109 static int 110 pc98_parse_type(const char *type, u_char *dp_mid, u_char *dp_sid) 111 { 112 const char *alias; 113 char *endp; 114 long lt; 115 116 if (type[0] == '!') { 117 lt = strtol(type + 1, &endp, 0); 118 if (type[1] == '\0' || *endp != '\0' || lt <= 0 || 119 lt >= 65536) 120 return (EINVAL); 121 /* Make sure the active and bootable flags aren't set. */ 122 if (lt & ((PC98_SID_ACTIVE << 8) | PC98_MID_BOOTABLE)) 123 return (ENOATTR); 124 *dp_mid = (*dp_mid & PC98_MID_BOOTABLE) | (u_char)lt; 125 *dp_sid = (*dp_sid & PC98_SID_ACTIVE) | (u_char)(lt >> 8); 126 return (0); 127 } 128 alias = g_part_alias_name(G_PART_ALIAS_FREEBSD); 129 if (!strcasecmp(type, alias)) { 130 *dp_mid = (*dp_mid & PC98_MID_BOOTABLE) | PC98_MID_386BSD; 131 *dp_sid = (*dp_sid & PC98_SID_ACTIVE) | PC98_SID_386BSD; 132 return (0); 133 } 134 return (EINVAL); 135 } 136 137 static void 138 pc98_set_chs(struct g_part_table *table, uint32_t lba, u_short *cylp, 139 u_char *hdp, u_char *secp) 140 { 141 uint32_t cyl, hd, sec; 142 143 sec = lba % table->gpt_sectors + 1; 144 lba /= table->gpt_sectors; 145 hd = lba % table->gpt_heads; 146 lba /= table->gpt_heads; 147 cyl = lba; 148 149 *cylp = htole16(cyl); 150 *hdp = hd; 151 *secp = sec; 152 } 153 154 static int 155 g_part_pc98_add(struct g_part_table *basetable, struct g_part_entry *baseentry, 156 struct g_part_parms *gpp) 157 { 158 struct g_part_pc98_entry *entry; 159 struct g_part_pc98_table *table; 160 uint32_t cyl, start, size; 161 162 if (gpp->gpp_parms & G_PART_PARM_LABEL) 163 return (EINVAL); 164 165 cyl = basetable->gpt_heads * basetable->gpt_sectors; 166 167 entry = (struct g_part_pc98_entry *)baseentry; 168 table = (struct g_part_pc98_table *)basetable; 169 170 start = gpp->gpp_start; 171 size = gpp->gpp_size; 172 if (size < cyl) 173 return (EINVAL); 174 if (start % cyl) { 175 size = size - cyl + (start % cyl); 176 start = start - (start % cyl) + cyl; 177 } 178 if (size % cyl) 179 size = size - (size % cyl); 180 if (size < cyl) 181 return (EINVAL); 182 183 if (baseentry->gpe_deleted) 184 bzero(&entry->ent, sizeof(entry->ent)); 185 else 186 entry->ent.dp_mid = entry->ent.dp_sid = 0; 187 188 KASSERT(baseentry->gpe_start <= start, (__func__)); 189 KASSERT(baseentry->gpe_end >= start + size - 1, (__func__)); 190 baseentry->gpe_start = start; 191 baseentry->gpe_end = start + size - 1; 192 pc98_set_chs(basetable, baseentry->gpe_start, &entry->ent.dp_scyl, 193 &entry->ent.dp_shd, &entry->ent.dp_ssect); 194 pc98_set_chs(basetable, baseentry->gpe_end, &entry->ent.dp_ecyl, 195 &entry->ent.dp_ehd, &entry->ent.dp_esect); 196 return (pc98_parse_type(gpp->gpp_type, &entry->ent.dp_mid, 197 &entry->ent.dp_sid)); 198 } 199 200 static int 201 g_part_pc98_bootcode(struct g_part_table *basetable, struct g_part_parms *gpp) 202 { 203 struct g_part_pc98_table *table; 204 size_t codesz; 205 206 codesz = DOSMAGICOFFSET; 207 table = (struct g_part_pc98_table *)basetable; 208 bzero(table->boot, codesz); 209 codesz = MIN(codesz, gpp->gpp_codesize); 210 if (codesz > 0) 211 bcopy(gpp->gpp_codeptr, table->boot, codesz); 212 return (0); 213 } 214 215 static int 216 g_part_pc98_create(struct g_part_table *basetable, struct g_part_parms *gpp) 217 { 218 struct g_consumer *cp; 219 struct g_provider *pp; 220 struct g_part_pc98_table *table; 221 uint32_t cyl, msize; 222 223 pp = gpp->gpp_provider; 224 cp = LIST_FIRST(&pp->consumers); 225 226 if (pp->sectorsize < SECSIZE || pp->mediasize < 2 * SECSIZE) 227 return (ENOSPC); 228 if (pp->sectorsize > SECSIZE) 229 return (ENXIO); 230 231 cyl = basetable->gpt_heads * basetable->gpt_sectors; 232 233 msize = MIN(pp->mediasize / SECSIZE, 0xffffffff); 234 basetable->gpt_first = cyl; 235 basetable->gpt_last = msize - (msize % cyl) - 1; 236 237 table = (struct g_part_pc98_table *)basetable; 238 le16enc(table->boot + DOSMAGICOFFSET, DOSMAGIC); 239 return (0); 240 } 241 242 static int 243 g_part_pc98_destroy(struct g_part_table *basetable, struct g_part_parms *gpp) 244 { 245 246 /* Wipe the first two sectors to clear the partitioning. */ 247 basetable->gpt_smhead |= 3; 248 return (0); 249 } 250 251 static void 252 g_part_pc98_dumpconf(struct g_part_table *table, 253 struct g_part_entry *baseentry, struct sbuf *sb, const char *indent) 254 { 255 struct g_part_pc98_entry *entry; 256 char name[sizeof(entry->ent.dp_name) + 1]; 257 u_int type; 258 259 entry = (struct g_part_pc98_entry *)baseentry; 260 if (entry == NULL) { 261 /* confxml: scheme information */ 262 return; 263 } 264 265 type = entry->ent.dp_mid + (entry->ent.dp_sid << 8); 266 strncpy(name, entry->ent.dp_name, sizeof(name) - 1); 267 name[sizeof(name) - 1] = '\0'; 268 if (indent == NULL) { 269 /* conftxt: libdisk compatibility */ 270 sbuf_printf(sb, " xs PC98 xt %u sn %s", type, name); 271 } else { 272 /* confxml: partition entry information */ 273 sbuf_printf(sb, "%s<label>%s</label>\n", indent, name); 274 if (entry->ent.dp_mid & PC98_MID_BOOTABLE) 275 sbuf_printf(sb, "%s<attrib>bootable</attrib>\n", 276 indent); 277 if (entry->ent.dp_sid & PC98_SID_ACTIVE) 278 sbuf_printf(sb, "%s<attrib>active</attrib>\n", indent); 279 sbuf_printf(sb, "%s<rawtype>%u</rawtype>\n", indent, 280 type & 0x7f7f); 281 } 282 } 283 284 static int 285 g_part_pc98_dumpto(struct g_part_table *table, struct g_part_entry *baseentry) 286 { 287 struct g_part_pc98_entry *entry; 288 289 /* Allow dumping to a FreeBSD partition only. */ 290 entry = (struct g_part_pc98_entry *)baseentry; 291 return (((entry->ent.dp_mid & PC98_MID_MASK) == PC98_MID_386BSD && 292 (entry->ent.dp_sid & PC98_SID_MASK) == PC98_SID_386BSD) ? 1 : 0); 293 } 294 295 static int 296 g_part_pc98_modify(struct g_part_table *basetable, 297 struct g_part_entry *baseentry, struct g_part_parms *gpp) 298 { 299 struct g_part_pc98_entry *entry; 300 301 if (gpp->gpp_parms & G_PART_PARM_LABEL) 302 return (EINVAL); 303 304 entry = (struct g_part_pc98_entry *)baseentry; 305 if (gpp->gpp_parms & G_PART_PARM_TYPE) 306 return (pc98_parse_type(gpp->gpp_type, &entry->ent.dp_mid, 307 &entry->ent.dp_sid)); 308 return (0); 309 } 310 311 static const char * 312 g_part_pc98_name(struct g_part_table *table, struct g_part_entry *baseentry, 313 char *buf, size_t bufsz) 314 { 315 316 snprintf(buf, bufsz, "s%d", baseentry->gpe_index); 317 return (buf); 318 } 319 320 static int 321 g_part_pc98_probe(struct g_part_table *table, struct g_consumer *cp) 322 { 323 struct g_provider *pp; 324 u_char *buf, *p; 325 int error, index, res, sum; 326 uint16_t magic, ecyl, scyl; 327 328 pp = cp->provider; 329 330 /* Sanity-check the provider. */ 331 if (pp->sectorsize < SECSIZE || pp->mediasize < 2 * SECSIZE) 332 return (ENOSPC); 333 if (pp->sectorsize > SECSIZE) 334 return (ENXIO); 335 336 /* Check that there's a PC98 partition table. */ 337 buf = g_read_data(cp, 0L, 2 * SECSIZE, &error); 338 if (buf == NULL) 339 return (error); 340 341 /* We goto out on mismatch. */ 342 res = ENXIO; 343 344 magic = le16dec(buf + DOSMAGICOFFSET); 345 if (magic != DOSMAGIC) 346 goto out; 347 348 sum = 0; 349 for (index = SECSIZE; index < 2 * SECSIZE; index++) 350 sum += buf[index]; 351 if (sum == 0) { 352 res = G_PART_PROBE_PRI_LOW; 353 goto out; 354 } 355 356 for (index = 0; index < NDOSPART; index++) { 357 p = buf + SECSIZE + index * DOSPARTSIZE; 358 if (p[0] == 0 || p[1] == 0) /* !dp_mid || !dp_sid */ 359 continue; 360 scyl = le16dec(p + 10); 361 ecyl = le16dec(p + 14); 362 if (scyl == 0 || ecyl == 0) 363 goto out; 364 if (p[8] == p[12] && /* dp_ssect == dp_esect */ 365 p[9] == p[13] && /* dp_shd == dp_ehd */ 366 scyl == ecyl) 367 goto out; 368 } 369 370 res = G_PART_PROBE_PRI_HIGH; 371 372 out: 373 g_free(buf); 374 return (res); 375 } 376 377 static int 378 g_part_pc98_read(struct g_part_table *basetable, struct g_consumer *cp) 379 { 380 struct pc98_partition ent; 381 struct g_provider *pp; 382 struct g_part_pc98_table *table; 383 struct g_part_pc98_entry *entry; 384 u_char *buf, *p; 385 off_t msize; 386 off_t start, end; 387 u_int cyl; 388 int error, index; 389 390 pp = cp->provider; 391 table = (struct g_part_pc98_table *)basetable; 392 msize = pp->mediasize / SECSIZE; 393 394 buf = g_read_data(cp, 0L, 2 * SECSIZE, &error); 395 if (buf == NULL) 396 return (error); 397 398 cyl = basetable->gpt_heads * basetable->gpt_sectors; 399 400 bcopy(buf, table->boot, sizeof(table->boot)); 401 bcopy(buf + SECSIZE, table->table, sizeof(table->table)); 402 403 for (index = NDOSPART - 1; index >= 0; index--) { 404 p = buf + SECSIZE + index * DOSPARTSIZE; 405 ent.dp_mid = p[0]; 406 ent.dp_sid = p[1]; 407 ent.dp_dum1 = p[2]; 408 ent.dp_dum2 = p[3]; 409 ent.dp_ipl_sct = p[4]; 410 ent.dp_ipl_head = p[5]; 411 ent.dp_ipl_cyl = le16dec(p + 6); 412 ent.dp_ssect = p[8]; 413 ent.dp_shd = p[9]; 414 ent.dp_scyl = le16dec(p + 10); 415 ent.dp_esect = p[12]; 416 ent.dp_ehd = p[13]; 417 ent.dp_ecyl = le16dec(p + 14); 418 bcopy(p + 16, ent.dp_name, sizeof(ent.dp_name)); 419 if (ent.dp_sid == 0) 420 continue; 421 422 start = ent.dp_scyl * cyl; 423 end = (ent.dp_ecyl + 1) * cyl - 1; 424 entry = (struct g_part_pc98_entry *)g_part_new_entry(basetable, 425 index + 1, start, end); 426 entry->ent = ent; 427 } 428 429 basetable->gpt_entries = NDOSPART; 430 basetable->gpt_first = cyl; 431 basetable->gpt_last = msize - (msize % cyl) - 1; 432 433 return (0); 434 } 435 436 static int 437 g_part_pc98_setunset(struct g_part_table *table, struct g_part_entry *baseentry, 438 const char *attrib, unsigned int set) 439 { 440 struct g_part_entry *iter; 441 struct g_part_pc98_entry *entry; 442 int changed, mid, sid; 443 444 mid = sid = 0; 445 if (strcasecmp(attrib, "active") == 0) 446 sid = 1; 447 else if (strcasecmp(attrib, "bootable") == 0) 448 mid = 1; 449 if (mid == 0 && sid == 0) 450 return (EINVAL); 451 452 LIST_FOREACH(iter, &table->gpt_entry, gpe_entry) { 453 if (iter->gpe_deleted) 454 continue; 455 if (iter != baseentry) 456 continue; 457 changed = 0; 458 entry = (struct g_part_pc98_entry *)iter; 459 if (set) { 460 if (mid && !(entry->ent.dp_mid & PC98_MID_BOOTABLE)) { 461 entry->ent.dp_mid |= PC98_MID_BOOTABLE; 462 changed = 1; 463 } 464 if (sid && !(entry->ent.dp_sid & PC98_SID_ACTIVE)) { 465 entry->ent.dp_sid |= PC98_SID_ACTIVE; 466 changed = 1; 467 } 468 } else { 469 if (mid && (entry->ent.dp_mid & PC98_MID_BOOTABLE)) { 470 entry->ent.dp_mid &= ~PC98_MID_BOOTABLE; 471 changed = 1; 472 } 473 if (sid && (entry->ent.dp_sid & PC98_SID_ACTIVE)) { 474 entry->ent.dp_sid &= ~PC98_SID_ACTIVE; 475 changed = 1; 476 } 477 } 478 if (changed && !iter->gpe_created) 479 iter->gpe_modified = 1; 480 } 481 return (0); 482 } 483 484 static const char * 485 g_part_pc98_type(struct g_part_table *basetable, struct g_part_entry *baseentry, 486 char *buf, size_t bufsz) 487 { 488 struct g_part_pc98_entry *entry; 489 u_int type; 490 491 entry = (struct g_part_pc98_entry *)baseentry; 492 type = (entry->ent.dp_mid & PC98_MID_MASK) | 493 ((entry->ent.dp_sid & PC98_SID_MASK) << 8); 494 if (type == (PC98_MID_386BSD | (PC98_SID_386BSD << 8))) 495 return (g_part_alias_name(G_PART_ALIAS_FREEBSD)); 496 snprintf(buf, bufsz, "!%d", type); 497 return (buf); 498 } 499 500 static int 501 g_part_pc98_write(struct g_part_table *basetable, struct g_consumer *cp) 502 { 503 struct g_part_entry *baseentry; 504 struct g_part_pc98_entry *entry; 505 struct g_part_pc98_table *table; 506 u_char *p; 507 int error, index; 508 509 table = (struct g_part_pc98_table *)basetable; 510 baseentry = LIST_FIRST(&basetable->gpt_entry); 511 for (index = 1; index <= basetable->gpt_entries; index++) { 512 p = table->table + (index - 1) * DOSPARTSIZE; 513 entry = (baseentry != NULL && index == baseentry->gpe_index) 514 ? (struct g_part_pc98_entry *)baseentry : NULL; 515 if (entry != NULL && !baseentry->gpe_deleted) { 516 p[0] = entry->ent.dp_mid; 517 p[1] = entry->ent.dp_sid; 518 p[2] = entry->ent.dp_dum1; 519 p[3] = entry->ent.dp_dum2; 520 p[4] = entry->ent.dp_ipl_sct; 521 p[5] = entry->ent.dp_ipl_head; 522 le16enc(p + 6, entry->ent.dp_ipl_cyl); 523 p[8] = entry->ent.dp_ssect; 524 p[9] = entry->ent.dp_shd; 525 le16enc(p + 10, entry->ent.dp_scyl); 526 p[12] = entry->ent.dp_esect; 527 p[13] = entry->ent.dp_ehd; 528 le16enc(p + 14, entry->ent.dp_ecyl); 529 bcopy(entry->ent.dp_name, p + 16, 530 sizeof(entry->ent.dp_name)); 531 } else 532 bzero(p, DOSPARTSIZE); 533 534 if (entry != NULL) 535 baseentry = LIST_NEXT(baseentry, gpe_entry); 536 } 537 538 error = g_write_data(cp, 0, table->boot, SECSIZE); 539 if (!error) 540 error = g_write_data(cp, SECSIZE, table->table, SECSIZE); 541 return (error); 542 }
Cache object: 38e076c03b6bda44b3839edfffccebdd
[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]