1 files changed, 58 insertions, 0 deletions
diff --git a/src/driver.c b/src/driver.c
new file mode 100644
index 0000000..145e143
--- /dev/null
+++ b/src/driver.c
@@ -0,0 +1,58 @@
+#include "driver.h"
+
+#include "kernel.h"
+#include "string.h"
+
+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 );
+	}
+
+	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_t *driver_vtable = driver->vtable;
+		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_t *driver_vtable = driver->vtable;
+		driver_vtable->deactivate( driver );
+	}
+}
+
+void driver_manager_deinit_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_t *driver_vtable = driver->vtable;
+		driver_vtable->deinit( driver );
+	}
+}
+
+