Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed
  • uspace/drv/bus/isa/isa.c

    r5cc9eba r0c0f823b  
    22 * Copyright (c) 2010 Lenka Trochtova
    33 * Copyright (c) 2011 Jiri Svoboda
    4  * Copyright (c) 2011 Jan Vesely
    54 * All rights reserved.
    65 *
     
    5251#include <dirent.h>
    5352#include <fcntl.h>
    54 #include <ipc/irc.h>
    55 #include <ipc/services.h>
    56 #include <sysinfo.h>
    57 #include <ns.h>
    5853#include <sys/stat.h>
    59 #include <ipc/irc.h>
    60 #include <ipc/services.h>
    61 #include <sysinfo.h>
    62 #include <ns.h>
    6354
    6455#include <ddf/driver.h>
     
    7061#include <device/hw_res.h>
    7162
    72 #include "i8237.h"
    73 
    7463#define NAME "isa"
    7564#define CHILD_FUN_CONF_PATH "/drv/isa/isa.dev"
     
    8170#define ISA_FUN(fun) ((isa_fun_t *) ((fun)->driver_data))
    8271
    83 #define ISA_MAX_HW_RES 5
     72#define ISA_MAX_HW_RES 4
    8473
    8574typedef struct {
     
    10796static bool isa_enable_fun_interrupt(ddf_fun_t *fnode)
    10897{
    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;
    169101}
    170102
    171103static 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
    175106};
    176107
     
    343274}
    344275
    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 
    378276static void isa_fun_set_io_range(isa_fun_t *fun, size_t addr, size_t len)
    379277{
     
    401299
    402300        val = skip_spaces(val);
    403         irq = (int) strtol(val, &end, 10);
     301        irq = (int)strtol(val, &end, 0x10);
    404302
    405303        if (val != end)
    406304                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);
    419305}
    420306
     
    510396        if (!prop_parse(fun, line, "io_range", &fun_parse_io_range) &&
    511397            !prop_parse(fun, line, "irq", &fun_parse_irq) &&
    512             !prop_parse(fun, line, "dma", &fun_parse_dma) &&
    513398            !prop_parse(fun, line, "match", &fun_parse_match_id)) {
    514399
     
    521406{
    522407        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);
    524409}
    525410
     
    705590
    706591
    707 static void isa_init()
     592static void isa_init() 
    708593{
    709594        ddf_log_init(NAME, LVL_ERROR);
Note: See TracChangeset for help on using the changeset viewer.