sys/geom/part/g_part_pc98.c

   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$");
  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 }