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
|
// MIT License, Copyright (c) 2021 Marvin Borner
// Device manager
#include <dev.h>
#include <lib.h>
#include <pnc.h>
static struct dev devices[32] = { 0 };
static const char *dev_resolve_type(enum dev_type type)
{
switch (type) {
case DEV_DISK:
return "Disk";
case DEV_FB:
return "Framebuffer";
default:
return "Unknown";
}
}
struct dev *dev_get(u8 id)
{
assert(id < COUNT(devices));
return &devices[id];
}
u8 dev_register(enum dev_type type, char *name, u32 data,
s32 (*read)(void *, u32, u32, struct dev *),
s32 (*write)(const void *, u32, u32, struct dev *))
{
static u8 id = 0;
assert(++id < 0xff);
struct dev *dev = &devices[id];
dev->id = id;
dev->type = type;
dev->read = read;
dev->write = write;
dev->data = data;
assert(strlen(name) < sizeof(dev->name));
memcpy(dev->name, name, sizeof(dev->name));
if (type == DEV_DISK)
dsk_detect(dev);
return id;
}
void dev_print(void)
{
for (u8 i = 0; i < COUNT(devices); i++) {
struct dev *dev = &devices[i];
if (!dev->id)
continue;
log("[DEV] %d: %s device: %s\n", dev->id, dev_resolve_type(dev->type), dev->name);
}
}
|
