#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: dkwedge_rdb.c,v 1.8 2021/02/20 09:51:20 rin Exp $");
#include <sys/param.h>
#include <sys/buf.h>
#include <sys/disklabel_rdb.h>
#include <sys/disk.h>
#include <sys/endian.h>
#include <sys/systm.h>
#define SD_C_ADJUSTS_NR
#ifdef SD_C_ADJUSTS_NR
#define ADJUST_NR(x) ((x) * (secsize / DEV_BSIZE))
#else
#define ADJUST_NR(x) (x)
#endif
static unsigned rdbchksum(void *);
static unsigned char getarchtype(uint32_t);
static const char *archtype_to_ptype(uint8_t);
static int
dkwedge_discover_rdb(struct disk *pdk, struct vnode *vp)
{
struct dkwedge_info dkw;
struct partblock *pbp;
struct rdblock *rbp;
struct buf *bp;
int error;
uint32_t blk_per_cyl, bufsize, newsecsize, nextb, secsize, tabsize;
const char *ptype;
uint8_t archtype;
bool found, root, swap;
secsize = DEV_BSIZE << pdk->dk_blkshift;
bufsize = roundup(MAX(sizeof(struct partblock), sizeof(struct rdblock)),
secsize);
bp = geteblk(bufsize);
retry:
for (nextb = 0; nextb < RDB_MAXBLOCKS; nextb++) {
error = dkwedge_read(pdk, vp, ADJUST_NR(nextb), bp->b_data,
bufsize);
if (error) {
aprint_error("%s: unable to read RDB @ %u, "
"error = %d\n", pdk->dk_name, nextb, error);
error = ESRCH;
goto done;
}
rbp = (struct rdblock *)bp->b_data;
if (be32toh(rbp->id) == RDBLOCK_ID) {
if (rdbchksum(rbp) == 0)
break;
else
aprint_error("%s: RDB bad checksum @ %u\n",
pdk->dk_name, nextb);
}
}
if (nextb == RDB_MAXBLOCKS) {
error = ESRCH;
goto done;
}
newsecsize = be32toh(rbp->nbytes);
if (secsize != newsecsize) {
aprint_verbose("secsize changed from %u to %u\n",
secsize, newsecsize);
secsize = newsecsize;
bufsize = roundup(MAX(sizeof(struct partblock),
sizeof(struct rdblock)), secsize);
brelse(bp, 0);
bp = geteblk(bufsize);
goto retry;
}
memset(&dkw, 0, sizeof(dkw));
strlcpy(dkw.dkw_parent, pdk->dk_name, sizeof(dkw.dkw_parent));
found = root = swap = false;
for (nextb = be32toh(rbp->partbhead); nextb != RDBNULL;
nextb = be32toh(pbp->next)) {
error = dkwedge_read(pdk, vp, ADJUST_NR(nextb), bp->b_data,
bufsize);
if (error) {
aprint_error("%s: unable to read RDB partition block @ "
"%u, error = %d\n", pdk->dk_name, nextb, error);
error = ESRCH;
goto done;
}
pbp = (struct partblock *)bp->b_data;
if (be32toh(pbp->id) != PARTBLOCK_ID) {
aprint_error(
"%s: RDB partition block @ %u bad id\n",
pdk->dk_name, nextb);
error = ESRCH;
goto done;
}
if (rdbchksum(pbp)) {
aprint_error(
"%s: RDB partition block @ %u bad checksum\n",
pdk->dk_name, nextb);
error = ESRCH;
goto done;
}
tabsize = be32toh(pbp->e.tabsize);
if (tabsize < 11) {
aprint_error(
"%s: RDB partition block @ %u bad partition info "
"(environ < 11)\n",
pdk->dk_name, nextb);
error = ESRCH;
goto done;
}
if (tabsize >= 16)
archtype = getarchtype(be32toh(pbp->e.dostype));
else
archtype = ADT_UNKNOWN;
switch (archtype) {
case ADT_NETBSDROOT:
if (root) {
aprint_error("%s: more than one root RDB "
"partition, ignoring\n", pdk->dk_name);
continue;
}
root = true;
break;
case ADT_NETBSDSWAP:
if (swap) {
aprint_error("%s: more than one swap RDB "
"partition , ignoring\n", pdk->dk_name);
continue;
}
swap = true;
break;
default:
break;
}
if (pbp->partname[0] + 1 < sizeof(pbp->partname))
pbp->partname[pbp->partname[0] + 1] = 0;
else
pbp->partname[sizeof(pbp->partname) - 1] = 0;
strlcpy(dkw.dkw_wname, pbp->partname + 1,
sizeof(dkw.dkw_wname));
ptype = archtype_to_ptype(archtype);
strlcpy(dkw.dkw_ptype, ptype, sizeof(dkw.dkw_ptype));
blk_per_cyl =
be32toh(pbp->e.secpertrk) * be32toh(pbp->e.numheads)
* ((be32toh(pbp->e.sizeblock) << 2) / secsize);
dkw.dkw_size = (uint64_t)(be32toh(pbp->e.highcyl)
- be32toh(pbp->e.lowcyl) + 1) * blk_per_cyl;
dkw.dkw_offset = (daddr_t)be32toh(pbp->e.lowcyl) * blk_per_cyl;
error = dkwedge_add(&dkw);
if (error == EEXIST) {
aprint_error(
"%s: wedge named '%s' already exists, ignoring\n",
pdk->dk_name, dkw.dkw_wname);
} else if (error)
aprint_error("%s: error %d adding partition %s\n",
pdk->dk_name, error, dkw.dkw_wname);
else
found = true;
}
if (found)
error = 0;
else
error = ESRCH;
done:
brelse(bp, 0);
return error;
}
static uint32_t
rdbchksum(void *bdata)
{
uint32_t *blp, cnt, val;
blp = bdata;
cnt = be32toh(blp[1]);
val = 0;
while (cnt--)
val += be32toh(*blp++);
return val;
}
static uint8_t
getarchtype(uint32_t dostype)
{
uint32_t t3, b1;
t3 = dostype & 0xffffff00;
b1 = dostype & 0x000000ff;
switch (t3) {
case DOST_NBR:
return ADT_NETBSDROOT;
case DOST_NBS:
return ADT_NETBSDSWAP;
case DOST_NBU:
return ADT_NETBSDUSER;
case DOST_MUFS:
case DOST_DOS:
return ADT_AMIGADOS;
case DOST_AMIX:
return ADT_AMIX;
case DOST_XXXBSD:
#ifdef DIAGNOSTIC
aprint_verbose("deprecated dostype found: 0x%x\n",
dostype);
#endif
switch (b1) {
case 'R':
return ADT_NETBSDROOT;
case 'S':
return ADT_NETBSDSWAP;
default:
return ADT_NETBSDUSER;
}
case DOST_EXT2:
return ADT_EXT2;
case DOST_RAID:
return ADT_RAID;
default:
#ifdef DIAGNOSTIC
aprint_verbose("warning unknown dostype: 0x%x\n",
dostype);
#endif
return ADT_UNKNOWN;
}
}
static const char *
archtype_to_ptype(unsigned char archtype)
{
switch (archtype) {
case ADT_NETBSDROOT:
case ADT_NETBSDUSER:
return DKW_PTYPE_FFS;
case ADT_NETBSDSWAP:
return DKW_PTYPE_SWAP;
case ADT_AMIGADOS:
return DKW_PTYPE_AMIGADOS;
case ADT_EXT2:
return DKW_PTYPE_EXT2FS;
default:
return DKW_PTYPE_UNKNOWN;
}
}
#ifdef _KERNEL
DKWEDGE_DISCOVERY_METHOD_DECL(RDB, 15, dkwedge_discover_rdb);
#endif