#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: dkwedge_bsdlabel.c,v 1.26 2026/01/05 11:00:01 nia Exp $");
#include <sys/param.h>
#include <sys/endian.h>
#ifdef _KERNEL
#include <sys/systm.h>
#endif
#include <sys/proc.h>
#include <sys/errno.h>
#include <sys/disk.h>
#include <sys/vnode.h>
#include <sys/buf.h>
#include <sys/bootblock.h>
#include <sys/disklabel.h>
#define BSD44_MBR_LABELSECTOR 1
#define DISKLABEL_SIZE(x) \
(offsetof(struct disklabel, d_partitions) + \
(sizeof(struct partition) * (x)))
#define DISKLABEL_MINSIZE DISKLABEL_SIZE(8)
static const struct disklabel_location {
daddr_t label_sector;
size_t label_offset;
} disklabel_locations[] = {
{ 0, 0 },
{ 0, 64 },
{ 0, 128 },
{ 1, 0 },
{ 2, 0 },
{ -1, 0 },
};
#define SCAN_CONTINUE 0
#define SCAN_FOUND 1
#define SCAN_ERROR 2
typedef struct mbr_args {
struct disk *pdk;
struct vnode *vp;
struct buf *bp;
int error;
uint32_t secsize;
} mbr_args_t;
static const char *
bsdlabel_fstype_to_str(uint8_t fstype)
{
const char *str;
switch (fstype) {
#define FSTYPE_TO_STR_CASE(tag, number, name, fsck, mount) \
case __CONCAT(FS_,tag): str = __CONCAT(DKW_PTYPE_,tag); break;
FSTYPE_DEFN(FSTYPE_TO_STR_CASE)
#undef FSTYPE_TO_STR_CASE
default: str = NULL; break;
}
return (str);
}
static void
swap_disklabel(struct disklabel *lp)
{
int i;
#define SWAP16(x) lp->x = bswap16(lp->x)
#define SWAP32(x) lp->x = bswap32(lp->x)
SWAP32(d_magic);
SWAP16(d_type);
SWAP16(d_subtype);
SWAP32(d_secsize);
SWAP32(d_nsectors);
SWAP32(d_ntracks);
SWAP32(d_ncylinders);
SWAP32(d_secpercyl);
SWAP32(d_secperunit);
SWAP16(d_sparespertrack);
SWAP16(d_sparespercyl);
SWAP32(d_acylinders);
SWAP16(d_rpm);
SWAP16(d_interleave);
SWAP16(d_trackskew);
SWAP16(d_cylskew);
SWAP32(d_headswitch);
SWAP32(d_trkseek);
SWAP32(d_flags);
for (i = 0; i < NDDATA; i++)
SWAP32(d_drivedata[i]);
for (i = 0; i < NSPARE; i++)
SWAP32(d_spare[i]);
SWAP32(d_magic2);
SWAP16(d_checksum);
SWAP16(d_npartitions);
SWAP32(d_bbsize);
SWAP32(d_sbsize);
for (i = 0; i < lp->d_npartitions; i++) {
SWAP32(d_partitions[i].p_size);
SWAP32(d_partitions[i].p_offset);
SWAP32(d_partitions[i].p_fsize);
SWAP16(d_partitions[i].p_cpg);
}
#undef SWAP16
#undef SWAP32
}
static void
addwedges(const mbr_args_t *a, const struct disklabel *lp)
{
int error, i;
for (i = 0; i < lp->d_npartitions; i++) {
struct dkwedge_info dkw;
const struct partition *p;
const char *ptype;
p = &lp->d_partitions[i];
if (p->p_fstype == FS_UNUSED)
continue;
memset(&dkw, 0, sizeof(dkw));
ptype = bsdlabel_fstype_to_str(p->p_fstype);
if (ptype == NULL)
snprintf(dkw.dkw_ptype, sizeof(dkw.dkw_ptype),
"unknown#%u", p->p_fstype);
else
strlcpy(dkw.dkw_ptype, ptype, sizeof(dkw.dkw_ptype));
strlcpy(dkw.dkw_parent, a->pdk->dk_name,
sizeof(dkw.dkw_parent));
dkw.dkw_offset = p->p_offset;
dkw.dkw_size = p->p_size;
if (lp->d_packname[0] &&
strcmp(lp->d_packname,"fictitious") != 0) {
snprintf((char *)&dkw.dkw_wname, sizeof(dkw.dkw_wname),
"%.*s/%c", (int)sizeof(dkw.dkw_wname)-3,
lp->d_packname, 'a' + i);
} else {
snprintf((char *)&dkw.dkw_wname, sizeof(dkw.dkw_wname),
"%s%c", a->pdk->dk_name, 'a' + i);
}
error = dkwedge_add(&dkw);
if (error == EEXIST)
aprint_error("%s: wedge named '%s' already "
"exists, manual intervention required\n",
a->pdk->dk_name, dkw.dkw_wname);
else if (error)
aprint_error("%s: error %d adding partition "
"%d type %d\n", a->pdk->dk_name, error,
i, p->p_fstype);
}
}
static int
validate_label(mbr_args_t *a, daddr_t label_sector, size_t label_offset)
{
struct disklabel *lp;
void *lp_lim;
int error, swapped;
uint16_t npartitions;
error = dkwedge_read(a->pdk, a->vp, label_sector, a->bp->b_data,
a->secsize);
if (error) {
aprint_error("%s: unable to read BSD disklabel @ %" PRId64
", error = %d\n", a->pdk->dk_name, label_sector, error);
a->error = error;
return (SCAN_ERROR);
}
lp = a->bp->b_data;
lp_lim = (char *)a->bp->b_data + a->secsize - DISKLABEL_MINSIZE;
for (;; lp = (void *)((char *)lp + sizeof(uint32_t))) {
if ((char *)lp > (char *)lp_lim)
return (SCAN_CONTINUE);
label_offset = (size_t)((char *)lp - (char *)a->bp->b_data);
if (lp->d_magic != DISKMAGIC || lp->d_magic2 != DISKMAGIC) {
if (lp->d_magic != bswap32(DISKMAGIC) ||
lp->d_magic2 != bswap32(DISKMAGIC))
continue;
swapped = 1;
} else
swapped = 0;
npartitions = (swapped) ? bswap16(lp->d_npartitions)
: lp->d_npartitions;
if ((char *)lp + DISKLABEL_SIZE(npartitions) >
(char *)a->bp->b_data + a->secsize) {
aprint_error("%s: BSD disklabel @ "
"%" PRId64 "+%zd has bogus partition count (%u)\n",
a->pdk->dk_name, label_sector, label_offset,
npartitions);
continue;
}
if (dkcksum_sized(lp, npartitions) != 0) {
aprint_error("%s: BSD disklabel @ %" PRId64
"+%zd has bad checksum\n", a->pdk->dk_name,
label_sector, label_offset);
continue;
}
if (swapped)
swap_disklabel(lp);
addwedges(a, lp);
return (SCAN_FOUND);
}
}
static int
scan_mbr(mbr_args_t *a, int (*actn)(mbr_args_t *, struct mbr_partition *,
int, u_int))
{
struct mbr_partition ptns[MBR_PART_COUNT];
struct mbr_partition *dp;
struct mbr_sector *mbr;
u_int ext_base, this_ext, next_ext;
int i, rval;
#ifdef COMPAT_386BSD_MBRPART
int dp_386bsd = -1;
#endif
ext_base = 0;
this_ext = 0;
for (;;) {
a->error = dkwedge_read(a->pdk, a->vp, this_ext, a->bp->b_data,
a->secsize);
if (a->error) {
aprint_error("%s: unable to read MBR @ %u, "
"error = %d\n", a->pdk->dk_name, this_ext,
a->error);
return (SCAN_ERROR);
}
mbr = a->bp->b_data;
if (mbr->mbr_magic != htole16(MBR_MAGIC))
return (SCAN_CONTINUE);
memcpy(ptns, &mbr->mbr_parts, sizeof(ptns));
next_ext = 0;
dp = ptns;
for (i = 0; i < MBR_PART_COUNT; i++, dp++) {
if (dp->mbrp_type == 0)
continue;
if (MBR_IS_EXTENDED(dp->mbrp_type)) {
next_ext = le32toh(dp->mbrp_start);
continue;
}
#ifdef COMPAT_386BSD_MBRPART
if (dp->mbrp_type == MBR_PTYPE_386BSD) {
if (this_ext == 0)
dp_386bsd = i;
continue;
}
#endif
rval = (*actn)(a, dp, i, this_ext);
if (rval != SCAN_CONTINUE)
return (rval);
}
if (next_ext == 0)
break;
if (ext_base == 0) {
ext_base = next_ext;
next_ext = 0;
}
next_ext += ext_base;
if (next_ext <= this_ext)
break;
this_ext = next_ext;
}
#ifdef COMPAT_386BSD_MBRPART
if (this_ext == 0 && dp_386bsd != -1)
return ((*actn)(a, &ptns[dp_386bsd], dp_386bsd, 0));
#endif
return (SCAN_CONTINUE);
}
static int
look_netbsd_part(mbr_args_t *a, struct mbr_partition *dp, int slot,
u_int ext_base)
{
int ptn_base = ext_base + le32toh(dp->mbrp_start);
int rval;
if (
#ifdef COMPAT_386BSD_MBRPART
dp->mbrp_type == MBR_PTYPE_386BSD ||
#endif
dp->mbrp_type == MBR_PTYPE_NETBSD) {
rval = validate_label(a, ptn_base + BSD44_MBR_LABELSECTOR, 0);
if (rval == SCAN_FOUND)
return (rval);
}
return (SCAN_CONTINUE);
}
static int
dkwedge_discover_bsdlabel(struct disk *pdk, struct vnode *vp)
{
mbr_args_t a;
const struct disklabel_location *dl;
int rval;
a.pdk = pdk;
a.secsize = DEV_BSIZE << pdk->dk_blkshift;
a.vp = vp;
a.bp = geteblk(a.secsize);
a.error = 0;
rval = scan_mbr(&a, look_netbsd_part);
if (rval != SCAN_CONTINUE) {
if (rval == SCAN_FOUND)
a.error = 0;
goto out;
}
for (dl = disklabel_locations; dl->label_sector != -1; dl++) {
rval = validate_label(&a, dl->label_sector, dl->label_offset);
if (rval != SCAN_CONTINUE) {
if (rval == SCAN_FOUND)
a.error = 0;
goto out;
}
}
a.error = ESRCH;
out:
brelse(a.bp, 0);
return (a.error);
}
#ifdef _KERNEL
DKWEDGE_DISCOVERY_METHOD_DECL(BSD44, 5, dkwedge_discover_bsdlabel);
#endif