#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: dk.c,v 1.175 2026/05/26 14:57:25 simonb Exp $");
#ifdef _KERNEL_OPT
#include "opt_dkwedge.h"
#endif
#include <sys/param.h>
#include <sys/types.h>
#include <sys/buf.h>
#include <sys/bufq.h>
#include <sys/callout.h>
#include <sys/conf.h>
#include <sys/device.h>
#include <sys/disk.h>
#include <sys/disklabel.h>
#include <sys/errno.h>
#include <sys/fcntl.h>
#include <sys/ioctl.h>
#include <sys/kauth.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/pool.h>
#include <sys/proc.h>
#include <sys/rwlock.h>
#include <sys/stat.h>
#include <sys/systm.h>
#include <sys/vnode.h>
#include <miscfs/specfs/specdev.h>
MALLOC_DEFINE(M_DKWEDGE, "dkwedge", "Disk wedge structures");
typedef enum {
DKW_STATE_LARVAL = 0,
DKW_STATE_RUNNING = 1,
DKW_STATE_DYING = 2,
DKW_STATE_DEAD = 666
} dkwedge_state_t;
struct dkwedge_softc {
device_t sc_dev;
struct cfdata sc_cfdata;
uint8_t sc_wname[128];
dkwedge_state_t sc_state;
struct disk *sc_parent;
daddr_t sc_offset;
krwlock_t sc_sizelock;
uint64_t sc_size;
char sc_ptype[32];
dev_t sc_pdev;
LIST_ENTRY(dkwedge_softc) sc_plink;
struct disk sc_dk;
struct bufq_state *sc_bufq;
struct callout sc_restart_ch;
kmutex_t sc_iolock;
bool sc_iostop;
int sc_mode;
};
static int dkwedge_match(device_t, cfdata_t, void *);
static void dkwedge_attach(device_t, device_t, void *);
static int dkwedge_detach(device_t, int);
static void dk_set_geometry(struct dkwedge_softc *, struct disk *);
static void dkstart(struct dkwedge_softc *);
static void dkiodone(struct buf *);
static void dkrestart(void *);
static void dkminphys(struct buf *);
static int dkfirstopen(struct dkwedge_softc *, int);
static void dklastclose(struct dkwedge_softc *);
static int dkwedge_detach(device_t, int);
static void dkwedge_delall1(struct disk *, bool);
static int dkwedge_del1(struct dkwedge_info *, int);
static int dk_open_parent(dev_t, int, struct vnode **);
static int dk_close_parent(struct vnode *, int);
static device_t dkwedge_rootspec_hook(const char *);
static void dkwedge_rootspec_print(void);
static void dkwedge_rootspec_noprint(void);
static dev_type_open(dkopen);
static dev_type_close(dkclose);
static dev_type_cancel(dkcancel);
static dev_type_read(dkread);
static dev_type_write(dkwrite);
static dev_type_ioctl(dkioctl);
static dev_type_strategy(dkstrategy);
static dev_type_dump(dkdump);
static dev_type_size(dksize);
static dev_type_discard(dkdiscard);
CFDRIVER_DECL(dk, DV_DISK, NULL);
CFATTACH_DECL3_NEW(dk, 0,
dkwedge_match, dkwedge_attach, dkwedge_detach, NULL, NULL, NULL,
DVF_DETACH_SHUTDOWN | DVF_NO_PARTITIONS);
const struct bdevsw dk_bdevsw = {
.d_open = dkopen,
.d_close = dkclose,
.d_cancel = dkcancel,
.d_strategy = dkstrategy,
.d_ioctl = dkioctl,
.d_dump = dkdump,
.d_psize = dksize,
.d_discard = dkdiscard,
.d_cfdriver = &dk_cd,
.d_devtounit = dev_minor_unit,
.d_flag = D_DISK | D_MPSAFE
};
const struct cdevsw dk_cdevsw = {
.d_open = dkopen,
.d_close = dkclose,
.d_cancel = dkcancel,
.d_read = dkread,
.d_write = dkwrite,
.d_ioctl = dkioctl,
.d_stop = nostop,
.d_tty = notty,
.d_poll = nopoll,
.d_mmap = nommap,
.d_kqfilter = nokqfilter,
.d_discard = dkdiscard,
.d_cfdriver = &dk_cd,
.d_devtounit = dev_minor_unit,
.d_flag = D_DISK | D_MPSAFE
};
static struct dkwedge_softc **dkwedges;
static u_int ndkwedges;
static krwlock_t dkwedges_lock;
static LIST_HEAD(, dkwedge_discovery_method) dkwedge_discovery_methods;
static krwlock_t dkwedge_discovery_methods_lock;
static int
dkwedge_match(device_t parent, cfdata_t match, void *aux)
{
return 1;
}
static void
dkwedge_attach(device_t parent, device_t self, void *aux)
{
struct dkwedge_softc *sc = aux;
struct disk *pdk = sc->sc_parent;
int unit = device_unit(self);
KASSERTMSG(unit >= 0, "unit=%d", unit);
if (!pmf_device_register(self, NULL, NULL))
aprint_error_dev(self, "couldn't establish power handler\n");
mutex_enter(&pdk->dk_openlock);
rw_enter(&dkwedges_lock, RW_WRITER);
KASSERTMSG(unit < ndkwedges, "unit=%d ndkwedges=%u", unit, ndkwedges);
KASSERTMSG(sc == dkwedges[unit], "sc=%p dkwedges[%d]=%p",
sc, unit, dkwedges[unit]);
KASSERTMSG(sc->sc_dev == NULL, "sc=%p sc->sc_dev=%p", sc, sc->sc_dev);
sc->sc_dev = self;
rw_exit(&dkwedges_lock);
mutex_exit(&pdk->dk_openlock);
disk_init(&sc->sc_dk, device_xname(sc->sc_dev), NULL);
mutex_enter(&pdk->dk_openlock);
dk_set_geometry(sc, pdk);
mutex_exit(&pdk->dk_openlock);
disk_attach(&sc->sc_dk);
device_set_private(self, sc);
sc->sc_state = DKW_STATE_RUNNING;
}
static int
dkwedge_compute_pdev(const char *pname, dev_t *pdevp, enum vtype type)
{
const char *name, *cp;
devmajor_t pmaj;
int punit;
char devname[16];
name = pname;
switch (type) {
case VBLK:
pmaj = devsw_name2blk(name, devname, sizeof(devname));
break;
case VCHR:
pmaj = devsw_name2chr(name, devname, sizeof(devname));
break;
default:
pmaj = NODEVMAJOR;
break;
}
if (pmaj == NODEVMAJOR)
return ENXIO;
name += strlen(devname);
for (cp = name, punit = 0; *cp >= '0' && *cp <= '9'; cp++)
punit = (punit * 10) + (*cp - '0');
if (cp == name) {
return ENXIO;
}
*pdevp = MAKEDISKDEV(pmaj, punit, RAW_PART);
return 0;
}
static int
dkwedge_array_expand(void)
{
const unsigned incr = 16;
unsigned newcnt, oldcnt;
struct dkwedge_softc **newarray = NULL, **oldarray = NULL;
KASSERT(rw_write_held(&dkwedges_lock));
oldcnt = ndkwedges;
oldarray = dkwedges;
if (oldcnt >= INT_MAX - incr)
return ENFILE;
newcnt = oldcnt + incr;
rw_exit(&dkwedges_lock);
newarray = malloc(newcnt * sizeof(*newarray), M_DKWEDGE,
M_WAITOK|M_ZERO);
rw_enter(&dkwedges_lock, RW_WRITER);
if (ndkwedges != oldcnt || dkwedges != oldarray) {
oldarray = NULL;
goto out;
}
if (oldarray != NULL)
memcpy(newarray, dkwedges, ndkwedges * sizeof(*newarray));
dkwedges = newarray;
newarray = NULL;
ndkwedges = newcnt;
out: rw_exit(&dkwedges_lock);
if (oldarray != NULL)
free(oldarray, M_DKWEDGE);
if (newarray != NULL)
free(newarray, M_DKWEDGE);
rw_enter(&dkwedges_lock, RW_WRITER);
return 0;
}
static void
dkwedge_size_init(struct dkwedge_softc *sc, uint64_t size)
{
rw_init(&sc->sc_sizelock);
sc->sc_size = size;
}
static void
dkwedge_size_fini(struct dkwedge_softc *sc)
{
rw_destroy(&sc->sc_sizelock);
}
static uint64_t
dkwedge_size(struct dkwedge_softc *sc)
{
uint64_t size;
rw_enter(&sc->sc_sizelock, RW_READER);
size = sc->sc_size;
rw_exit(&sc->sc_sizelock);
return size;
}
static void
dkwedge_size_increase(struct dkwedge_softc *sc, uint64_t size)
{
KASSERT(mutex_owned(&sc->sc_parent->dk_openlock));
rw_enter(&sc->sc_sizelock, RW_WRITER);
KASSERTMSG(size >= sc->sc_size,
"decreasing dkwedge size from %"PRIu64" to %"PRIu64,
sc->sc_size, size);
sc->sc_size = size;
rw_exit(&sc->sc_sizelock);
}
static void
dk_set_geometry(struct dkwedge_softc *sc, struct disk *pdk)
{
struct disk *dk = &sc->sc_dk;
struct disk_geom *dg = &dk->dk_geom;
uint32_t r, lspps;
KASSERT(mutex_owned(&pdk->dk_openlock));
memset(dg, 0, sizeof(*dg));
dg->dg_secperunit = dkwedge_size(sc);
dg->dg_secsize = DEV_BSIZE << pdk->dk_blkshift;
dg->dg_nsectors = 32;
dg->dg_ntracks = 64;
dg->dg_ncylinders =
dg->dg_secperunit / (dg->dg_nsectors * dg->dg_ntracks);
dg->dg_physsecsize = pdk->dk_geom.dg_physsecsize;
dg->dg_alignedsec = pdk->dk_geom.dg_alignedsec;
lspps = MAX(1u, dg->dg_physsecsize / dg->dg_secsize);
r = sc->sc_offset % lspps;
if (r > dg->dg_alignedsec)
dg->dg_alignedsec += lspps;
dg->dg_alignedsec -= r;
dg->dg_alignedsec %= lspps;
disk_set_info(sc->sc_dev, dk, NULL);
}
int
dkwedge_add(struct dkwedge_info *dkw)
{
struct dkwedge_softc *sc, *lsc;
struct disk *pdk;
u_int unit;
int error;
dev_t pdev;
device_t dev __diagused;
dkw->dkw_parent[sizeof(dkw->dkw_parent) - 1] = '\0';
pdk = disk_find(dkw->dkw_parent);
if (pdk == NULL)
return ENXIO;
error = dkwedge_compute_pdev(pdk->dk_name, &pdev, VBLK);
if (error)
return error;
if (dkw->dkw_offset < 0)
return EINVAL;
sc = NULL;
mutex_enter(&pdk->dk_openlock);
LIST_FOREACH(lsc, &pdk->dk_wedges, sc_plink) {
if (lsc->sc_offset != dkw->dkw_offset)
continue;
if (strcmp(lsc->sc_wname, dkw->dkw_wname) != 0)
break;
if (strcmp(lsc->sc_ptype, dkw->dkw_ptype) != 0)
break;
if (dkwedge_size(lsc) > dkw->dkw_size)
break;
if (lsc->sc_dev == NULL)
break;
sc = lsc;
device_acquire(sc->sc_dev);
dkwedge_size_increase(sc, dkw->dkw_size);
dk_set_geometry(sc, pdk);
break;
}
mutex_exit(&pdk->dk_openlock);
if (sc != NULL)
goto announce;
sc = malloc(sizeof(*sc), M_DKWEDGE, M_WAITOK|M_ZERO);
sc->sc_state = DKW_STATE_LARVAL;
sc->sc_parent = pdk;
sc->sc_pdev = pdev;
sc->sc_offset = dkw->dkw_offset;
dkwedge_size_init(sc, dkw->dkw_size);
memcpy(sc->sc_wname, dkw->dkw_wname, sizeof(sc->sc_wname));
sc->sc_wname[sizeof(sc->sc_wname) - 1] = '\0';
memcpy(sc->sc_ptype, dkw->dkw_ptype, sizeof(sc->sc_ptype));
sc->sc_ptype[sizeof(sc->sc_ptype) - 1] = '\0';
bufq_alloc(&sc->sc_bufq, "fcfs", 0);
callout_init(&sc->sc_restart_ch, 0);
callout_setfunc(&sc->sc_restart_ch, dkrestart, sc);
mutex_init(&sc->sc_iolock, MUTEX_DEFAULT, IPL_BIO);
mutex_enter(&pdk->dk_openlock);
if (pdk->dk_openmask & ~(1 << RAW_PART))
error = EBUSY;
else {
LIST_FOREACH(lsc, &pdk->dk_wedges, sc_plink) {
uint64_t size = dkwedge_size(sc);
uint64_t lsize = dkwedge_size(lsc);
daddr_t lastblk = sc->sc_offset + size - 1;
daddr_t llastblk = lsc->sc_offset + lsize - 1;
if (sc->sc_offset >= lsc->sc_offset &&
sc->sc_offset <= llastblk) {
break;
}
if (lastblk >= lsc->sc_offset &&
lastblk <= llastblk) {
break;
}
}
if (lsc != NULL) {
if (sc->sc_offset == lsc->sc_offset &&
dkwedge_size(sc) == dkwedge_size(lsc) &&
strcmp(sc->sc_wname, lsc->sc_wname) == 0)
error = EEXIST;
else
error = EINVAL;
} else {
pdk->dk_nwedges++;
LIST_INSERT_HEAD(&pdk->dk_wedges, sc, sc_plink);
}
}
mutex_exit(&pdk->dk_openlock);
if (error) {
mutex_destroy(&sc->sc_iolock);
bufq_free(sc->sc_bufq);
dkwedge_size_fini(sc);
free(sc, M_DKWEDGE);
return error;
}
sc->sc_cfdata.cf_name = dk_cd.cd_name;
sc->sc_cfdata.cf_atname = dk_ca.ca_name;
sc->sc_cfdata.cf_fstate = FSTATE_NOTFOUND;
rw_enter(&dkwedges_lock, RW_WRITER);
for (error = 0;;) {
struct dkwedge_softc **scpp;
for (scpp = NULL, unit = 0; unit < ndkwedges; unit++) {
if (dkwedges[unit] == NULL) {
if (scpp == NULL) {
scpp = &dkwedges[unit];
sc->sc_cfdata.cf_unit = unit;
}
} else {
if (strcmp(dkwedges[unit]->sc_wname,
sc->sc_wname) == 0) {
error = EEXIST;
break;
}
}
}
if (error)
break;
KASSERT(unit == ndkwedges);
if (scpp == NULL) {
error = dkwedge_array_expand();
if (error)
break;
} else {
KASSERT(scpp == &dkwedges[sc->sc_cfdata.cf_unit]);
*scpp = sc;
break;
}
}
rw_exit(&dkwedges_lock);
if (error) {
mutex_enter(&pdk->dk_openlock);
pdk->dk_nwedges--;
LIST_REMOVE(sc, sc_plink);
mutex_exit(&pdk->dk_openlock);
mutex_destroy(&sc->sc_iolock);
bufq_free(sc->sc_bufq);
dkwedge_size_fini(sc);
free(sc, M_DKWEDGE);
return error;
}
if ((dev = config_attach_pseudo_acquire(&sc->sc_cfdata, sc)) == NULL) {
aprint_error("%s%u: unable to attach pseudo-device\n",
sc->sc_cfdata.cf_name, sc->sc_cfdata.cf_unit);
rw_enter(&dkwedges_lock, RW_WRITER);
KASSERT(dkwedges[sc->sc_cfdata.cf_unit] == sc);
dkwedges[sc->sc_cfdata.cf_unit] = NULL;
rw_exit(&dkwedges_lock);
mutex_enter(&pdk->dk_openlock);
pdk->dk_nwedges--;
LIST_REMOVE(sc, sc_plink);
mutex_exit(&pdk->dk_openlock);
mutex_destroy(&sc->sc_iolock);
bufq_free(sc->sc_bufq);
dkwedge_size_fini(sc);
free(sc, M_DKWEDGE);
return ENOMEM;
}
KASSERT(dev == sc->sc_dev);
announce:
aprint_normal(
"%s at %s: \"%s\", %"PRIu64" blocks at %"PRId64", type: %s\n",
device_xname(sc->sc_dev), pdk->dk_name,
sc->sc_wname,
dkwedge_size(sc), sc->sc_offset,
sc->sc_ptype[0] == '\0' ? "<unknown>" : sc->sc_ptype);
strlcpy(dkw->dkw_devname, device_xname(sc->sc_dev),
sizeof(dkw->dkw_devname));
device_release(sc->sc_dev);
return 0;
}
static struct dkwedge_softc *
dkwedge_find_acquire(struct dkwedge_info *dkw, u_int *unitp)
{
struct dkwedge_softc *sc = NULL;
u_int unit;
dkw->dkw_devname[sizeof(dkw->dkw_devname) - 1] = '\0';
rw_enter(&dkwedges_lock, RW_READER);
for (unit = 0; unit < ndkwedges; unit++) {
if ((sc = dkwedges[unit]) != NULL &&
sc->sc_dev != NULL &&
strcmp(device_xname(sc->sc_dev), dkw->dkw_devname) == 0 &&
strcmp(sc->sc_parent->dk_name, dkw->dkw_parent) == 0) {
device_acquire(sc->sc_dev);
break;
}
}
rw_exit(&dkwedges_lock);
if (sc == NULL)
return NULL;
if (unitp != NULL)
*unitp = unit;
return sc;
}
int
dkwedge_del(struct dkwedge_info *dkw)
{
return dkwedge_del1(dkw, 0);
}
int
dkwedge_del1(struct dkwedge_info *dkw, int flags)
{
struct dkwedge_softc *sc = NULL;
if ((sc = dkwedge_find_acquire(dkw, NULL)) == NULL)
return ESRCH;
return config_detach_release(sc->sc_dev, flags);
}
static int
dkwedge_detach(device_t self, int flags)
{
struct dkwedge_softc *const sc = device_private(self);
const u_int unit = device_unit(self);
int bmaj, cmaj, error;
error = disk_begindetach(&sc->sc_dk, NULL, self, flags);
if (error)
return error;
sc->sc_state = DKW_STATE_DYING;
pmf_device_deregister(self);
mutex_enter(&sc->sc_iolock);
sc->sc_iostop = true;
mutex_exit(&sc->sc_iolock);
callout_halt(&sc->sc_restart_ch, NULL);
bmaj = bdevsw_lookup_major(&dk_bdevsw);
cmaj = cdevsw_lookup_major(&dk_cdevsw);
vdevgone(bmaj, unit, unit, VBLK);
vdevgone(cmaj, unit, unit, VCHR);
KASSERT(sc->sc_dk.dk_openmask == 0);
KASSERT(bufq_peek(sc->sc_bufq) == NULL);
bufq_drain(sc->sc_bufq);
aprint_normal("%s at %s (%s) deleted\n", device_xname(sc->sc_dev),
sc->sc_parent->dk_name,
sc->sc_wname);
mutex_enter(&sc->sc_parent->dk_openlock);
sc->sc_parent->dk_nwedges--;
LIST_REMOVE(sc, sc_plink);
mutex_exit(&sc->sc_parent->dk_openlock);
bufq_free(sc->sc_bufq);
disk_detach(&sc->sc_dk);
disk_destroy(&sc->sc_dk);
rw_enter(&dkwedges_lock, RW_WRITER);
KASSERT(dkwedges[unit] == sc);
dkwedges[unit] = NULL;
sc->sc_state = DKW_STATE_DEAD;
rw_exit(&dkwedges_lock);
mutex_destroy(&sc->sc_iolock);
dkwedge_size_fini(sc);
free(sc, M_DKWEDGE);
return 0;
}
void
dkwedge_delall(struct disk *pdk)
{
dkwedge_delall1(pdk, false);
}
void
dkwedge_delidle(struct disk *pdk)
{
dkwedge_delall1(pdk, true);
}
static void
dkwedge_delall1(struct disk *pdk, bool idleonly)
{
struct dkwedge_softc *sc;
int flags;
flags = DETACH_QUIET;
if (!idleonly)
flags |= DETACH_FORCE;
for (;;) {
mutex_enter(&pdk->dk_rawlock);
mutex_enter(&pdk->dk_openlock);
LIST_FOREACH(sc, &pdk->dk_wedges, sc_plink) {
if (sc->sc_dev == NULL)
continue;
if (!idleonly || sc->sc_dk.dk_openmask == 0) {
device_acquire(sc->sc_dev);
break;
}
}
if (sc == NULL) {
KASSERT(idleonly || pdk->dk_nwedges == 0);
mutex_exit(&pdk->dk_openlock);
mutex_exit(&pdk->dk_rawlock);
return;
}
mutex_exit(&pdk->dk_openlock);
mutex_exit(&pdk->dk_rawlock);
(void)config_detach_release(sc->sc_dev, flags);
}
}
int
dkwedge_list(struct disk *pdk, struct dkwedge_list *dkwl, struct lwp *l)
{
struct uio uio;
struct iovec iov;
struct dkwedge_softc *sc;
struct dkwedge_info dkw;
int error = 0;
iov.iov_base = dkwl->dkwl_buf;
iov.iov_len = dkwl->dkwl_bufsize;
uio.uio_iov = &iov;
uio.uio_iovcnt = 1;
uio.uio_offset = 0;
uio.uio_resid = dkwl->dkwl_bufsize;
uio.uio_rw = UIO_READ;
KASSERT(l == curlwp);
uio.uio_vmspace = l->l_proc->p_vmspace;
dkwl->dkwl_ncopied = 0;
mutex_enter(&pdk->dk_openlock);
LIST_FOREACH(sc, &pdk->dk_wedges, sc_plink) {
if (uio.uio_resid < sizeof(dkw))
break;
if (sc->sc_dev == NULL)
continue;
strlcpy(dkw.dkw_devname, device_xname(sc->sc_dev),
sizeof(dkw.dkw_devname));
memcpy(dkw.dkw_wname, sc->sc_wname, sizeof(dkw.dkw_wname));
dkw.dkw_wname[sizeof(dkw.dkw_wname) - 1] = '\0';
strlcpy(dkw.dkw_parent, sc->sc_parent->dk_name,
sizeof(dkw.dkw_parent));
dkw.dkw_offset = sc->sc_offset;
dkw.dkw_size = dkwedge_size(sc);
strlcpy(dkw.dkw_ptype, sc->sc_ptype, sizeof(dkw.dkw_ptype));
device_acquire(sc->sc_dev);
mutex_exit(&pdk->dk_openlock);
error = uiomove(&dkw, sizeof(dkw), &uio);
mutex_enter(&pdk->dk_openlock);
device_release(sc->sc_dev);
if (error)
break;
dkwl->dkwl_ncopied++;
}
dkwl->dkwl_nwedges = pdk->dk_nwedges;
mutex_exit(&pdk->dk_openlock);
return error;
}
static device_t
dkwedge_find_by_wname_acquire(const char *wname)
{
device_t dv = NULL;
struct dkwedge_softc *sc;
int i;
rw_enter(&dkwedges_lock, RW_READER);
for (i = 0; i < ndkwedges; i++) {
if ((sc = dkwedges[i]) == NULL || sc->sc_dev == NULL)
continue;
if (strcmp(sc->sc_wname, wname) == 0) {
if (dv != NULL) {
printf(
"WARNING: double match for wedge name %s "
"(%s, %s)\n", wname, device_xname(dv),
device_xname(sc->sc_dev));
continue;
}
device_acquire(sc->sc_dev);
dv = sc->sc_dev;
}
}
rw_exit(&dkwedges_lock);
return dv;
}
static device_t
dkwedge_find_by_parent_acquire(const char *name, size_t *i)
{
rw_enter(&dkwedges_lock, RW_READER);
for (; *i < (size_t)ndkwedges; (*i)++) {
struct dkwedge_softc *sc;
if ((sc = dkwedges[*i]) == NULL || sc->sc_dev == NULL)
continue;
if (strcmp(sc->sc_parent->dk_name, name) != 0)
continue;
device_acquire(sc->sc_dev);
rw_exit(&dkwedges_lock);
return sc->sc_dev;
}
rw_exit(&dkwedges_lock);
return NULL;
}
device_t
dkwedge_find_by_wname(const char *wname)
{
device_t dv;
if ((dv = dkwedge_find_by_wname_acquire(wname)) == NULL)
return NULL;
device_release(dv);
return dv;
}
device_t
dkwedge_find_by_parent(const char *name, size_t *i)
{
device_t dv;
if ((dv = dkwedge_find_by_parent_acquire(name, i)) == NULL)
return NULL;
device_release(dv);
return dv;
}
static device_t
dkwedge_rootspec_hook(const char *spec)
{
device_t dv;
dv = dkwedge_find_by_wname(spec);
return dv;
}
static void
dkwedge_rootspec_print(void)
{
struct dkwedge_softc *sc;
int i;
rw_enter(&dkwedges_lock, RW_READER);
for (i = 0; i < ndkwedges; i++) {
if ((sc = dkwedges[i]) == NULL || sc->sc_dev == NULL)
continue;
printf(" wedge:%s", sc->sc_wname);
}
rw_exit(&dkwedges_lock);
}
static void
dkwedge_rootspec_noprint(void)
{
}
static struct dkwedge_discovery_method dummy_discovery_method;
__link_set_add_bss(dkwedge_methods, dummy_discovery_method);
void
dkwedge_init(void)
{
__link_set_decl(dkwedge_methods, struct dkwedge_discovery_method);
struct dkwedge_discovery_method * const *ddmp;
struct dkwedge_discovery_method *lddm, *ddm;
rw_init(&dkwedges_lock);
rw_init(&dkwedge_discovery_methods_lock);
if (config_cfdriver_attach(&dk_cd) != 0)
panic("dkwedge: unable to attach cfdriver");
if (config_cfattach_attach(dk_cd.cd_name, &dk_ca) != 0)
panic("dkwedge: unable to attach cfattach");
rw_enter(&dkwedge_discovery_methods_lock, RW_WRITER);
LIST_INIT(&dkwedge_discovery_methods);
__link_set_foreach(ddmp, dkwedge_methods) {
ddm = *ddmp;
if (ddm == &dummy_discovery_method)
continue;
if (LIST_EMPTY(&dkwedge_discovery_methods)) {
LIST_INSERT_HEAD(&dkwedge_discovery_methods,
ddm, ddm_list);
continue;
}
LIST_FOREACH(lddm, &dkwedge_discovery_methods, ddm_list) {
if (ddm->ddm_priority == lddm->ddm_priority) {
aprint_error("dk-method-%s: method \"%s\" "
"already exists at priority %d\n",
ddm->ddm_name, lddm->ddm_name,
lddm->ddm_priority);
break;
}
if (ddm->ddm_priority < lddm->ddm_priority) {
LIST_INSERT_BEFORE(lddm, ddm, ddm_list);
break;
}
if (LIST_NEXT(lddm, ddm_list) == NULL) {
KASSERT(lddm->ddm_priority < ddm->ddm_priority);
LIST_INSERT_AFTER(lddm, ddm, ddm_list);
break;
}
}
}
rw_exit(&dkwedge_discovery_methods_lock);
rootspechook_establish("wedge:", dkwedge_rootspec_hook,
dkwedge_rootspec_print);
rootspechook_establish("NAME=", dkwedge_rootspec_hook,
dkwedge_rootspec_noprint);
}
#ifdef DKWEDGE_AUTODISCOVER
int dkwedge_autodiscover = 1;
#else
int dkwedge_autodiscover = 0;
#endif
void
dkwedge_discover(struct disk *pdk)
{
struct dkwedge_discovery_method *ddm;
struct vnode *vp;
int error;
dev_t pdev;
if (dkwedge_autodiscover == 0)
return;
rw_enter(&dkwedge_discovery_methods_lock, RW_READER);
error = dkwedge_compute_pdev(pdk->dk_name, &pdev, VCHR);
if (error) {
aprint_error("%s: unable to compute pdev, error = %d\n",
pdk->dk_name, error);
goto out;
}
error = cdevvp(pdev, &vp);
if (error) {
aprint_error("%s: unable to find vnode for pdev, error = %d\n",
pdk->dk_name, error);
goto out;
}
error = vn_lock(vp, LK_EXCLUSIVE | LK_RETRY);
if (error) {
aprint_error("%s: unable to lock vnode for pdev, error = %d\n",
pdk->dk_name, error);
vrele(vp);
goto out;
}
error = VOP_OPEN(vp, FREAD | FSILENT, NOCRED);
if (error) {
if (error != ENXIO)
aprint_error("%s: unable to open device, error = %d\n",
pdk->dk_name, error);
vput(vp);
goto out;
}
VOP_UNLOCK(vp);
dkwedge_delidle(pdk);
LIST_FOREACH(ddm, &dkwedge_discovery_methods, ddm_list) {
error = (*ddm->ddm_discover)(pdk, vp);
if (error == 0) {
break;
}
}
error = vn_close(vp, FREAD, NOCRED);
if (error) {
aprint_error("%s: unable to close device, error = %d\n",
pdk->dk_name, error);
}
out:
rw_exit(&dkwedge_discovery_methods_lock);
}
int
dkwedge_read(struct disk *pdk, struct vnode *vp, daddr_t blkno,
void *tbuf, size_t len)
{
buf_t *bp;
int error;
bool isopen;
dev_t bdev;
struct vnode *bdvp;
bdev = devsw_chr2blk(vp->v_rdev);
mutex_enter(&pdk->dk_rawlock);
if (pdk->dk_rawopens != 0) {
KASSERT(pdk->dk_rawvp != NULL);
isopen = true;
++pdk->dk_rawopens;
bdvp = pdk->dk_rawvp;
error = 0;
} else {
isopen = false;
error = dk_open_parent(bdev, FREAD, &bdvp);
}
mutex_exit(&pdk->dk_rawlock);
if (error)
return error;
bp = getiobuf(bdvp, true);
bp->b_flags = B_READ;
bp->b_cflags = BC_BUSY;
bp->b_dev = bdev;
bp->b_data = tbuf;
bp->b_bufsize = bp->b_bcount = len;
bp->b_blkno = blkno;
bp->b_cylinder = 0;
bp->b_error = 0;
VOP_STRATEGY(bdvp, bp);
error = biowait(bp);
putiobuf(bp);
mutex_enter(&pdk->dk_rawlock);
if (isopen) {
--pdk->dk_rawopens;
} else {
dk_close_parent(bdvp, FREAD);
}
mutex_exit(&pdk->dk_rawlock);
return error;
}
static struct dkwedge_softc *
dkwedge_lookup(dev_t dev)
{
return device_lookup_private(&dk_cd, minor(dev));
}
static struct dkwedge_softc *
dkwedge_lookup_acquire(dev_t dev)
{
device_t dv = device_lookup_acquire(&dk_cd, minor(dev));
if (dv == NULL)
return NULL;
return device_private(dv);
}
static int
dk_open_parent(dev_t dev, int mode, struct vnode **vpp)
{
struct vnode *vp;
int error;
error = bdevvp(dev, &vp);
if (error)
return error;
error = vn_lock(vp, LK_EXCLUSIVE | LK_RETRY);
if (error) {
vrele(vp);
return error;
}
error = VOP_OPEN(vp, mode, NOCRED);
if (error) {
vput(vp);
return error;
}
if (mode & FWRITE) {
mutex_enter(vp->v_interlock);
vp->v_writecount++;
mutex_exit(vp->v_interlock);
}
VOP_UNLOCK(vp);
*vpp = vp;
return 0;
}
static int
dk_close_parent(struct vnode *vp, int mode)
{
int error;
error = vn_close(vp, mode, NOCRED);
return error;
}
static int
dkopen(dev_t dev, int flags, int fmt, struct lwp *l)
{
struct dkwedge_softc *sc = dkwedge_lookup(dev);
int error = 0;
if (sc == NULL)
return ENXIO;
KASSERT(sc->sc_dev != NULL);
KASSERT(sc->sc_state == DKW_STATE_RUNNING);
mutex_enter(&sc->sc_dk.dk_openlock);
mutex_enter(&sc->sc_parent->dk_rawlock);
if (sc->sc_dk.dk_openmask == 0) {
error = dkfirstopen(sc, flags);
if (error)
goto out;
} else if (flags & ~sc->sc_mode & FWRITE) {
error = EROFS;
goto out;
}
KASSERT(sc->sc_mode != 0);
KASSERTMSG(sc->sc_mode & FREAD, "%s: sc_mode=%x",
device_xname(sc->sc_dev), sc->sc_mode);
KASSERTMSG((flags & FWRITE) ? (sc->sc_mode & FWRITE) : 1,
"%s: flags=%x sc_mode=%x",
device_xname(sc->sc_dev), flags, sc->sc_mode);
if (fmt == S_IFCHR)
sc->sc_dk.dk_copenmask |= 1;
else
sc->sc_dk.dk_bopenmask |= 1;
sc->sc_dk.dk_openmask =
sc->sc_dk.dk_copenmask | sc->sc_dk.dk_bopenmask;
out: mutex_exit(&sc->sc_parent->dk_rawlock);
mutex_exit(&sc->sc_dk.dk_openlock);
return error;
}
static int
dkfirstopen(struct dkwedge_softc *sc, int flags)
{
struct dkwedge_softc *nsc;
struct vnode *vp;
int mode;
int error;
KASSERT(mutex_owned(&sc->sc_dk.dk_openlock));
KASSERT(mutex_owned(&sc->sc_parent->dk_rawlock));
if (sc->sc_parent->dk_rawopens == 0) {
KASSERT(sc->sc_parent->dk_rawvp == NULL);
mode = FREAD | FWRITE;
error = dk_open_parent(sc->sc_pdev, mode, &vp);
if (error == EROFS && (flags & FWRITE) == 0) {
mode &= ~FWRITE;
error = dk_open_parent(sc->sc_pdev, mode, &vp);
}
if (error)
return error;
KASSERT(vp != NULL);
sc->sc_parent->dk_rawvp = vp;
} else {
KASSERT(sc->sc_parent->dk_rawopens < UINT_MAX);
KASSERT(sc->sc_parent->dk_rawvp != NULL);
mode = 0;
mutex_enter(&sc->sc_parent->dk_openlock);
LIST_FOREACH(nsc, &sc->sc_parent->dk_wedges, sc_plink) {
if (nsc == sc || nsc->sc_dk.dk_openmask == 0)
continue;
mode = nsc->sc_mode;
break;
}
mutex_exit(&sc->sc_parent->dk_openlock);
}
sc->sc_mode = mode;
sc->sc_parent->dk_rawopens++;
return 0;
}
static void
dklastclose(struct dkwedge_softc *sc)
{
KASSERT(mutex_owned(&sc->sc_dk.dk_openlock));
KASSERT(mutex_owned(&sc->sc_parent->dk_rawlock));
KASSERT(sc->sc_parent->dk_rawopens > 0);
KASSERT(sc->sc_parent->dk_rawvp != NULL);
if (--sc->sc_parent->dk_rawopens == 0) {
struct vnode *const vp = sc->sc_parent->dk_rawvp;
const int mode = sc->sc_mode;
sc->sc_parent->dk_rawvp = NULL;
sc->sc_mode = 0;
dk_close_parent(vp, mode);
}
}
static int
dkclose(dev_t dev, int flags, int fmt, struct lwp *l)
{
struct dkwedge_softc *sc = dkwedge_lookup(dev);
if (sc == NULL)
return ENXIO;
KASSERT(sc->sc_dev != NULL);
KASSERT(sc->sc_state != DKW_STATE_LARVAL);
KASSERT(sc->sc_state != DKW_STATE_DEAD);
mutex_enter(&sc->sc_dk.dk_openlock);
mutex_enter(&sc->sc_parent->dk_rawlock);
KASSERT(sc->sc_dk.dk_openmask != 0);
if (fmt == S_IFCHR)
sc->sc_dk.dk_copenmask &= ~1;
else
sc->sc_dk.dk_bopenmask &= ~1;
sc->sc_dk.dk_openmask =
sc->sc_dk.dk_copenmask | sc->sc_dk.dk_bopenmask;
if (sc->sc_dk.dk_openmask == 0) {
dklastclose(sc);
}
mutex_exit(&sc->sc_parent->dk_rawlock);
mutex_exit(&sc->sc_dk.dk_openlock);
return 0;
}
static int
dkcancel(dev_t dev, int flags, int fmt, struct lwp *l)
{
struct dkwedge_softc *sc = dkwedge_lookup(dev);
KASSERT(sc != NULL);
KASSERT(sc->sc_dev != NULL);
KASSERT(sc->sc_state != DKW_STATE_LARVAL);
KASSERT(sc->sc_state != DKW_STATE_DEAD);
return 0;
}
static void
dkstrategy(struct buf *bp)
{
struct dkwedge_softc *sc = dkwedge_lookup(bp->b_dev);
uint64_t p_size, p_offset;
KASSERT(sc != NULL);
KASSERT(sc->sc_dev != NULL);
KASSERT(sc->sc_state != DKW_STATE_LARVAL);
KASSERT(sc->sc_state != DKW_STATE_DEAD);
KASSERT(sc->sc_parent->dk_rawvp != NULL);
if (bp->b_bcount == 0)
goto done;
p_offset = sc->sc_offset << sc->sc_parent->dk_blkshift;
p_size = dkwedge_size(sc) << sc->sc_parent->dk_blkshift;
if (bounds_check_with_mediasize(bp, DEV_BSIZE, p_size) <= 0)
goto done;
bp->b_rawblkno = bp->b_blkno + p_offset;
mutex_enter(&sc->sc_iolock);
disk_wait(&sc->sc_dk);
bufq_put(sc->sc_bufq, bp);
mutex_exit(&sc->sc_iolock);
dkstart(sc);
return;
done:
bp->b_resid = bp->b_bcount;
biodone(bp);
}
static void
dkstart(struct dkwedge_softc *sc)
{
struct vnode *vp;
struct buf *bp, *nbp;
mutex_enter(&sc->sc_iolock);
while ((bp = bufq_peek(sc->sc_bufq)) != NULL) {
if (sc->sc_iostop) {
(void) bufq_get(sc->sc_bufq);
mutex_exit(&sc->sc_iolock);
bp->b_error = ENXIO;
bp->b_resid = bp->b_bcount;
biodone(bp);
mutex_enter(&sc->sc_iolock);
continue;
}
mutex_exit(&sc->sc_iolock);
nbp = getiobuf(sc->sc_parent->dk_rawvp, false);
mutex_enter(&sc->sc_iolock);
if (nbp == NULL) {
if (!sc->sc_iostop)
callout_schedule(&sc->sc_restart_ch, hz/2);
break;
}
bp = bufq_get(sc->sc_bufq);
if (bp == NULL) {
mutex_exit(&sc->sc_iolock);
putiobuf(nbp);
mutex_enter(&sc->sc_iolock);
continue;
}
disk_busy(&sc->sc_dk);
mutex_exit(&sc->sc_iolock);
nbp->b_data = bp->b_data;
nbp->b_flags = bp->b_flags;
nbp->b_oflags = bp->b_oflags;
nbp->b_cflags = bp->b_cflags;
nbp->b_iodone = dkiodone;
nbp->b_proc = bp->b_proc;
nbp->b_blkno = bp->b_rawblkno;
nbp->b_dev = sc->sc_parent->dk_rawvp->v_rdev;
nbp->b_bcount = bp->b_bcount;
nbp->b_private = bp;
BIO_COPYPRIO(nbp, bp);
vp = nbp->b_vp;
if ((nbp->b_flags & B_READ) == 0) {
mutex_enter(vp->v_interlock);
vp->v_numoutput++;
mutex_exit(vp->v_interlock);
}
VOP_STRATEGY(vp, nbp);
mutex_enter(&sc->sc_iolock);
}
mutex_exit(&sc->sc_iolock);
}
static void
dkiodone(struct buf *bp)
{
struct buf *obp = bp->b_private;
struct dkwedge_softc *sc = dkwedge_lookup(obp->b_dev);
KASSERT(sc != NULL);
KASSERT(sc->sc_dev != NULL);
if (bp->b_error != 0)
obp->b_error = bp->b_error;
obp->b_resid = bp->b_resid;
putiobuf(bp);
mutex_enter(&sc->sc_iolock);
disk_unbusy(&sc->sc_dk, obp->b_bcount - obp->b_resid,
obp->b_flags & B_READ);
mutex_exit(&sc->sc_iolock);
biodone(obp);
dkstart(sc);
}
static void
dkrestart(void *v)
{
struct dkwedge_softc *sc = v;
dkstart(sc);
}
static void
dkminphys(struct buf *bp)
{
struct dkwedge_softc *sc = dkwedge_lookup(bp->b_dev);
dev_t dev;
KASSERT(sc != NULL);
KASSERT(sc->sc_dev != NULL);
dev = bp->b_dev;
bp->b_dev = sc->sc_pdev;
if (sc->sc_parent->dk_driver && sc->sc_parent->dk_driver->d_minphys)
(*sc->sc_parent->dk_driver->d_minphys)(bp);
else
minphys(bp);
bp->b_dev = dev;
}
static int
dkread(dev_t dev, struct uio *uio, int flags)
{
struct dkwedge_softc *sc __diagused = dkwedge_lookup(dev);
KASSERT(sc != NULL);
KASSERT(sc->sc_dev != NULL);
KASSERT(sc->sc_state != DKW_STATE_LARVAL);
KASSERT(sc->sc_state != DKW_STATE_DEAD);
return physio(dkstrategy, NULL, dev, B_READ, dkminphys, uio);
}
static int
dkwrite(dev_t dev, struct uio *uio, int flags)
{
struct dkwedge_softc *sc __diagused = dkwedge_lookup(dev);
KASSERT(sc != NULL);
KASSERT(sc->sc_dev != NULL);
KASSERT(sc->sc_state != DKW_STATE_LARVAL);
KASSERT(sc->sc_state != DKW_STATE_DEAD);
return physio(dkstrategy, NULL, dev, B_WRITE, dkminphys, uio);
}
static int
dkioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
{
struct dkwedge_softc *sc = dkwedge_lookup(dev);
int error = 0;
KASSERT(sc != NULL);
KASSERT(sc->sc_dev != NULL);
KASSERT(sc->sc_state != DKW_STATE_LARVAL);
KASSERT(sc->sc_state != DKW_STATE_DEAD);
KASSERT(sc->sc_parent->dk_rawvp != NULL);
error = disk_ioctl(&sc->sc_dk, NODEV, cmd, data, flag, l);
if (error != EPASSTHROUGH)
return error;
error = 0;
switch (cmd) {
case DIOCGSTRATEGY:
case DIOCGCACHE:
case DIOCCACHESYNC:
error = VOP_IOCTL(sc->sc_parent->dk_rawvp, cmd, data, flag,
l != NULL ? l->l_cred : NOCRED);
break;
case DIOCGWEDGEINFO: {
struct dkwedge_info *dkw = data;
strlcpy(dkw->dkw_devname, device_xname(sc->sc_dev),
sizeof(dkw->dkw_devname));
memcpy(dkw->dkw_wname, sc->sc_wname, sizeof(dkw->dkw_wname));
dkw->dkw_wname[sizeof(dkw->dkw_wname) - 1] = '\0';
strlcpy(dkw->dkw_parent, sc->sc_parent->dk_name,
sizeof(dkw->dkw_parent));
dkw->dkw_offset = sc->sc_offset;
dkw->dkw_size = dkwedge_size(sc);
strlcpy(dkw->dkw_ptype, sc->sc_ptype, sizeof(dkw->dkw_ptype));
break;
}
case DIOCGSECTORALIGN: {
struct disk_sectoralign *dsa = data;
uint32_t r;
error = VOP_IOCTL(sc->sc_parent->dk_rawvp, cmd, dsa, flag,
l != NULL ? l->l_cred : NOCRED);
if (error)
break;
r = sc->sc_offset % dsa->dsa_alignment;
if (r < dsa->dsa_firstaligned)
dsa->dsa_firstaligned = dsa->dsa_firstaligned - r;
else
dsa->dsa_firstaligned = (dsa->dsa_firstaligned +
dsa->dsa_alignment) - r;
dsa->dsa_firstaligned %= dsa->dsa_alignment;
break;
}
default:
error = ENOTTY;
}
return error;
}
static int
dkdiscard(dev_t dev, off_t pos, off_t len)
{
struct dkwedge_softc *sc = dkwedge_lookup(dev);
uint64_t size = dkwedge_size(sc);
unsigned shift;
off_t offset, maxlen;
int error;
KASSERT(sc != NULL);
KASSERT(sc->sc_dev != NULL);
KASSERT(sc->sc_state != DKW_STATE_LARVAL);
KASSERT(sc->sc_state != DKW_STATE_DEAD);
KASSERT(sc->sc_parent->dk_rawvp != NULL);
shift = (sc->sc_parent->dk_blkshift + DEV_BSHIFT);
KASSERT(__type_fit(off_t, size));
KASSERT(__type_fit(off_t, sc->sc_offset));
KASSERT(0 <= sc->sc_offset);
KASSERT(size <= (__type_max(off_t) >> shift));
KASSERT(sc->sc_offset <= ((__type_max(off_t) >> shift) - size));
offset = ((off_t)sc->sc_offset << shift);
maxlen = ((off_t)size << shift);
if (len > maxlen)
return EINVAL;
if (pos > (maxlen - len))
return EINVAL;
pos += offset;
vn_lock(sc->sc_parent->dk_rawvp, LK_EXCLUSIVE | LK_RETRY);
error = VOP_FDISCARD(sc->sc_parent->dk_rawvp, pos, len);
VOP_UNLOCK(sc->sc_parent->dk_rawvp);
return error;
}
static int
dksize(dev_t dev)
{
struct dkwedge_softc *sc = dkwedge_lookup(dev);
uint64_t p_size;
int rv = -1;
if (sc == NULL)
return -1;
if (sc->sc_state != DKW_STATE_RUNNING)
return -1;
p_size = dkwedge_size(sc) << sc->sc_parent->dk_blkshift;
if (strcmp(sc->sc_ptype, DKW_PTYPE_SWAP) == 0) {
if (p_size > INT_MAX)
rv = INT_MAX;
else
rv = (int)p_size;
}
return rv;
}
static int
dkdump(dev_t dev, daddr_t blkno, void *va, size_t size)
{
struct dkwedge_softc *sc = dkwedge_lookup(dev);
const struct bdevsw *bdev;
uint64_t p_size, p_offset;
if (sc == NULL)
return ENXIO;
if (sc->sc_state != DKW_STATE_RUNNING)
return ENXIO;
if (strcmp(sc->sc_ptype, DKW_PTYPE_SWAP) != 0 &&
strcmp(sc->sc_ptype, DKW_PTYPE_RAID) != 0 &&
strcmp(sc->sc_ptype, DKW_PTYPE_CGD) != 0)
return ENXIO;
if (size % DEV_BSIZE != 0)
return EINVAL;
p_offset = sc->sc_offset << sc->sc_parent->dk_blkshift;
p_size = dkwedge_size(sc) << sc->sc_parent->dk_blkshift;
if (blkno < 0 || blkno + size/DEV_BSIZE > p_size) {
printf("%s: blkno (%" PRIu64 ") + size / DEV_BSIZE (%zu) > "
"p_size (%" PRIu64 ")\n", __func__, blkno,
size/DEV_BSIZE, p_size);
return EINVAL;
}
bdev = bdevsw_lookup(sc->sc_pdev);
return (*bdev->d_dump)(sc->sc_pdev, blkno + p_offset, va, size);
}
static device_t
dkwedge_find_partition_acquire(device_t parent, daddr_t startblk,
uint64_t nblks)
{
struct dkwedge_softc *sc;
int i;
device_t wedge = NULL;
rw_enter(&dkwedges_lock, RW_READER);
for (i = 0; i < ndkwedges; i++) {
if ((sc = dkwedges[i]) == NULL || sc->sc_dev == NULL)
continue;
if (strcmp(sc->sc_parent->dk_name, device_xname(parent)) == 0 &&
sc->sc_offset == startblk &&
dkwedge_size(sc) == nblks) {
if (wedge) {
printf("WARNING: double match for boot wedge "
"(%s, %s)\n",
device_xname(wedge),
device_xname(sc->sc_dev));
continue;
}
wedge = sc->sc_dev;
device_acquire(wedge);
}
}
rw_exit(&dkwedges_lock);
return wedge;
}
device_t
dkwedge_find_partition(device_t parent, daddr_t startblk,
uint64_t nblks)
{
device_t dv;
if ((dv = dkwedge_find_partition_acquire(parent, startblk, nblks))
== NULL)
return NULL;
device_release(dv);
return dv;
}
const char *
dkwedge_get_parent_name(dev_t dev)
{
int bmaj = bdevsw_lookup_major(&dk_bdevsw);
int cmaj = cdevsw_lookup_major(&dk_cdevsw);
if (major(dev) != bmaj && major(dev) != cmaj)
return NULL;
struct dkwedge_softc *const sc = dkwedge_lookup_acquire(dev);
if (sc == NULL)
return NULL;
const char *const name = sc->sc_parent->dk_name;
device_release(sc->sc_dev);
return name;
}