aboutsummaryrefslogtreecommitdiffstats
path: root/com32/elflink/test_com32.c
blob: 639e0b3338d51cdbf0cb30dfb734a19627886292 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
#include <stdio.h>
#include <stdlib.h>
#include <console.h>
#include <string.h>

#include <sys/module.h>

#define KLIBC_NAME			"klibc.dyn"
#define ROOT_NAME			"_root_.dyn"

#define ELF_DIRECTORY		"/dyn/"

static struct elf_module    *mod_root;

int modules_com32_setup() {
	int res;

	res = modules_init();

	if (res != 0)
		return res;

	////////////////////////////////////////
	// Load the root module

	// Create its associated structure
	mod_root = module_alloc(ELF_DIRECTORY ROOT_NAME);

	if (mod_root == NULL) {
		return -1;
	}

	res = module_load_shallow(mod_root);

	if (res != 0) {
		return res;
	}

	return 0;
}

int modules_com32_load(char *name) {
	char full_name[MODULE_NAME_SIZE];
	int res;

	strcpy(full_name, ELF_DIRECTORY);
	strcat(full_name, name);

	struct elf_module *module = module_alloc(full_name);

	res = module_load(module);

	if (res != 0)
		return res;

	if (*(module->init_func) != NULL) {
		res = (*(module->init_func))();
		printf("Initialization function returned: %d\n", res);
	} else {
		printf("No initialization function present.\n");
	}

	return res;
}

void modules_com32_unload(char *name) {
	char full_name[MODULE_NAME_SIZE];

	strcpy(full_name, ELF_DIRECTORY);
	strcat(full_name, name);

	struct elf_module *module = module_find(full_name);

	if (module != NULL) {
		if (*(module->exit_func) != NULL) {
			(*(module->exit_func))();
		}
		module_unload(module);
	} else {
		printf("Cannot find module %s for unloading\n", full_name);
	}
}

void print_usage() {
	printf("Usage: test_com32 module ...\n");
	printf("Where:\n");
	printf("\tmodule\tThe name of an ELF module to load, eg. hello.dyn\n");
	printf("\n");
}

void modules_com32_finalize() {
	modules_term();
}

int main(int argc, char **argv) {
	int res, i;

	// Open a standard r/w console
	openconsole(&dev_stdcon_r, &dev_stdcon_w);

	argc--;
	argv++;

	if (argc == 0) {
		print_usage();
		return 1;
	}

	// Initializing the module subsystem
	res = modules_com32_setup();

	// Load the modules...
	for (i = 0; i < argc; i++) {
		modules_com32_load(argv[i]);
	}

	// ...then unload them
	for (i = argc-1; i >= 0; i--) {
		modules_com32_unload(argv[i]);
	}

	modules_com32_finalize();

	return 0;
}