Changes in uspace/drv/bus/isa/isa.c [5cc9eba:0c0f823b] in mainline
- File:
-
- 1 edited
-
uspace/drv/bus/isa/isa.c (modified) (10 diffs)
Legend:
- Unmodified
- Added
- Removed
-
uspace/drv/bus/isa/isa.c
r5cc9eba r0c0f823b 2 2 * Copyright (c) 2010 Lenka Trochtova 3 3 * Copyright (c) 2011 Jiri Svoboda 4 * Copyright (c) 2011 Jan Vesely5 4 * All rights reserved. 6 5 * … … 52 51 #include <dirent.h> 53 52 #include <fcntl.h> 54 #include <ipc/irc.h>55 #include <ipc/services.h>56 #include <sysinfo.h>57 #include <ns.h>58 53 #include <sys/stat.h> 59 #include <ipc/irc.h>60 #include <ipc/services.h>61 #include <sysinfo.h>62 #include <ns.h>63 54 64 55 #include <ddf/driver.h> … … 70 61 #include <device/hw_res.h> 71 62 72 #include "i8237.h"73 74 63 #define NAME "isa" 75 64 #define CHILD_FUN_CONF_PATH "/drv/isa/isa.dev" … … 81 70 #define ISA_FUN(fun) ((isa_fun_t *) ((fun)->driver_data)) 82 71 83 #define ISA_MAX_HW_RES 572 #define ISA_MAX_HW_RES 4 84 73 85 74 typedef struct { … … 107 96 static bool isa_enable_fun_interrupt(ddf_fun_t *fnode) 108 97 { 109 /* This is an old ugly way, copied from pci driver */ 110 assert(fnode); 111 isa_fun_t *isa_fun = fnode->driver_data; 112 113 sysarg_t apic; 114 sysarg_t i8259; 115 116 async_sess_t *irc_sess = NULL; 117 118 if (((sysinfo_get_value("apic", &apic) == EOK) && (apic)) 119 || ((sysinfo_get_value("i8259", &i8259) == EOK) && (i8259))) { 120 irc_sess = service_connect_blocking(EXCHANGE_SERIALIZE, 121 SERVICE_IRC, 0, 0); 122 } 123 124 if (!irc_sess) 125 return false; 126 127 assert(isa_fun); 128 const hw_resource_list_t *res = &isa_fun->hw_resources; 129 assert(res); 130 for (size_t i = 0; i < res->count; ++i) { 131 if (res->resources[i].type == INTERRUPT) { 132 const int irq = res->resources[i].res.interrupt.irq; 133 134 async_exch_t *exch = async_exchange_begin(irc_sess); 135 const int rc = 136 async_req_1_0(exch, IRC_ENABLE_INTERRUPT, irq); 137 async_exchange_end(exch); 138 139 if (rc != EOK) { 140 async_hangup(irc_sess); 141 return false; 142 } 143 } 144 } 145 146 async_hangup(irc_sess); 147 return true; 148 } 149 150 static int isa_dma_channel_fun_setup(ddf_fun_t *fnode, 151 unsigned int channel, uint32_t pa, uint16_t size, uint8_t mode) 152 { 153 assert(fnode); 154 isa_fun_t *isa_fun = fnode->driver_data; 155 const hw_resource_list_t *res = &isa_fun->hw_resources; 156 assert(res); 157 158 const unsigned int ch = channel; 159 for (size_t i = 0; i < res->count; ++i) { 160 if (((res->resources[i].type == DMA_CHANNEL_16) && 161 (res->resources[i].res.dma_channel.dma16 == ch)) || 162 ((res->resources[i].type == DMA_CHANNEL_8) && 163 (res->resources[i].res.dma_channel.dma8 == ch))) { 164 return dma_setup_channel(channel, pa, size, mode); 165 } 166 } 167 168 return EINVAL; 98 /* TODO */ 99 100 return false; 169 101 } 170 102 171 103 static hw_res_ops_t isa_fun_hw_res_ops = { 172 .get_resource_list = isa_get_fun_resources, 173 .enable_interrupt = isa_enable_fun_interrupt, 174 .dma_channel_setup = isa_dma_channel_fun_setup, 104 &isa_get_fun_resources, 105 &isa_enable_fun_interrupt 175 106 }; 176 107 … … 343 274 } 344 275 345 static void isa_fun_set_dma(isa_fun_t *fun, int dma)346 {347 size_t count = fun->hw_resources.count;348 hw_resource_t *resources = fun->hw_resources.resources;349 350 if (count < ISA_MAX_HW_RES) {351 if ((dma > 0) && (dma < 4)) {352 resources[count].type = DMA_CHANNEL_8;353 resources[count].res.dma_channel.dma8 = dma;354 355 fun->hw_resources.count++;356 ddf_msg(LVL_NOTE, "Added dma 0x%x to function %s", dma,357 fun->fnode->name);358 359 return;360 }361 362 if ((dma > 4) && (dma < 8)) {363 resources[count].type = DMA_CHANNEL_16;364 resources[count].res.dma_channel.dma16 = dma;365 366 fun->hw_resources.count++;367 ddf_msg(LVL_NOTE, "Added dma 0x%x to function %s", dma,368 fun->fnode->name);369 370 return;371 }372 373 ddf_msg(LVL_WARN, "Skipped dma 0x%x for function %s", dma,374 fun->fnode->name);375 }376 }377 378 276 static void isa_fun_set_io_range(isa_fun_t *fun, size_t addr, size_t len) 379 277 { … … 401 299 402 300 val = skip_spaces(val); 403 irq = (int) strtol(val, &end,10);301 irq = (int)strtol(val, &end, 0x10); 404 302 405 303 if (val != end) 406 304 isa_fun_set_irq(fun, irq); 407 }408 409 static void fun_parse_dma(isa_fun_t *fun, char *val)410 {411 unsigned int dma = 0;412 char *end = NULL;413 414 val = skip_spaces(val);415 dma = (unsigned int) strtol(val, &end, 10);416 417 if (val != end)418 isa_fun_set_dma(fun, dma);419 305 } 420 306 … … 510 396 if (!prop_parse(fun, line, "io_range", &fun_parse_io_range) && 511 397 !prop_parse(fun, line, "irq", &fun_parse_irq) && 512 !prop_parse(fun, line, "dma", &fun_parse_dma) &&513 398 !prop_parse(fun, line, "match", &fun_parse_match_id)) { 514 399 … … 521 406 { 522 407 fun->hw_resources.resources = 523 (hw_resource_t *) malloc(sizeof(hw_resource_t) * ISA_MAX_HW_RES);408 (hw_resource_t *)malloc(sizeof(hw_resource_t) * ISA_MAX_HW_RES); 524 409 } 525 410 … … 705 590 706 591 707 static void isa_init() 592 static void isa_init() 708 593 { 709 594 ddf_log_init(NAME, LVL_ERROR);
Note:
See TracChangeset
for help on using the changeset viewer.
