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
|
#include "driver.h"
#include "kernel.h"
#include "string.h"
#include "stdlib.h"
static driver_vtable_t const driver_vtable = {
driver_activate,
driver_deactivate,
driver_deinit,
driver_print_info
};
void driver_init( driver_t *driver, driver_type_t type, interrupt_t *interrupt, void *context )
{
memset( driver, 0, sizeof( driver_t ) );
driver->type = type;
driver->interrupt = interrupt;
driver->context = context;
driver->vtable = &driver_vtable;
}
void driver_activate( void *obj )
{
kernel_panic( "Activating a generic driver should not be called directly." );
}
void driver_deactivate( void *obj )
{
kernel_panic( "Deactivating a generic driver should not be called directly." );
}
void driver_deinit( void *obj )
{
// nothing to be done
}
void driver_print_info( void *obj )
{
kernel_panic( "Printing info of a generic driver should not be called directly." );
}
void driver_manager_init( driver_manager_t *manager )
{
memset( manager, 0, sizeof( driver_manager_t ) );
manager->nof_drivers = 0;
}
void driver_manager_add_driver( driver_manager_t *manager, driver_t *driver )
{
if( manager->nof_drivers >= MAX_NOF_DRIVERS - 1 ) {
kernel_panic( "Allocating more than %d drivers.. increase kernel constant MAX_NOF_DRIVERS", MAX_NOF_DRIVERS );
}
manager->driver[manager->nof_drivers] = driver;
manager->nof_drivers++;
}
void driver_manager_activate_all( driver_manager_t *manager )
{
for( int i = 0; i < manager->nof_drivers; i++ ) {
driver_t *driver = (driver_t *)manager->driver[i];
driver->vtable->activate( driver );
}
}
void driver_manager_deactivate_all( driver_manager_t *manager )
{
if( manager->nof_drivers == 0 ) {
return;
}
for( int i = manager->nof_drivers - 1; i >= 0; i-- ) {
driver_t *driver = (driver_t *)manager->driver[i];
driver->vtable->deactivate( driver );
}
}
void driver_manager_deinit( driver_manager_t *manager )
{
if( manager->nof_drivers == 0 ) {
return;
}
for( int i = manager->nof_drivers - 1; i >= 0; i-- ) {
driver_t *driver = (driver_t *)manager->driver[i];
driver->vtable->deinit( driver );
free( driver );
}
}
void driver_manager_print_info_all( driver_manager_t *manager )
{
for( int i = 0; i < manager->nof_drivers; i++ ) {
driver_t *driver = (driver_t *)manager->driver[i];
driver->vtable->print_info( driver );
}
}
driver_t *driver_manager_find_driver( driver_manager_t *manager, driver_type_t type )
{
driver_t *driver;
for( int i = 0; i < manager->nof_drivers; i++ ) {
driver_t *driver = (driver_t *)manager->driver[i];
if( driver->type == type ) {
return driver;
}
}
return NULL;
}
|