0d5d0b20dc
- Use format-independant module allocator. - Conditionalise ISA PnP support. - Simplify PnP enumerator interface. - Improve module/object searching. - Add missing depend/install targets in BTX makefiles. - Pass the kernel environment and module data in extended bootinfo fields. - Add a pointer to the end of the kernel + modules in bootinfo. - Fix parsing of old-style kernel arguments.
281 lines
6.6 KiB
C
281 lines
6.6 KiB
C
/*
|
|
* mjs copyright
|
|
*/
|
|
/*
|
|
* "Plug and Play" functionality.
|
|
*
|
|
* We use the PnP enumerators to obtain identifiers for installed hardware,
|
|
* and the contents of a database to determine modules to be loaded to support
|
|
* such hardware.
|
|
*/
|
|
|
|
#include <stand.h>
|
|
#include <string.h>
|
|
#include <bootstrap.h>
|
|
|
|
static struct pnpinfo *pnp_devices = NULL;
|
|
|
|
static void pnp_discard(struct pnpinfo **list);
|
|
static int pnp_readconf(char *path);
|
|
static int pnp_scankernel(void);
|
|
|
|
/*
|
|
* Perform complete enumeration sweep, and load required module(s) if possible.
|
|
*/
|
|
|
|
COMMAND_SET(pnpscan, "pnpscan", "scan for PnP devices", pnp_scan);
|
|
|
|
int
|
|
pnp_scan(int argc, char *argv[])
|
|
{
|
|
int hdlr;
|
|
|
|
/* forget anything we think we knew */
|
|
pnp_discard(&pnp_devices);
|
|
|
|
/* iterate over all of the handlers */
|
|
for (hdlr = 0; pnphandlers[hdlr] != NULL; hdlr++) {
|
|
printf("Probing bus '%s'...\n", pnphandlers[hdlr]->pp_name);
|
|
pnphandlers[hdlr]->pp_enumerate(&pnp_devices);
|
|
}
|
|
return(CMD_OK);
|
|
}
|
|
|
|
/*
|
|
* Try to load outstanding modules (eg. after disk change)
|
|
*/
|
|
int
|
|
pnp_reload(char *fname)
|
|
{
|
|
struct pnpinfo *pi;
|
|
char *modfname;
|
|
|
|
/* find anything? */
|
|
if (pnp_devices != NULL) {
|
|
|
|
/* check for kernel, assign modules handled by static drivers there */
|
|
if (pnp_scankernel()) {
|
|
command_errmsg = "cannot load drivers until kernel loaded";
|
|
return(CMD_ERROR);
|
|
}
|
|
if (fname == NULL) {
|
|
/* default paths */
|
|
pnp_readconf("/boot/pnpdata.local");
|
|
pnp_readconf("/boot/pnpdata");
|
|
} else {
|
|
if (pnp_readconf("fname")) {
|
|
sprintf(command_errbuf, "can't read PnP information from '%s'", fname);
|
|
return(CMD_ERROR);
|
|
}
|
|
}
|
|
|
|
/* try to load any modules that have been nominated */
|
|
for (pi = pnp_devices; pi != NULL; pi = pi->pi_next) {
|
|
/* Already loaded? */
|
|
if ((pi->pi_module != NULL) && (mod_findmodule(pi->pi_module, NULL) == NULL)) {
|
|
modfname = malloc(strlen(pi->pi_module + 3));
|
|
sprintf(modfname, "%s.ko", pi->pi_module); /* XXX implicit knowledge of KLD module filenames */
|
|
if (mod_load(pi->pi_module, pi->pi_argc, pi->pi_argv))
|
|
printf("Could not load module '%s' for device '%s'\n", modfname, pi->pi_ident->id_ident);
|
|
free(modfname);
|
|
}
|
|
}
|
|
}
|
|
return(CMD_OK);
|
|
}
|
|
|
|
/*
|
|
* Throw away anything we think we know about PnP devices on (list)
|
|
*/
|
|
static void
|
|
pnp_discard(struct pnpinfo **list)
|
|
{
|
|
struct pnpinfo *pi;
|
|
struct pnpident *id;
|
|
|
|
while (*list != NULL) {
|
|
pi = *list;
|
|
*list = (*list)->pi_next;
|
|
while (pi->pi_ident) {
|
|
id = pi->pi_ident;
|
|
pi->pi_ident = pi->pi_ident->id_next;
|
|
free(id);
|
|
}
|
|
if (pi->pi_module)
|
|
free(pi->pi_module);
|
|
if (pi->pi_argv)
|
|
free(pi->pi_argv);
|
|
free(pi);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* The PnP configuration database consists of a flat text file with
|
|
* entries one per line. Valid lines are:
|
|
*
|
|
* # <text>
|
|
*
|
|
* This line is a comment, and ignored.
|
|
*
|
|
* [<name>]
|
|
*
|
|
* Entries following this line are for devices connected to the
|
|
* bus <name>, At least one such entry must be encountered
|
|
* before identifiers are recognised.
|
|
*
|
|
* ident=<identifier> rev=<revision> module=<module> args=<arguments>
|
|
*
|
|
* This line describes an identifier:module mapping. The 'ident'
|
|
* and 'module' fields are required; the 'rev' field is currently
|
|
* ignored (but should be used), and the 'args' field must come
|
|
* last.
|
|
*/
|
|
static int
|
|
pnp_readconf(char *path)
|
|
{
|
|
struct pnpinfo *pi;
|
|
struct pnpident *id;
|
|
int fd, line;
|
|
char lbuf[128], *currbus, *ident, *revision, *module, *args;
|
|
char *cp, *ep, *tp, c;
|
|
|
|
/* try to open the file */
|
|
if ((fd = open(path, O_RDONLY)) >= 0) {
|
|
line = 0;
|
|
currbus = NULL;
|
|
|
|
while (fgetstr(lbuf, sizeof(lbuf), fd) > 0) {
|
|
line++;
|
|
/* Find the first non-space character on the line */
|
|
for (cp = lbuf; (*cp != 0) && !isspace(*cp); cp++)
|
|
;
|
|
|
|
/* keep/discard? */
|
|
if ((*cp == 0) || (*cp == '#'))
|
|
continue;
|
|
|
|
/* bus declaration? */
|
|
if (*cp == '[') {
|
|
if (((ep = strchr(cp, ']')) == NULL) || ((ep - cp) < 2)) {
|
|
printf("%s line %d: bad bus specification\n", path, line);
|
|
} else {
|
|
if (currbus != NULL)
|
|
free(currbus);
|
|
*ep = 0;
|
|
currbus = strdup(cp + 1);
|
|
}
|
|
continue;
|
|
}
|
|
|
|
/* XXX should we complain? */
|
|
if (currbus == NULL)
|
|
continue;
|
|
|
|
/* mapping */
|
|
for (ident = module = args = revision = NULL; *cp != 0;) {
|
|
|
|
/* discard leading whitespace */
|
|
if (isspace(*cp)) {
|
|
cp++;
|
|
continue;
|
|
}
|
|
|
|
/* scan for terminator, separator */
|
|
for (ep = cp; (*ep != 0) && (*ep != '=') && !isspace(*ep); ep++)
|
|
;
|
|
|
|
if (*ep == '=') {
|
|
*ep = 0;
|
|
for (tp = ep + 1; (*tp != 0) && !isspace(*tp); tp++)
|
|
;
|
|
c = *tp;
|
|
*tp = 0;
|
|
if ((ident == NULL) && !strcmp(cp, "ident")) {
|
|
ident = ep + 1;
|
|
} else if ((revision == NULL) && !strcmp(cp, "revision")) {
|
|
revision = ep + 1;
|
|
} else if ((args == NULL) && !strcmp(cp, "args")) {
|
|
*tp = c;
|
|
while (*tp != 0) /* skip to end of string */
|
|
tp++;
|
|
args = ep + 1;
|
|
} else {
|
|
/* XXX complain? */
|
|
}
|
|
cp = tp;
|
|
continue;
|
|
}
|
|
|
|
/* it's garbage or a keyword - ignore it for now */
|
|
cp = ep;
|
|
}
|
|
|
|
/* we must have at least ident and module set */
|
|
if ((ident == NULL) || (module == NULL)) {
|
|
printf("%s line %d: bad mapping\n", path, line);
|
|
continue;
|
|
}
|
|
|
|
/*
|
|
* Loop looking for module/bus that might match this, but aren't already
|
|
* assigned.
|
|
* XXX no revision parse/test here yet.
|
|
*/
|
|
for (pi = pnp_devices; pi != NULL; pi = pi->pi_next) {
|
|
|
|
/* no driver assigned, bus matches OK */
|
|
if ((pi->pi_module == NULL) &&
|
|
!strcmp(pi->pi_handler->pp_name, currbus)) {
|
|
|
|
/* scan idents, take first match */
|
|
for (id = pi->pi_ident; id != NULL; id = id->id_next)
|
|
if (!strcmp(id->id_ident, ident))
|
|
break;
|
|
|
|
/* find a match? */
|
|
if (id != NULL) {
|
|
if (args != NULL)
|
|
if (parse(&pi->pi_argc, &pi->pi_argv, args)) {
|
|
printf("%s line %d: bad arguments\n", path, line);
|
|
continue;
|
|
}
|
|
pi->pi_module = strdup(module);
|
|
printf("use module '%s' for %s:%s\n", module, pi->pi_handler->pp_name, id->id_ident);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
close(fd);
|
|
}
|
|
return(CMD_OK);
|
|
}
|
|
|
|
static int
|
|
pnp_scankernel(void)
|
|
{
|
|
return(CMD_OK);
|
|
}
|
|
|
|
/*
|
|
* Add a unique identifier to (pi)
|
|
*/
|
|
void
|
|
pnp_addident(struct pnpinfo *pi, char *ident)
|
|
{
|
|
struct pnpident *id, **idp;
|
|
|
|
if (pi->pi_ident == NULL) {
|
|
idp = &(pi->pi_ident);
|
|
} else {
|
|
for (id = pi->pi_ident; id->id_next != NULL; id = id->id_next)
|
|
if (!strcmp(id->id_ident, ident))
|
|
return; /* already have this one */
|
|
;
|
|
idp = &(id->id_next);
|
|
}
|
|
*idp = malloc(sizeof(struct pnpident));
|
|
(*idp)->id_next = NULL;
|
|
(*idp)->id_ident = strdup(ident);
|
|
}
|
|
|