#include <sys/param.h>
#include <sys/reboot.h>
#include "stand.h"
int
nodev(void)
{
return (ENXIO);
}
void
nullsys(void)
{
}
int
noioctl(struct open_file *f __unused, u_long cmd __unused, void *data __unused)
{
return (EINVAL);
}
char *
devformat(struct devdesc *d)
{
static char name[DEV_DEVLEN];
if (d->d_dev->dv_fmtdev != NULL)
return (d->d_dev->dv_fmtdev(d));
snprintf(name, sizeof(name), "%s%d:", d->d_dev->dv_name, d->d_unit);
return (name);
}
static int
default_parsedev(struct devdesc **dev, const char *devspec,
const char **path)
{
struct devdesc *idev;
int unit, err;
char *cp;
idev = malloc(sizeof(struct devdesc));
if (idev == NULL)
return (ENOMEM);
unit = 0;
cp = (char *)devspec;
if (*devspec != '\0' && *devspec != ':') {
errno = 0;
unit = strtol(devspec, &cp, 0);
if (errno != 0 || cp == devspec) {
err = EUNIT;
goto fail;
}
}
if (*cp != '\0' && *cp != ':') {
err = EINVAL;
goto fail;
}
idev->d_unit = unit;
if (path != NULL)
*path = (*cp == 0) ? cp : cp + 1;
*dev = idev;
return (0);
fail:
free(idev);
return (err);
}
int
devparse(struct devdesc **dev, const char *devspec, const char **path)
{
struct devdesc *idev;
struct devsw *dv;
int i, err;
const char *np;
if (strlen(devspec) < 2)
return (EINVAL);
for (i = 0; devsw[i] != NULL; i++) {
dv = devsw[i];
if (dv->dv_match != NULL) {
if (dv->dv_match(dv, devspec) != 0)
break;
} else {
if (!strncmp(devspec, dv->dv_name, strlen(dv->dv_name)))
break;
}
}
if (devsw[i] == NULL)
return (ENOENT);
idev = NULL;
err = 0;
if (dv->dv_parsedev) {
err = dv->dv_parsedev(&idev, devspec, path);
} else {
np = devspec + strlen(dv->dv_name);
err = default_parsedev(&idev, np, path);
}
if (err != 0)
return (err);
idev->d_dev = dv;
if (dev != NULL)
*dev = idev;
else
free(idev);
return (0);
}
int
devinit(void)
{
int err = 0;
for (int i = 0; devsw[i] != NULL; i++) {
if (devsw[i]->dv_init != NULL) {
if ((devsw[i]->dv_init)() != 0) {
err++;
}
}
}
return (err);
}
void
dev_cleanup(void)
{
int i;
for (i = 0; devsw[i] != NULL; ++i)
if (devsw[i]->dv_cleanup != NULL)
(devsw[i]->dv_cleanup)();
}