Changes in uspace/drv/rootpc/rootpc.c [aa7dc64:41b56084] in mainline
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
uspace/drv/rootpc/rootpc.c
raa7dc64 r41b56084 46 46 #include <macros.h> 47 47 48 #include <d df/driver.h>48 #include <driver.h> 49 49 #include <devman.h> 50 50 #include <ipc/devman.h> … … 55 55 #define NAME "rootpc" 56 56 57 /** Obtain function soft-state from DDF function node */ 58 #define ROOTPC_FUN(fnode) ((rootpc_fun_t *) (fnode)->driver_data) 59 60 typedef struct rootpc_fun { 57 typedef struct rootpc_child_dev_data { 61 58 hw_resource_list_t hw_resources; 62 } rootpc_ fun_t;63 64 static int rootpc_add_device(d df_dev_t *dev);59 } rootpc_child_dev_data_t; 60 61 static int rootpc_add_device(device_t *dev); 65 62 static void root_pc_init(void); 66 63 … … 85 82 }; 86 83 87 static rootpc_ fun_t pci_data = {84 static rootpc_child_dev_data_t pci_data = { 88 85 .hw_resources = { 89 86 1, … … 92 89 }; 93 90 94 static hw_resource_list_t *rootpc_get_resources(ddf_fun_t *fnode) 95 { 96 rootpc_fun_t *fun = ROOTPC_FUN(fnode); 97 98 assert(fun != NULL); 99 return &fun->hw_resources; 100 } 101 102 static bool rootpc_enable_interrupt(ddf_fun_t *fun) 91 static hw_resource_list_t *rootpc_get_child_resources(device_t *dev) 92 { 93 rootpc_child_dev_data_t *data; 94 95 data = (rootpc_child_dev_data_t *) dev->driver_data; 96 if (NULL == data) 97 return NULL; 98 99 return &data->hw_resources; 100 } 101 102 static bool rootpc_enable_child_interrupt(device_t *dev) 103 103 { 104 104 /* TODO */ … … 107 107 } 108 108 109 static hw_res_ops_t fun_hw_res_ops = {110 &rootpc_get_ resources,111 &rootpc_enable_ interrupt109 static hw_res_ops_t child_hw_res_ops = { 110 &rootpc_get_child_resources, 111 &rootpc_enable_child_interrupt 112 112 }; 113 113 114 114 /* Initialized in root_pc_init() function. */ 115 static d df_dev_ops_t rootpc_fun_ops;115 static device_ops_t rootpc_child_ops; 116 116 117 117 static bool 118 rootpc_add_ fun(ddf_dev_t *dev, const char *name, const char *str_match_id,119 rootpc_ fun_t *fun)120 { 121 printf(NAME ": adding new function'%s'.\n", name);122 123 d df_fun_t *fnode= NULL;118 rootpc_add_child(device_t *parent, const char *name, const char *str_match_id, 119 rootpc_child_dev_data_t *drv_data) 120 { 121 printf(NAME ": adding new child device '%s'.\n", name); 122 123 device_t *child = NULL; 124 124 match_id_t *match_id = NULL; 125 125 126 126 /* Create new device. */ 127 fnode = ddf_fun_create(dev, fun_inner, name);128 if ( fnode == NULL)127 child = create_device(); 128 if (NULL == child) 129 129 goto failure; 130 130 131 fnode->driver_data = fun; 131 child->name = name; 132 child->driver_data = drv_data; 132 133 133 134 /* Initialize match id list */ 134 135 match_id = create_match_id(); 135 if ( match_id == NULL)136 if (NULL == match_id) 136 137 goto failure; 137 138 138 139 match_id->id = str_match_id; 139 140 match_id->score = 100; 140 add_match_id(& fnode->match_ids, match_id);141 add_match_id(&child->match_ids, match_id); 141 142 142 143 /* Set provided operations to the device. */ 143 fnode->ops = &rootpc_fun_ops; 144 145 /* Register function. */ 146 if (ddf_fun_bind(fnode) != EOK) { 147 printf(NAME ": error binding function %s.\n", name); 144 child->ops = &rootpc_child_ops; 145 146 /* Register child device. */ 147 if (EOK != child_device_register(child, parent)) 148 148 goto failure; 149 }150 149 151 150 return true; 152 151 153 152 failure: 154 if ( match_id != NULL)153 if (NULL != match_id) 155 154 match_id->id = NULL; 156 155 157 if (fnode != NULL) 158 ddf_fun_destroy(fnode); 159 160 printf(NAME ": failed to add function '%s'.\n", name); 156 if (NULL != child) { 157 child->name = NULL; 158 delete_device(child); 159 } 160 161 printf(NAME ": failed to add child device '%s'.\n", name); 161 162 162 163 return false; 163 164 } 164 165 165 static bool rootpc_add_ functions(ddf_dev_t *dev)166 { 167 return rootpc_add_ fun(dev, "pci0", "intel_pci", &pci_data);166 static bool rootpc_add_children(device_t *dev) 167 { 168 return rootpc_add_child(dev, "pci0", "intel_pci", &pci_data); 168 169 } 169 170 … … 174 175 * @return Zero on success, negative error number otherwise. 175 176 */ 176 static int rootpc_add_device(d df_dev_t *dev)177 static int rootpc_add_device(device_t *dev) 177 178 { 178 179 printf(NAME ": rootpc_add_device, device handle = %d\n", 179 180 (int)dev->handle); 180 181 181 /* Register functions. */182 if (!rootpc_add_ functions(dev)) {183 printf(NAME ": failed to add functions for PC platform.\n");182 /* Register child devices. */ 183 if (!rootpc_add_children(dev)) { 184 printf(NAME ": failed to add child devices for PC platform.\n"); 184 185 } 185 186 … … 189 190 static void root_pc_init(void) 190 191 { 191 rootpc_ fun_ops.interfaces[HW_RES_DEV_IFACE] = &fun_hw_res_ops;192 rootpc_child_ops.interfaces[HW_RES_DEV_IFACE] = &child_hw_res_ops; 192 193 } 193 194 … … 196 197 printf(NAME ": HelenOS PC platform driver\n"); 197 198 root_pc_init(); 198 return d df_driver_main(&rootpc_driver);199 return driver_main(&rootpc_driver); 199 200 } 200 201
Note:
See TracChangeset
for help on using the changeset viewer.