#include <sys/cdefs.h>
#include <lib/libsa/stand.h>
#include <lib/libsa/loadfile.h>
#include <lib/libkern/libkern.h>
#include <sys/param.h>
#include <sys/queue.h>
#include "bootstrap.h"
static int file_load(char *filename, vaddr_t dest, struct preloaded_file **result);
static int file_havepath(const char *name);
static void file_insert_tail(struct preloaded_file *mp);
static vaddr_t loadaddr = 0;
struct preloaded_file *preloaded_files = NULL;
int
command_load(int argc, char *argv[])
{
char *typestr;
int dofile, dokld, ch;
dokld = dofile = 0;
optind = 1;
optreset = 1;
typestr = NULL;
if (argc == 1) {
command_seterr("no filename specified");
return(CMD_ERROR);
}
while ((ch = getopt(argc, argv, "k:")) != -1) {
switch(ch) {
case 'k':
dokld = 1;
break;
case '?':
default:
return(CMD_OK);
}
}
argv += (optind - 1);
argc -= (optind - 1);
if (dokld || file_havepath(argv[1])) {
int error = file_loadkernel(argv[1], argc - 2, argv + 2);
if (error == EEXIST)
command_seterr("warning: KLD '%s' already loaded", argv[1]);
return error == 0 ? CMD_OK : CMD_ERROR;
}
return CMD_OK;
}
int
command_unload(int argc, char *argv[])
{
struct preloaded_file *fp;
while (preloaded_files != NULL) {
fp = preloaded_files;
preloaded_files = preloaded_files->f_next;
file_discard(fp);
}
loadaddr = 0;
unsetenv("kernelname");
return(CMD_OK);
}
int
command_lskern(int argc, char *argv[])
{
struct preloaded_file *fp;
char lbuf[80];
int ch, verbose;
verbose = 0;
optind = 1;
optreset = 1;
pager_open();
for (fp = preloaded_files; fp; fp = fp->f_next) {
snprintf(lbuf, sizeof(lbuf), " %p: %s (%s, 0x%lx)\n",
(void *) fp->f_addr, fp->f_name, fp->f_type, (long) fp->f_size);
pager_output(lbuf);
if (fp->f_args != NULL) {
pager_output(" args: ");
pager_output(fp->f_args);
pager_output("\n");
}
}
pager_close();
return(CMD_OK);
}
int
file_load(char *filename, vaddr_t dest, struct preloaded_file **result)
{
struct preloaded_file *fp;
int error;
int i;
error = EFTYPE;
for (i = 0, fp = NULL; file_formats[i] && fp == NULL; i++) {
error = (file_formats[i]->l_load)(filename, dest, &fp);
if (error == 0) {
fp->f_loader = i;
*result = fp;
break;
}
if (error == EFTYPE)
continue;
if (error) {
command_seterr("can't load file '%s': %s",
filename, strerror(error));
break;
}
}
return (error);
}
int
file_loadkernel(char *filename, int argc, char *argv[])
{
struct preloaded_file *fp, *last_file;
int err;
fp = file_findfile(filename, NULL);
if (fp) {
command_seterr("warning: KLD '%s' already loaded", filename);
free(filename);
return (0);
}
for (last_file = preloaded_files;
last_file != NULL && last_file->f_next != NULL;
last_file = last_file->f_next)
;
do {
err = file_load(filename, loadaddr, &fp);
if (err)
break;
fp->f_args = unargv(argc, argv);
loadaddr = fp->f_addr + fp->f_size;
file_insert_tail(fp);
} while(0);
if (err == EFTYPE)
command_seterr("don't know how to load module '%s'", filename);
if (err && fp)
file_discard(fp);
free(filename);
return (err);
}
struct preloaded_file *
file_findfile(char *name, char *type)
{
struct preloaded_file *fp;
for (fp = preloaded_files; fp != NULL; fp = fp->f_next) {
if (((name == NULL) || !strcmp(name, fp->f_name)) &&
((type == NULL) || !strcmp(type, fp->f_type)))
break;
}
return (fp);
}
static int
file_havepath(const char *name)
{
const char *cp;
archsw.arch_getdev(NULL, name, &cp);
return (cp != name || strchr(name, '/') != NULL);
}
void
file_discard(struct preloaded_file *fp)
{
if (fp == NULL)
return;
if (fp->f_name != NULL)
free(fp->f_name);
if (fp->f_type != NULL)
free(fp->f_type);
if (fp->f_args != NULL)
free(fp->f_args);
if (fp->marks != NULL)
free(fp->marks);
free(fp);
}
struct preloaded_file *
file_alloc(void)
{
struct preloaded_file *fp;
if ((fp = alloc(sizeof(struct preloaded_file))) != NULL) {
memset(fp, 0, sizeof(struct preloaded_file));
}
return (fp);
}
static void
file_insert_tail(struct preloaded_file *fp)
{
struct preloaded_file *cm;
fp->f_next = NULL;
if (preloaded_files == NULL) {
preloaded_files = fp;
} else {
for (cm = preloaded_files; cm->f_next != NULL; cm = cm->f_next)
;
cm->f_next = fp;
}
}