geom_sunlabel.c revision 113011
192372Sphk/*- 292372Sphk * Copyright (c) 2002 Poul-Henning Kamp 392372Sphk * Copyright (c) 2002 Networks Associates Technology, Inc. 492372Sphk * All rights reserved. 592372Sphk * 692372Sphk * This software was developed for the FreeBSD Project by Poul-Henning Kamp 792372Sphk * and NAI Labs, the Security Research Division of Network Associates, Inc. 892372Sphk * under DARPA/SPAWAR contract N66001-01-C-8035 ("CBOSS"), as part of the 992372Sphk * DARPA CHATS research program. 1092372Sphk * 1192372Sphk * Redistribution and use in source and binary forms, with or without 1292372Sphk * modification, are permitted provided that the following conditions 1392372Sphk * are met: 1492372Sphk * 1. Redistributions of source code must retain the above copyright 1592372Sphk * notice, this list of conditions and the following disclaimer. 1692372Sphk * 2. Redistributions in binary form must reproduce the above copyright 1792372Sphk * notice, this list of conditions and the following disclaimer in the 1892372Sphk * documentation and/or other materials provided with the distribution. 1992372Sphk * 3. The names of the authors may not be used to endorse or promote 2092372Sphk * products derived from this software without specific prior written 2192372Sphk * permission. 2292372Sphk * 2392372Sphk * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 2492372Sphk * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 2592372Sphk * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 2692372Sphk * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 2792372Sphk * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2892372Sphk * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2992372Sphk * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 3092372Sphk * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 3192372Sphk * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 3292372Sphk * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 3392372Sphk * SUCH DAMAGE. 3492372Sphk * 3592372Sphk * $FreeBSD: head/sys/geom/geom_sunlabel.c 113011 2003-04-03 11:36:53Z phk $ 3692372Sphk */ 3792372Sphk 3892372Sphk 3992372Sphk#include <sys/param.h> 40113011Sphk#include <sys/endian.h> 4192372Sphk#ifndef _KERNEL 4292372Sphk#include <stdio.h> 4392372Sphk#include <string.h> 4492372Sphk#include <stdlib.h> 4592372Sphk#include <signal.h> 46110183Sphk#include <sys/errno.h> 4792372Sphk#include <err.h> 4892372Sphk#else 4992372Sphk#include <sys/systm.h> 5092372Sphk#include <sys/kernel.h> 5192372Sphk#include <sys/conf.h> 5292372Sphk#include <sys/bio.h> 5392372Sphk#include <sys/malloc.h> 5492372Sphk#include <sys/lock.h> 5592372Sphk#include <sys/mutex.h> 5692372Sphk#endif 5792372Sphk#include <geom/geom.h> 5892372Sphk#include <geom/geom_slice.h> 5992372Sphk#include <machine/endian.h> 6092372Sphk 6197075Sphk#define SUNLABEL_CLASS_NAME "SUN" 6292372Sphk 6392372Sphkstruct g_sunlabel_softc { 64110183Sphk int sectorsize; 65106100Sphk int nheads; 66106100Sphk int nsects; 67106100Sphk int nalt; 6892372Sphk}; 6992372Sphk 7092372Sphkstatic int 71110183Sphkg_sunlabel_modify(struct g_geom *gp, struct g_sunlabel_softc *ms, u_char *sec0) 72110183Sphk{ 73110183Sphk int i, error; 74110183Sphk u_int u, v, csize; 75110183Sphk 76110183Sphk /* The second last short is a magic number */ 77113011Sphk if (be16dec(sec0 + 508) != 0xdabe) 78110183Sphk return (EBUSY); 79110183Sphk 80110183Sphk /* The shortword parity of the entire thing must be even */ 81110183Sphk u = 0; 82110183Sphk for (i = 0; i < 512; i += 2) 83113011Sphk u ^= be16dec(sec0 + i); 84110183Sphk if (u != 0) 85110183Sphk return(EBUSY); 86110183Sphk 87113011Sphk csize = be16dec(sec0 + 436) * be16dec(sec0 + 438); 88110183Sphk 89110183Sphk for (i = 0; i < 8; i++) { 90113011Sphk v = be32dec(sec0 + 444 + i * 8); 91113011Sphk u = be32dec(sec0 + 448 + i * 8); 92110183Sphk g_topology_lock(); 93110183Sphk error = g_slice_config(gp, i, G_SLICE_CONFIG_CHECK, 94110183Sphk ((off_t)v * csize) << 9ULL, 95110183Sphk ((off_t)u) << 9ULL, 96110183Sphk ms->sectorsize, 97110183Sphk "%s%c", gp->name, 'a' + i); 98110183Sphk g_topology_unlock(); 99110183Sphk if (error) 100110183Sphk return (error); 101110183Sphk } 102110183Sphk for (i = 0; i < 8; i++) { 103113011Sphk v = be32dec(sec0 + 444 + i * 8); 104113011Sphk u = be32dec(sec0 + 448 + i * 8); 105110183Sphk g_topology_lock(); 106110183Sphk g_slice_config(gp, i, G_SLICE_CONFIG_SET, 107110183Sphk ((off_t)v * csize) << 9ULL, 108110183Sphk ((off_t)u) << 9ULL, 109110183Sphk ms->sectorsize, 110110183Sphk "%s%c", gp->name, 'a' + i); 111110183Sphk g_topology_unlock(); 112110183Sphk } 113113011Sphk ms->nalt = be16dec(sec0 + 434); 114113011Sphk ms->nheads = be16dec(sec0 + 436); 115113011Sphk ms->nsects = be16dec(sec0 + 438); 116110183Sphk 117110183Sphk return (0); 118110183Sphk} 119110183Sphk 120110183Sphkstatic int 12192372Sphkg_sunlabel_start(struct bio *bp) 12292372Sphk{ 12392372Sphk struct g_geom *gp; 12492372Sphk struct g_sunlabel_softc *ms; 12592372Sphk struct g_slicer *gsp; 12692372Sphk 12792372Sphk gp = bp->bio_to->geom; 12892372Sphk gsp = gp->softc; 12992372Sphk ms = gsp->softc; 13092372Sphk return (0); 13192372Sphk} 13292372Sphk 13392372Sphkstatic void 134107953Sphkg_sunlabel_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, struct g_consumer *cp __unused, struct g_provider *pp) 13592372Sphk{ 136106100Sphk struct g_slicer *gsp; 137106100Sphk struct g_sunlabel_softc *ms; 13892372Sphk 139106100Sphk gsp = gp->softc; 140106100Sphk ms = gsp->softc; 14192372Sphk g_slice_dumpconf(sb, indent, gp, cp, pp); 142106100Sphk if (indent == NULL) { 143106100Sphk sbuf_printf(sb, " sc %u hd %u alt %u", 144106100Sphk ms->nsects, ms->nheads, ms->nalt); 145106100Sphk } 14692372Sphk} 14792372Sphk 14892372Sphkstatic struct g_geom * 14993250Sphkg_sunlabel_taste(struct g_class *mp, struct g_provider *pp, int flags) 15092372Sphk{ 15192372Sphk struct g_geom *gp; 15292372Sphk struct g_consumer *cp; 15394287Sphk int error, i, npart; 15492372Sphk u_char *buf; 15592372Sphk struct g_sunlabel_softc *ms; 15692372Sphk off_t mediasize; 15794287Sphk struct g_slicer *gsp; 15892372Sphk 15992372Sphk g_trace(G_T_TOPOLOGY, "g_sunlabel_taste(%s,%s)", mp->name, pp->name); 16092372Sphk g_topology_assert(); 16192372Sphk if (flags == G_TF_NORMAL && 16293358Sphk !strcmp(pp->geom->class->name, SUNLABEL_CLASS_NAME)) 16392372Sphk return (NULL); 16492372Sphk gp = g_slice_new(mp, 8, pp, &cp, &ms, sizeof *ms, g_sunlabel_start); 16592372Sphk if (gp == NULL) 16692372Sphk return (NULL); 16794287Sphk gsp = gp->softc; 16892372Sphk g_topology_unlock(); 16992372Sphk gp->dumpconf = g_sunlabel_dumpconf; 17092372Sphk npart = 0; 171110183Sphk do { /* a trick to allow us to use break */ 17292372Sphk if (gp->rank != 2 && flags == G_TF_NORMAL) 17392372Sphk break; 174110183Sphk ms->sectorsize = cp->provider->sectorsize; 175110183Sphk if (ms->sectorsize < 512) 176105551Sphk break; 177110183Sphk gsp->frontstuff = 16 * ms->sectorsize; 178105551Sphk mediasize = cp->provider->mediasize; 179110183Sphk buf = g_read_data(cp, 0, ms->sectorsize, &error); 18092372Sphk if (buf == NULL || error != 0) 18192372Sphk break; 18292372Sphk 18392372Sphk if (bootverbose) { 18492372Sphk g_hexdump(buf, 128); 18592372Sphk for (i = 0; i < 8; i++) { 18692372Sphk printf("part %d %u %u\n", i, 187113011Sphk be32dec(buf + 444 + i * 8), 188113011Sphk be32dec(buf + 448 + i * 8)); 18992372Sphk } 190113011Sphk printf("v_version = %d\n", be32dec(buf + 128)); 191113011Sphk printf("v_nparts = %d\n", be16dec(buf + 140)); 19292372Sphk for (i = 0; i < 8; i++) { 19392372Sphk printf("v_part[%d] = %d %d\n", 194113011Sphk i, be16dec(buf + 142 + i * 4), 195113011Sphk be16dec(buf + 144 + i * 4)); 19692372Sphk } 197113011Sphk printf("v_sanity %x\n", be32dec(buf + 186)); 198113011Sphk printf("v_version = %d\n", be32dec(buf + 128)); 199113011Sphk printf("v_rpm %d\n", be16dec(buf + 420)); 200113011Sphk printf("v_totalcyl %d\n", be16dec(buf + 422)); 201113011Sphk printf("v_cyl %d\n", be16dec(buf + 432)); 202113011Sphk printf("v_alt %d\n", be16dec(buf + 434)); 203113011Sphk printf("v_head %d\n", be16dec(buf + 436)); 204113011Sphk printf("v_sec %d\n", be16dec(buf + 438)); 20592372Sphk } 206110183Sphk 207110183Sphk g_sunlabel_modify(gp, ms, buf); 20892372Sphk 20992372Sphk break; 210110183Sphk } while (0); 21192372Sphk g_topology_lock(); 212107956Sphk g_access_rel(cp, -1, 0, 0); 213107956Sphk if (LIST_EMPTY(&gp->provider)) { 214107956Sphk g_std_spoiled(cp); 215107956Sphk return (NULL); 216110183Sphk#ifdef notyet 217110183Sphk } else { 218110183Sphk g_slice_conf_hot(gp, 0, 0, ms->sectorsize); 219110183Sphk#endif 220107956Sphk } 221107956Sphk return (gp); 22292372Sphk} 22392372Sphk 22493248Sphkstatic struct g_class g_sunlabel_class = { 225112552Sphk .name = SUNLABEL_CLASS_NAME, 226112552Sphk .taste = g_sunlabel_taste, 22798066Sphk G_CLASS_INITIALIZER 22892372Sphk}; 22992372Sphk 23093248SphkDECLARE_GEOM_CLASS(g_sunlabel_class, g_sunlabel); 231