geom_sunlabel.c revision 152967
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 36116196Sobrien#include <sys/cdefs.h> 37116196Sobrien__FBSDID("$FreeBSD: head/sys/geom/geom_sunlabel.c 152967 2005-11-30 19:24:51Z sobomax $"); 3892372Sphk 3992372Sphk#include <sys/param.h> 40113011Sphk#include <sys/endian.h> 4192372Sphk#include <sys/systm.h> 4292372Sphk#include <sys/kernel.h> 4392372Sphk#include <sys/conf.h> 4492372Sphk#include <sys/bio.h> 4592372Sphk#include <sys/malloc.h> 4692372Sphk#include <sys/lock.h> 4792372Sphk#include <sys/mutex.h> 48144934Spjd#include <sys/md5.h> 49113819Sphk#include <sys/sun_disklabel.h> 5092372Sphk#include <geom/geom.h> 5192372Sphk#include <geom/geom_slice.h> 5292372Sphk#include <machine/endian.h> 5392372Sphk 5497075Sphk#define SUNLABEL_CLASS_NAME "SUN" 5592372Sphk 5692372Sphkstruct g_sunlabel_softc { 57110183Sphk int sectorsize; 58106100Sphk int nheads; 59106100Sphk int nsects; 60106100Sphk int nalt; 61144934Spjd u_char labelsum[16]; 6292372Sphk}; 6392372Sphk 6492372Sphkstatic int 65110183Sphkg_sunlabel_modify(struct g_geom *gp, struct g_sunlabel_softc *ms, u_char *sec0) 66110183Sphk{ 67110183Sphk int i, error; 68110183Sphk u_int u, v, csize; 69113819Sphk struct sun_disklabel sl; 70144934Spjd MD5_CTX md5sum; 71110183Sphk 72113819Sphk error = sunlabel_dec(sec0, &sl); 73113819Sphk if (error) 74113819Sphk return (error); 75110183Sphk 76113819Sphk csize = sl.sl_ntracks * sl.sl_nsectors; 77110183Sphk 78113819Sphk for (i = 0; i < SUN_NPART; i++) { 79113819Sphk v = sl.sl_part[i].sdkp_cyloffset; 80113819Sphk u = sl.sl_part[i].sdkp_nsectors; 81110183Sphk error = g_slice_config(gp, i, G_SLICE_CONFIG_CHECK, 82110183Sphk ((off_t)v * csize) << 9ULL, 83110183Sphk ((off_t)u) << 9ULL, 84110183Sphk ms->sectorsize, 85110183Sphk "%s%c", gp->name, 'a' + i); 86110183Sphk if (error) 87110183Sphk return (error); 88110183Sphk } 89113819Sphk for (i = 0; i < SUN_NPART; i++) { 90113819Sphk v = sl.sl_part[i].sdkp_cyloffset; 91113819Sphk u = sl.sl_part[i].sdkp_nsectors; 92110183Sphk g_slice_config(gp, i, G_SLICE_CONFIG_SET, 93110183Sphk ((off_t)v * csize) << 9ULL, 94110183Sphk ((off_t)u) << 9ULL, 95110183Sphk ms->sectorsize, 96110183Sphk "%s%c", gp->name, 'a' + i); 97110183Sphk } 98113819Sphk ms->nalt = sl.sl_acylinders; 99113819Sphk ms->nheads = sl.sl_ntracks; 100113819Sphk ms->nsects = sl.sl_nsectors; 101110183Sphk 102144934Spjd /* 103144934Spjd * Calculate MD5 from the first sector and use it for avoiding 104144934Spjd * recursive labels creation. 105144934Spjd */ 106144934Spjd MD5Init(&md5sum); 107144934Spjd MD5Update(&md5sum, sec0, ms->sectorsize); 108144934Spjd MD5Final(ms->labelsum, &md5sum); 109144934Spjd 110110183Sphk return (0); 111110183Sphk} 112110183Sphk 113113821Sphkstatic void 114113821Sphkg_sunlabel_hotwrite(void *arg, int flag) 115113821Sphk{ 116113821Sphk struct bio *bp; 117113821Sphk struct g_geom *gp; 118113821Sphk struct g_slicer *gsp; 119113821Sphk struct g_slice *gsl; 120113821Sphk struct g_sunlabel_softc *ms; 121113821Sphk u_char *p; 122113821Sphk int error; 123113821Sphk 124113821Sphk KASSERT(flag != EV_CANCEL, ("g_sunlabel_hotwrite cancelled")); 125113821Sphk bp = arg; 126113821Sphk gp = bp->bio_to->geom; 127113821Sphk gsp = gp->softc; 128113821Sphk ms = gsp->softc; 129113821Sphk gsl = &gsp->slices[bp->bio_to->index]; 130113821Sphk /* 131113821Sphk * XXX: For all practical purposes, this whould be equvivalent to 132113821Sphk * XXX: "p = (u_char *)bp->bio_data;" because the label is always 133113821Sphk * XXX: in the first sector and we refuse sectors smaller than the 134113821Sphk * XXX: label. 135113821Sphk */ 136113821Sphk p = (u_char *)bp->bio_data - (bp->bio_offset + gsl->offset); 137113821Sphk 138113821Sphk error = g_sunlabel_modify(gp, ms, p); 139113821Sphk if (error) { 140113821Sphk g_io_deliver(bp, EPERM); 141113821Sphk return; 142113821Sphk } 143113821Sphk g_slice_finish_hot(bp); 144113821Sphk} 145113821Sphk 14692372Sphkstatic void 147107953Sphkg_sunlabel_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, struct g_consumer *cp __unused, struct g_provider *pp) 14892372Sphk{ 149106100Sphk struct g_slicer *gsp; 150106100Sphk struct g_sunlabel_softc *ms; 15192372Sphk 152106100Sphk gsp = gp->softc; 153106100Sphk ms = gsp->softc; 15492372Sphk g_slice_dumpconf(sb, indent, gp, cp, pp); 155106100Sphk if (indent == NULL) { 156106100Sphk sbuf_printf(sb, " sc %u hd %u alt %u", 157106100Sphk ms->nsects, ms->nheads, ms->nalt); 158106100Sphk } 15992372Sphk} 16092372Sphk 161115512Sphkstruct g_hh01 { 162113895Sphk struct g_geom *gp; 163113895Sphk struct g_sunlabel_softc *ms; 164113895Sphk u_char *label; 165113895Sphk int error; 166113895Sphk}; 167113895Sphk 168113895Sphkstatic void 169113895Sphkg_sunlabel_callconfig(void *arg, int flag) 170113895Sphk{ 171115512Sphk struct g_hh01 *hp; 172113895Sphk 173113895Sphk hp = arg; 174113895Sphk hp->error = g_sunlabel_modify(hp->gp, hp->ms, hp->label); 175113895Sphk if (!hp->error) 176113895Sphk hp->error = g_write_data(LIST_FIRST(&hp->gp->consumer), 177113895Sphk 0, hp->label, SUN_SIZE); 178113895Sphk} 179113895Sphk 180113895Sphk/* 181113895Sphk * NB! curthread is user process which GCTL'ed. 182113895Sphk */ 183115624Sphkstatic void 184115624Sphkg_sunlabel_config(struct gctl_req *req, struct g_class *mp, const char *verb) 185113895Sphk{ 186113895Sphk u_char *label; 187113895Sphk int error, i; 188115512Sphk struct g_hh01 h0h0; 189113895Sphk struct g_slicer *gsp; 190115624Sphk struct g_geom *gp; 191113895Sphk struct g_consumer *cp; 192113895Sphk 193113895Sphk g_topology_assert(); 194115624Sphk gp = gctl_get_geom(req, mp, "geom"); 195115624Sphk if (gp == NULL) 196115624Sphk return; 197113895Sphk cp = LIST_FIRST(&gp->consumer); 198113895Sphk gsp = gp->softc; 199113895Sphk if (!strcmp(verb, "write label")) { 200113895Sphk label = gctl_get_paraml(req, "label", SUN_SIZE); 201113895Sphk if (label == NULL) 202115624Sphk return; 203113895Sphk h0h0.gp = gp; 204113895Sphk h0h0.ms = gsp->softc; 205113895Sphk h0h0.label = label; 206113895Sphk h0h0.error = -1; 207113895Sphk /* XXX: Does this reference register with our selfdestruct code ? */ 208125755Sphk error = g_access(cp, 1, 1, 1); 209114459Sphk if (error) { 210115624Sphk gctl_error(req, "could not access consumer"); 211115624Sphk return; 212114459Sphk } 213115624Sphk g_sunlabel_callconfig(&h0h0, 0); 214125755Sphk g_access(cp, -1, -1, -1); 215113895Sphk } else if (!strcmp(verb, "write bootcode")) { 216113895Sphk label = gctl_get_paraml(req, "bootcode", SUN_BOOTSIZE); 217113895Sphk if (label == NULL) 218115624Sphk return; 219113895Sphk /* XXX: Does this reference register with our selfdestruct code ? */ 220125755Sphk error = g_access(cp, 1, 1, 1); 221114459Sphk if (error) { 222115624Sphk gctl_error(req, "could not access consumer"); 223115624Sphk return; 224114459Sphk } 225113895Sphk for (i = 0; i < SUN_NPART; i++) { 226113895Sphk if (gsp->slices[i].length <= SUN_BOOTSIZE) 227113895Sphk continue; 228113895Sphk g_write_data(cp, 229113895Sphk gsp->slices[i].offset + SUN_SIZE, label + SUN_SIZE, 230113895Sphk SUN_BOOTSIZE - SUN_SIZE); 231113895Sphk } 232125755Sphk g_access(cp, -1, -1, -1); 233113895Sphk } else { 234115624Sphk gctl_error(req, "Unknown verb parameter"); 235113895Sphk } 236113895Sphk} 237113895Sphk 238144934Spjdstatic int 239144934Spjdg_sunlabel_start(struct bio *bp) 240144934Spjd{ 241144934Spjd struct g_sunlabel_softc *mp; 242144934Spjd struct g_slicer *gsp; 243144934Spjd 244144934Spjd gsp = bp->bio_to->geom->softc; 245144934Spjd mp = gsp->softc; 246144934Spjd if (bp->bio_cmd == BIO_GETATTR) { 247144934Spjd if (g_handleattr(bp, "SUN::labelsum", mp->labelsum, 248144934Spjd sizeof(mp->labelsum))) 249144934Spjd return (1); 250144934Spjd } 251144934Spjd return (0); 252144934Spjd} 253144934Spjd 25492372Sphkstatic struct g_geom * 25593250Sphkg_sunlabel_taste(struct g_class *mp, struct g_provider *pp, int flags) 25692372Sphk{ 25792372Sphk struct g_geom *gp; 25892372Sphk struct g_consumer *cp; 25992372Sphk struct g_sunlabel_softc *ms; 26094287Sphk struct g_slicer *gsp; 261144934Spjd u_char *buf, hash[16]; 262144934Spjd MD5_CTX md5sum; 263144934Spjd int error; 26492372Sphk 26592372Sphk g_trace(G_T_TOPOLOGY, "g_sunlabel_taste(%s,%s)", mp->name, pp->name); 26692372Sphk g_topology_assert(); 26792372Sphk if (flags == G_TF_NORMAL && 26893358Sphk !strcmp(pp->geom->class->name, SUNLABEL_CLASS_NAME)) 26992372Sphk return (NULL); 270144934Spjd gp = g_slice_new(mp, 8, pp, &cp, &ms, sizeof *ms, g_sunlabel_start); 27192372Sphk if (gp == NULL) 27292372Sphk return (NULL); 27394287Sphk gsp = gp->softc; 274113285Sphk do { 275110183Sphk ms->sectorsize = cp->provider->sectorsize; 276110183Sphk if (ms->sectorsize < 512) 277105551Sphk break; 278113880Sphk g_topology_unlock(); 279110183Sphk buf = g_read_data(cp, 0, ms->sectorsize, &error); 280113880Sphk g_topology_lock(); 281152967Ssobomax if (buf == NULL) 28292372Sphk break; 283144934Spjd 284144934Spjd /* 285144934Spjd * Calculate MD5 from the first sector and use it for avoiding 286144934Spjd * recursive labels creation. 287144934Spjd */ 288144934Spjd MD5Init(&md5sum); 289144934Spjd MD5Update(&md5sum, buf, ms->sectorsize); 290144934Spjd MD5Final(ms->labelsum, &md5sum); 291144934Spjd 292144934Spjd error = g_getattr("SUN::labelsum", cp, &hash); 293144934Spjd if (!error && !bcmp(ms->labelsum, hash, sizeof(hash))) { 294144934Spjd g_free(buf); 295144934Spjd break; 296144934Spjd } 297144934Spjd 298110183Sphk g_sunlabel_modify(gp, ms, buf); 299114459Sphk g_free(buf); 30092372Sphk 30192372Sphk break; 302110183Sphk } while (0); 303125755Sphk g_access(cp, -1, 0, 0); 304107956Sphk if (LIST_EMPTY(&gp->provider)) { 305114505Sphk g_slice_spoiled(cp); 306107956Sphk return (NULL); 307107956Sphk } 308114533Sphk g_slice_conf_hot(gp, 0, 0, SUN_SIZE, 309114533Sphk G_SLICE_HOT_ALLOW, G_SLICE_HOT_DENY, G_SLICE_HOT_CALL); 310114533Sphk gsp->hot = g_sunlabel_hotwrite; 311107956Sphk return (gp); 31292372Sphk} 31392372Sphk 31493248Sphkstatic struct g_class g_sunlabel_class = { 315112552Sphk .name = SUNLABEL_CLASS_NAME, 316133318Sphk .version = G_VERSION, 317112552Sphk .taste = g_sunlabel_taste, 318115624Sphk .ctlreq = g_sunlabel_config, 319133314Sphk .dumpconf = g_sunlabel_dumpconf, 32092372Sphk}; 32192372Sphk 32293248SphkDECLARE_GEOM_CLASS(g_sunlabel_class, g_sunlabel); 323