99 lines
1.8 KiB
C
99 lines
1.8 KiB
C
|
#include <stdio.h>
|
||
|
|
#include <string.h>
|
||
|
|
#include <fcntl.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
#include <malloc.h>
|
||
|
|
#include <errno.h>
|
||
|
|
#include <sys/types.h>
|
||
|
|
#include <sys/stat.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
|
||
|
|
extern int init_module(void *, unsigned long, const char *);
|
||
|
|
|
||
|
|
static void *read_file(const char *filename, ssize_t *_size)
|
||
|
|
{
|
||
|
|
int ret, fd;
|
||
|
|
struct stat sb;
|
||
|
|
ssize_t size;
|
||
|
|
void *buffer = NULL;
|
||
|
|
|
||
|
|
/* open the file */
|
||
|
|
fd = open(filename, O_RDONLY);
|
||
|
|
if (fd < 0)
|
||
|
|
return NULL;
|
||
|
|
|
||
|
|
/* find out how big it is */
|
||
|
|
if (fstat(fd, &sb) < 0)
|
||
|
|
goto bail;
|
||
|
|
size = sb.st_size;
|
||
|
|
|
||
|
|
/* allocate memory for it to be read into */
|
||
|
|
buffer = malloc(size);
|
||
|
|
if (!buffer)
|
||
|
|
goto bail;
|
||
|
|
|
||
|
|
/* slurp it into our buffer */
|
||
|
|
ret = read(fd, buffer, size);
|
||
|
|
if (ret != size)
|
||
|
|
goto bail;
|
||
|
|
|
||
|
|
/* let the caller know how big it is */
|
||
|
|
*_size = size;
|
||
|
|
|
||
|
|
bail:
|
||
|
|
close(fd);
|
||
|
|
return buffer;
|
||
|
|
}
|
||
|
|
|
||
|
|
#define min(x,y) ((x) < (y) ? (x) : (y))
|
||
|
|
int insmod_main(int argc, char **argv)
|
||
|
|
{
|
||
|
|
void *file;
|
||
|
|
ssize_t size = 0;
|
||
|
|
char opts[1024];
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
/* make sure we've got an argument */
|
||
|
|
if (argc < 2) {
|
||
|
|
fprintf(stderr, "usage: insmod <module.o>\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* read the file into memory */
|
||
|
|
file = read_file(argv[1], &size);
|
||
|
|
if (!file) {
|
||
|
|
fprintf(stderr, "insmod: can't open '%s'\n", argv[1]);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
opts[0] = '\0';
|
||
|
|
if (argc > 2) {
|
||
|
|
int i, len;
|
||
|
|
char *end = opts + sizeof(opts) - 1;
|
||
|
|
char *ptr = opts;
|
||
|
|
|
||
|
|
for (i = 2; (i < argc) && (ptr < end); i++) {
|
||
|
|
len = min(strlen(argv[i]), end - ptr);
|
||
|
|
memcpy(ptr, argv[i], len);
|
||
|
|
ptr += len;
|
||
|
|
*ptr++ = ' ';
|
||
|
|
*ptr++ = '\0';
|
||
|
|
}
|
||
|
|
*(ptr - 1) = '\0';
|
||
|
|
}
|
||
|
|
|
||
|
|
/* pass it to the kernel */
|
||
|
|
ret = init_module(file, size, opts);
|
||
|
|
if (ret != 0) {
|
||
|
|
fprintf(stderr,
|
||
|
|
"insmod: init_module '%s' failed (%s)\n",
|
||
|
|
argv[1], strerror(errno));
|
||
|
|
}
|
||
|
|
|
||
|
|
/* free the file buffer */
|
||
|
|
free(file);
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|