#include <lib/libsa/stand.h>
#include <lib/libkern/libkern.h>
#include "biosdisk.h"
#include "boot.h"
#include "bootinfo.h"
static int dev2bios(char *devname, unsigned int unit, int *biosdev);
static int devlookup(char *d);
static int
dev2bios(char *devname, unsigned int unit, int *biosdev)
{
if (strcmp(devname, "hd") == 0) {
if (unit == 0 || unit == 1) {
*biosdev = 0x40 + (unit << 4);
return (0);
}
}
return (ENXIO);
}
int
bios2dev(int biosdev, char **devname, u_int *unit, u_int sector, u_int *ptnp)
{
*devname = "hd";
*unit = (biosdev >> 4) & 1;
*ptnp = biosdisk_findptn(biosdev, sector);
return (0);
}
static int
devlookup(char *d)
{
struct devsw *dp = devsw;
int i;
for (i = 0; i < ndevs; i++, dp++) {
if ((dp->dv_name != NULL) && (strcmp(dp->dv_name, d) == 0)) {
return (i);
}
}
printf("No such device - Configured devices are:\n");
for (dp = devsw, i = 0; i < ndevs; i++, dp++) {
if (dp->dv_name != NULL) {
printf(" %s", dp->dv_name);
}
}
printf("\n");
return (-1);
}
int
devopen(struct open_file *f, const char *fname, char **file)
{
static struct btinfo_bootpath bibp;
struct devsw *dp;
char *devname;
unsigned int dev, ctlr, unit, partition;
int biosdev;
int error;
#if defined(DEBUG)
printf("devopen: fname = %s\n", fname);
#endif
ctlr = 0;
if ((error = parsebootfile(fname, &devname, &unit, &partition,
(const char **)file)) != 0) {
return (error);
}
#if defined(DEBUG)
printf("devopen: devname = %s\n", devname);
#endif
dev = devlookup(devname);
if (dev == -1) {
#if defined(DEBUG)
printf("devopen: devlookup failed\n");
#endif
return (ENXIO);
}
dp = &devsw[dev];
if (dp->dv_open == NULL) {
#if defined(DEBUG)
printf("devopen: dev->dv_open() == NULL\n");
#endif
return (ENODEV);
}
f->f_dev = dp;
strncpy(bibp.bootpath, *file, sizeof(bibp.bootpath));
BI_ADD(&bibp, BTINFO_BOOTPATH, sizeof(bibp));
if (dev2bios(devname, unit, &biosdev) == 0) {
#if defined(DEBUG)
printf("devopen: bios disk\n");
#endif
return (biosdisk_open(f, biosdev, partition));
}
#if defined(DEBUG)
printf("devopen: dev->dv_open()\n");
#endif
if ((error = (*dp->dv_open)(f, ctlr, unit, partition)) == 0) {
#if defined(DEBUG)
printf("devopen: dev->dv_open() opened\n");
#endif
return (0);
}
printf("%s%d%c:%s : %s\n", dp->dv_name, unit, partition + 'a', *file,
strerror(error));
return (error);
}