source: mainline/uspace/drv/bus/isa/isa.c@ dbc1398

serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since dbc1398 was 3d0fd0d, checked in by Jakub Jermar <jakub@…>, 6 years ago

Do not flag absolute ISA mem range as relative

  • Property mode set to 100644
File size: 19.1 KB
RevLine 
[892e4e1]1/*
[b25970f]2 * Copyright (c) 2018 Jiri Svoboda
[892e4e1]3 * Copyright (c) 2010 Lenka Trochtova
[ec388d7]4 * Copyright (c) 2011 Jan Vesely
[892e4e1]5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 *
11 * - Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * - Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * - The name of the author may not be used to endorse or promote products
17 * derived from this software without specific prior written permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
20 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
21 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
22 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
23 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
24 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
25 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
26 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
28 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29 */
30
31/**
[4122410]32 * @addtogroup isa
[892e4e1]33 * @{
34 */
35
36/** @file
37 */
38
[f278930]39#include <adt/list.h>
[892e4e1]40#include <assert.h>
41#include <stdio.h>
42#include <errno.h>
[3e6a98c5]43#include <stdbool.h>
[892e4e1]44#include <fibril_synch.h>
45#include <stdlib.h>
[c47e1a8]46#include <str.h>
[cd0684d]47#include <str_error.h>
[892e4e1]48#include <ctype.h>
49#include <macros.h>
[38d150e]50#include <stdlib.h>
[c1a8ae52]51#include <dirent.h>
[5960b48]52#include <ipc/irc.h>
53#include <ipc/services.h>
[23a0368]54#include <vfs/vfs.h>
[ebc9c2c]55#include <irc.h>
[1a11a16]56#include <ns.h>
[892e4e1]57
[af6b5157]58#include <ddf/driver.h>
[fc51296]59#include <ddf/log.h>
[41b56084]60#include <ops/hw_res.h>
[ff97957]61#include <ops/pio_window.h>
[5dc9622]62
63#include <device/hw_res.h>
[0a428943]64#include <device/pio_window.h>
[892e4e1]65
[3c5b86c]66#include <pci_dev_iface.h>
67
[d9cf684a]68#include "i8237.h"
[ec388d7]69
[892e4e1]70#define NAME "isa"
[3c5b86c]71#define ISA_CHILD_FUN_CONF_PATH "/drv/isa/isa.dev"
72#define EBUS_CHILD_FUN_CONF_PATH "/drv/isa/ebus.dev"
[892e4e1]73
[55a8e0cb]74#define ISA_MAX_HW_RES 5
[5dc9622]75
[f278930]76typedef struct {
77 fibril_mutex_t mutex;
[7e9e652]78 uint16_t pci_vendor_id;
79 uint16_t pci_device_id;
80 uint8_t pci_class;
81 uint8_t pci_subclass;
[f278930]82 ddf_dev_t *dev;
83 ddf_fun_t *fctl;
[0a428943]84 pio_window_t pio_win;
[f278930]85 list_t functions;
86} isa_bus_t;
87
[68414f4a]88typedef struct isa_fun {
[f278930]89 fibril_mutex_t mutex;
[83a2f43]90 ddf_fun_t *fnode;
[85c4cc45]91 hw_resource_t resources[ISA_MAX_HW_RES];
[032e0bb]92 hw_resource_list_t hw_resources;
[f278930]93 link_t bus_link;
[68414f4a]94} isa_fun_t;
[5dc9622]95
[56fd7cf]96/** Obtain soft-state from device node */
97static isa_bus_t *isa_bus(ddf_dev_t *dev)
98{
99 return ddf_dev_data_get(dev);
100}
101
102/** Obtain soft-state from function node */
103static isa_fun_t *isa_fun(ddf_fun_t *fun)
104{
105 return ddf_fun_data_get(fun);
106}
107
[ff97957]108static hw_resource_list_t *isa_fun_get_resources(ddf_fun_t *fnode)
[5dc9622]109{
[ff97957]110 isa_fun_t *fun = isa_fun(fnode);
111 assert(fun);
[032e0bb]112
[ff97957]113 return &fun->hw_resources;
[5dc9622]114}
115
[d51838f]116static bool isa_fun_owns_interrupt(isa_fun_t *fun, int irq)
[5dc9622]117{
[ff97957]118 const hw_resource_list_t *res = &fun->hw_resources;
[1a11a16]119
[cccd60c3]120 /* Check that specified irq really belongs to the function */
121 for (size_t i = 0; i < res->count; ++i) {
122 if (res->resources[i].type == INTERRUPT &&
123 res->resources[i].res.interrupt.irq == irq) {
[d51838f]124 return true;
[1a11a16]125 }
126 }
127
[d51838f]128 return false;
129}
130
[b7fd2a0]131static errno_t isa_fun_enable_interrupt(ddf_fun_t *fnode, int irq)
[d51838f]132{
133 isa_fun_t *fun = isa_fun(fnode);
134
135 if (!isa_fun_owns_interrupt(fun, irq))
[cccd60c3]136 return EINVAL;
137
138 return irc_enable_interrupt(irq);
[5dc9622]139}
140
[b7fd2a0]141static errno_t isa_fun_disable_interrupt(ddf_fun_t *fnode, int irq)
[d51838f]142{
143 isa_fun_t *fun = isa_fun(fnode);
144
145 if (!isa_fun_owns_interrupt(fun, irq))
146 return EINVAL;
147
148 return irc_disable_interrupt(irq);
149}
150
[b7fd2a0]151static errno_t isa_fun_clear_interrupt(ddf_fun_t *fnode, int irq)
[d51838f]152{
153 isa_fun_t *fun = isa_fun(fnode);
154
155 if (!isa_fun_owns_interrupt(fun, irq))
156 return EINVAL;
157
158 return irc_clear_interrupt(irq);
159}
160
[b7fd2a0]161static errno_t isa_fun_setup_dma(ddf_fun_t *fnode,
[301032a]162 unsigned int channel, uint32_t pa, uint32_t size, uint8_t mode)
[ec388d7]163{
164 assert(fnode);
[ff97957]165 isa_fun_t *fun = isa_fun(fnode);
166 assert(fun);
167 const hw_resource_list_t *res = &fun->hw_resources;
[ec388d7]168 assert(res);
[03362fbd]169
[ec388d7]170 for (size_t i = 0; i < res->count; ++i) {
[1ec394e]171 /* Check for assigned channel */
[d9cf684a]172 if (((res->resources[i].type == DMA_CHANNEL_16) &&
[1ec394e]173 (res->resources[i].res.dma_channel.dma16 == channel)) ||
[d9cf684a]174 ((res->resources[i].type == DMA_CHANNEL_8) &&
[1ec394e]175 (res->resources[i].res.dma_channel.dma8 == channel))) {
176 return dma_channel_setup(channel, pa, size, mode);
[ec388d7]177 }
178 }
[03362fbd]179
[ec388d7]180 return EINVAL;
181}
182
[b7fd2a0]183static errno_t isa_fun_remain_dma(ddf_fun_t *fnode,
[3869c596]184 unsigned channel, size_t *size)
[1864948]185{
186 assert(size);
187 assert(fnode);
[ff97957]188 isa_fun_t *fun = isa_fun(fnode);
189 assert(fun);
190 const hw_resource_list_t *res = &fun->hw_resources;
[1864948]191 assert(res);
[03362fbd]192
[1864948]193 for (size_t i = 0; i < res->count; ++i) {
194 /* Check for assigned channel */
195 if (((res->resources[i].type == DMA_CHANNEL_16) &&
196 (res->resources[i].res.dma_channel.dma16 == channel)) ||
197 ((res->resources[i].type == DMA_CHANNEL_8) &&
198 (res->resources[i].res.dma_channel.dma8 == channel))) {
199 return dma_channel_remain(channel, size);
200 }
201 }
[03362fbd]202
[1864948]203 return EINVAL;
204}
205
[8b1e15ac]206static hw_res_ops_t isa_fun_hw_res_ops = {
[ff97957]207 .get_resource_list = isa_fun_get_resources,
[bc6762f]208 .enable_interrupt = isa_fun_enable_interrupt,
[d51838f]209 .disable_interrupt = isa_fun_disable_interrupt,
210 .clear_interrupt = isa_fun_clear_interrupt,
[bc6762f]211 .dma_channel_setup = isa_fun_setup_dma,
[1864948]212 .dma_channel_remain = isa_fun_remain_dma,
[5dc9622]213};
214
[ff97957]215static pio_window_t *isa_fun_get_pio_window(ddf_fun_t *fnode)
216{
217 ddf_dev_t *dev = ddf_fun_get_dev(fnode);
218 isa_bus_t *isa = isa_bus(dev);
219 assert(isa);
220
221 return &isa->pio_win;
222}
223
224static pio_window_ops_t isa_fun_pio_window_ops = {
225 .get_pio_window = isa_fun_get_pio_window
226};
227
[1433ecda]228static ddf_dev_ops_t isa_fun_ops = {
[b28dabe]229 .interfaces[HW_RES_DEV_IFACE] = &isa_fun_hw_res_ops,
[ff97957]230 .interfaces[PIO_WINDOW_DEV_IFACE] = &isa_fun_pio_window_ops,
[b28dabe]231};
[5dc9622]232
[b7fd2a0]233static errno_t isa_dev_add(ddf_dev_t *dev);
234static errno_t isa_dev_remove(ddf_dev_t *dev);
235static errno_t isa_fun_online(ddf_fun_t *fun);
236static errno_t isa_fun_offline(ddf_fun_t *fun);
[892e4e1]237
[032e0bb]238/** The isa device driver's standard operations */
[892e4e1]239static driver_ops_t isa_ops = {
[0c0f823b]240 .dev_add = &isa_dev_add,
[f278930]241 .dev_remove = &isa_dev_remove,
[5b68e0c]242 .fun_online = &isa_fun_online,
243 .fun_offline = &isa_fun_offline
[892e4e1]244};
245
[032e0bb]246/** The isa device driver structure. */
[892e4e1]247static driver_t isa_driver = {
248 .name = NAME,
249 .driver_ops = &isa_ops
250};
251
[f278930]252static isa_fun_t *isa_fun_create(isa_bus_t *isa, const char *name)
[c1a8ae52]253{
[f278930]254 ddf_fun_t *fnode = ddf_fun_create(isa->dev, fun_inner, name);
255 if (fnode == NULL)
[c1a8ae52]256 return NULL;
[032e0bb]257
[f278930]258 isa_fun_t *fun = ddf_fun_data_alloc(fnode, sizeof(isa_fun_t));
[0bbd13e]259 if (fun == NULL) {
260 ddf_fun_destroy(fnode);
[c1a8ae52]261 return NULL;
[0bbd13e]262 }
[032e0bb]263
[f278930]264 fibril_mutex_initialize(&fun->mutex);
[85c4cc45]265 fun->hw_resources.resources = fun->resources;
266
[68414f4a]267 fun->fnode = fnode;
[8b1e15ac]268 return fun;
[c1a8ae52]269}
270
[68414f4a]271static char *fun_conf_read(const char *conf_path)
[032e0bb]272{
273 bool suc = false;
[c1a8ae52]274 char *buf = NULL;
275 bool opened = false;
[032e0bb]276 int fd;
[6efd162]277 size_t len;
[b7fd2a0]278 errno_t rc;
[8e3498b]279 size_t nread;
[39330200]280 vfs_stat_t st;
[032e0bb]281
[f77c1c9]282 rc = vfs_lookup_open(conf_path, WALK_REGULAR, MODE_READ, &fd);
283 if (rc != EOK) {
[ebcb05a]284 ddf_msg(LVL_ERROR, "Unable to open %s", conf_path);
[c1a8ae52]285 goto cleanup;
[032e0bb]286 }
287
288 opened = true;
289
[23a0368]290 if (vfs_stat(fd, &st) != EOK) {
291 ddf_msg(LVL_ERROR, "Unable to vfs_stat %d", fd);
[58898d1d]292 goto cleanup;
293 }
294
295 len = st.size;
[6efd162]296 if (len == 0) {
[ebcb05a]297 ddf_msg(LVL_ERROR, "Configuration file '%s' is empty.",
[fc51296]298 conf_path);
[032e0bb]299 goto cleanup;
[c1a8ae52]300 }
[032e0bb]301
[6efd162]302 buf = malloc(len + 1);
[c1a8ae52]303 if (buf == NULL) {
[ebcb05a]304 ddf_msg(LVL_ERROR, "Memory allocation failed.");
[c1a8ae52]305 goto cleanup;
[032e0bb]306 }
307
[1433ecda]308 rc = vfs_read(fd, (aoff64_t []) { 0 }, buf, len, &nread);
[8e3498b]309 if (rc != EOK) {
[6efd162]310 ddf_msg(LVL_ERROR, "Unable to read file '%s'.", conf_path);
311 goto cleanup;
312 }
[032e0bb]313
[8e3498b]314 buf[nread] = 0;
[032e0bb]315
[c1a8ae52]316 suc = true;
[032e0bb]317
[c1a8ae52]318cleanup:
[032e0bb]319 if (!suc && buf != NULL) {
320 free(buf);
[c1a8ae52]321 buf = NULL;
322 }
[032e0bb]323
324 if (opened)
[9c4cf0d]325 vfs_put(fd);
[032e0bb]326
327 return buf;
[c1a8ae52]328}
329
[032e0bb]330static char *str_get_line(char *str, char **next)
331{
[5dc9622]332 char *line = str;
[cf56332]333 *next = NULL;
[032e0bb]334
335 if (str == NULL) {
[f928a8a]336 return NULL;
337 }
[032e0bb]338
339 while (*str != '\0' && *str != '\n') {
[5dc9622]340 str++;
[032e0bb]341 }
342
343 if (*str != '\0') {
[5dc9622]344 *next = str + 1;
[032e0bb]345 }
346
347 *str = '\0';
[5dc9622]348 return line;
[c1a8ae52]349}
350
351static bool line_empty(const char *line)
352{
[032e0bb]353 while (line != NULL && *line != 0) {
354 if (!isspace(*line))
[c1a8ae52]355 return false;
[032e0bb]356 line++;
357 }
358
359 return true;
[c1a8ae52]360}
361
[032e0bb]362static char *get_device_name(char *line)
363{
364 /* Skip leading spaces. */
365 while (*line != '\0' && isspace(*line)) {
[c1a8ae52]366 line++;
367 }
[032e0bb]368
369 /* Get the name part of the rest of the line. */
[ee3f6f6]370 str_tok(line, ":", NULL);
[3d4ad475]371 return line;
[c1a8ae52]372}
373
[b5f305b]374static inline const char *skip_spaces(const char *line)
[c1a8ae52]375{
[032e0bb]376 /* Skip leading spaces. */
377 while (*line != '\0' && isspace(*line))
[c1a8ae52]378 line++;
379
[032e0bb]380 return line;
381}
[c1a8ae52]382
[82e4005]383static void isa_fun_add_irq(isa_fun_t *fun, int irq)
[c1a8ae52]384{
[68414f4a]385 size_t count = fun->hw_resources.count;
386 hw_resource_t *resources = fun->hw_resources.resources;
[032e0bb]387
[5dc9622]388 if (count < ISA_MAX_HW_RES) {
389 resources[count].type = INTERRUPT;
390 resources[count].res.interrupt.irq = irq;
[032e0bb]391
[68414f4a]392 fun->hw_resources.count++;
[032e0bb]393
[ebcb05a]394 ddf_msg(LVL_NOTE, "Added irq 0x%x to function %s", irq,
[56fd7cf]395 ddf_fun_get_name(fun->fnode));
[032e0bb]396 }
[5dc9622]397}
398
[82e4005]399static void isa_fun_add_dma(isa_fun_t *fun, int dma)
[55a8e0cb]400{
401 size_t count = fun->hw_resources.count;
402 hw_resource_t *resources = fun->hw_resources.resources;
[a35b458]403
[55a8e0cb]404 if (count < ISA_MAX_HW_RES) {
[d9cf684a]405 if ((dma > 0) && (dma < 4)) {
[55a8e0cb]406 resources[count].type = DMA_CHANNEL_8;
407 resources[count].res.dma_channel.dma8 = dma;
[a35b458]408
[55a8e0cb]409 fun->hw_resources.count++;
410 ddf_msg(LVL_NOTE, "Added dma 0x%x to function %s", dma,
[56fd7cf]411 ddf_fun_get_name(fun->fnode));
[a35b458]412
[55a8e0cb]413 return;
414 }
415
[d9cf684a]416 if ((dma > 4) && (dma < 8)) {
[55a8e0cb]417 resources[count].type = DMA_CHANNEL_16;
418 resources[count].res.dma_channel.dma16 = dma;
[a35b458]419
[55a8e0cb]420 fun->hw_resources.count++;
421 ddf_msg(LVL_NOTE, "Added dma 0x%x to function %s", dma,
[56fd7cf]422 ddf_fun_get_name(fun->fnode));
[a35b458]423
[55a8e0cb]424 return;
425 }
[a35b458]426
[55a8e0cb]427 ddf_msg(LVL_WARN, "Skipped dma 0x%x for function %s", dma,
[56fd7cf]428 ddf_fun_get_name(fun->fnode));
[55a8e0cb]429 }
430}
431
[82e4005]432static void isa_fun_add_io_range(isa_fun_t *fun, size_t addr, size_t len)
[5dc9622]433{
[68414f4a]434 size_t count = fun->hw_resources.count;
435 hw_resource_t *resources = fun->hw_resources.resources;
[032e0bb]436
[0a428943]437 isa_bus_t *isa = isa_bus(ddf_fun_get_dev(fun->fnode));
438
[5dc9622]439 if (count < ISA_MAX_HW_RES) {
440 resources[count].type = IO_RANGE;
441 resources[count].res.io_range.address = addr;
[0a428943]442 resources[count].res.io_range.address += isa->pio_win.io.base;
[5dc9622]443 resources[count].res.io_range.size = len;
[9e470c0]444 resources[count].res.io_range.relative = false;
[032e0bb]445 resources[count].res.io_range.endianness = LITTLE_ENDIAN;
446
[68414f4a]447 fun->hw_resources.count++;
[032e0bb]448
[fc51296]449 ddf_msg(LVL_NOTE, "Added io range (addr=0x%x, size=0x%x) to "
[ebcb05a]450 "function %s", (unsigned int) addr, (unsigned int) len,
[56fd7cf]451 ddf_fun_get_name(fun->fnode));
[032e0bb]452 }
[c1a8ae52]453}
454
[b446b02]455static void isa_fun_add_mem_range(isa_fun_t *fun, uintptr_t addr, size_t len)
456{
457 size_t count = fun->hw_resources.count;
458 hw_resource_t *resources = fun->hw_resources.resources;
459
460 isa_bus_t *isa = isa_bus(ddf_fun_get_dev(fun->fnode));
461
462 if (count < ISA_MAX_HW_RES) {
463 resources[count].type = MEM_RANGE;
464 resources[count].res.mem_range.address = addr;
465 resources[count].res.mem_range.address += isa->pio_win.mem.base;
466 resources[count].res.mem_range.size = len;
[3d0fd0d]467 resources[count].res.mem_range.relative = false;
[b446b02]468 resources[count].res.mem_range.endianness = LITTLE_ENDIAN;
469
470 fun->hw_resources.count++;
471
472 ddf_msg(LVL_NOTE, "Added mem range (addr=0x%zx, size=0x%x) to "
473 "function %s", (uintptr_t) addr, (unsigned int) len,
474 ddf_fun_get_name(fun->fnode));
475 }
476}
477
[b5f305b]478static void fun_parse_irq(isa_fun_t *fun, const char *val)
[c1a8ae52]479{
480 int irq = 0;
481 char *end = NULL;
[032e0bb]482
[8b1e15ac]483 val = skip_spaces(val);
[5cc9eba]484 irq = (int) strtol(val, &end, 10);
[032e0bb]485
486 if (val != end)
[82e4005]487 isa_fun_add_irq(fun, irq);
[c1a8ae52]488}
489
[b5f305b]490static void fun_parse_dma(isa_fun_t *fun, const char *val)
[55a8e0cb]491{
492 char *end = NULL;
[a35b458]493
[55a8e0cb]494 val = skip_spaces(val);
[1ec394e]495 const int dma = strtol(val, &end, 10);
[a35b458]496
[55a8e0cb]497 if (val != end)
[82e4005]498 isa_fun_add_dma(fun, dma);
[55a8e0cb]499}
500
[b5f305b]501static void fun_parse_io_range(isa_fun_t *fun, const char *val)
[c1a8ae52]502{
[5dc9622]503 size_t addr, len;
504 char *end = NULL;
[032e0bb]505
[8b1e15ac]506 val = skip_spaces(val);
[5dc9622]507 addr = strtol(val, &end, 0x10);
[032e0bb]508
509 if (val == end)
[5dc9622]510 return;
[032e0bb]511
[8b1e15ac]512 val = skip_spaces(end);
[5dc9622]513 len = strtol(val, &end, 0x10);
[032e0bb]514
515 if (val == end)
[5dc9622]516 return;
[032e0bb]517
[82e4005]518 isa_fun_add_io_range(fun, addr, len);
[c1a8ae52]519}
520
[b446b02]521static void fun_parse_mem_range(isa_fun_t *fun, const char *val)
522{
523 uintptr_t addr;
524 size_t len;
525 char *end = NULL;
526
527 val = skip_spaces(val);
528 addr = strtoul(val, &end, 0x10);
529
530 if (val == end)
531 return;
532
533 val = skip_spaces(end);
534 len = strtol(val, &end, 0x10);
535
536 if (val == end)
537 return;
538
539 isa_fun_add_mem_range(fun, addr, len);
540}
541
[b5f305b]542static void get_match_id(char **id, const char *val)
[c1a8ae52]543{
[b5f305b]544 const char *end = val;
[032e0bb]545
546 while (!isspace(*end))
[5dc9622]547 end++;
[032e0bb]548
[f928a8a]549 size_t size = end - val + 1;
[5dc9622]550 *id = (char *)malloc(size);
[032e0bb]551 str_cpy(*id, size, val);
[5dc9622]552}
553
[b5f305b]554static void fun_parse_match_id(isa_fun_t *fun, const char *val)
[032e0bb]555{
[5dc9622]556 char *id = NULL;
557 char *end = NULL;
[032e0bb]558
[68414f4a]559 val = skip_spaces(val);
[032e0bb]560
[cf56332]561 int score = (int)strtol(val, &end, 10);
[5dc9622]562 if (val == end) {
[fc51296]563 ddf_msg(LVL_ERROR, "Cannot read match score for function "
[56fd7cf]564 "%s.", ddf_fun_get_name(fun->fnode));
[5dc9622]565 return;
566 }
[032e0bb]567
[bab6388]568 val = skip_spaces(end);
[5dc9622]569 get_match_id(&id, val);
[032e0bb]570 if (id == NULL) {
[ebcb05a]571 ddf_msg(LVL_ERROR, "Cannot read match ID for function %s.",
[56fd7cf]572 ddf_fun_get_name(fun->fnode));
[5dc9622]573 return;
574 }
[032e0bb]575
[fc51296]576 ddf_msg(LVL_DEBUG, "Adding match id '%s' with score %d to "
[56fd7cf]577 "function %s", id, score, ddf_fun_get_name(fun->fnode));
[cd0684d]578
[b7fd2a0]579 errno_t rc = ddf_fun_add_match_id(fun->fnode, id, score);
[fc51296]580 if (rc != EOK) {
[ebcb05a]581 ddf_msg(LVL_ERROR, "Failed adding match ID: %s",
[fc51296]582 str_error(rc));
583 }
[ef9460b]584
585 free(id);
[c1a8ae52]586}
587
[b5f305b]588static bool prop_parse(isa_fun_t *fun, const char *line, const char *prop,
589 void (*read_fn)(isa_fun_t *, const char *))
[5fe1c32]590{
591 size_t proplen = str_size(prop);
[032e0bb]592
593 if (str_lcmp(line, prop, proplen) == 0) {
[5fe1c32]594 line += proplen;
595 line = skip_spaces(line);
[8b1e15ac]596 (*read_fn)(fun, line);
[032e0bb]597
[5fe1c32]598 return true;
599 }
[032e0bb]600
601 return false;
[5fe1c32]602}
603
[b5f305b]604static void fun_prop_parse(isa_fun_t *fun, const char *line)
[c1a8ae52]605{
[032e0bb]606 /* Skip leading spaces. */
[c1a8ae52]607 line = skip_spaces(line);
[032e0bb]608
[68414f4a]609 if (!prop_parse(fun, line, "io_range", &fun_parse_io_range) &&
[b446b02]610 !prop_parse(fun, line, "mem_range", &fun_parse_mem_range) &&
[68414f4a]611 !prop_parse(fun, line, "irq", &fun_parse_irq) &&
[55a8e0cb]612 !prop_parse(fun, line, "dma", &fun_parse_dma) &&
[fc51296]613 !prop_parse(fun, line, "match", &fun_parse_match_id)) {
614
[ebcb05a]615 ddf_msg(LVL_ERROR, "Undefined device property at line '%s'",
[fc51296]616 line);
[032e0bb]617 }
[c1a8ae52]618}
619
[f278930]620static char *isa_fun_read_info(char *fun_conf, isa_bus_t *isa)
[c1a8ae52]621{
622 char *line;
[032e0bb]623
624 /* Skip empty lines. */
[1de97fe6]625 do {
[8b1e15ac]626 line = str_get_line(fun_conf, &fun_conf);
[032e0bb]627
628 if (line == NULL) {
629 /* no more lines */
[c1a8ae52]630 return NULL;
631 }
[032e0bb]632
[1de97fe6]633 } while (line_empty(line));
[032e0bb]634
635 /* Get device name. */
[3d4ad475]636 const char *fun_name = get_device_name(line);
[8b1e15ac]637 if (fun_name == NULL)
[c1a8ae52]638 return NULL;
[032e0bb]639
[f278930]640 isa_fun_t *fun = isa_fun_create(isa, fun_name);
[8b1e15ac]641 if (fun == NULL) {
[c1a8ae52]642 return NULL;
643 }
[032e0bb]644
645 /* Get properties of the device (match ids, irq and io range). */
646 while (true) {
[8b1e15ac]647 line = str_get_line(fun_conf, &fun_conf);
[032e0bb]648
[5dc9622]649 if (line_empty(line)) {
[032e0bb]650 /* no more device properties */
[5dc9622]651 break;
652 }
[032e0bb]653
654 /*
655 * Get the device's property from the configuration line
656 * and store it in the device structure.
657 */
[68414f4a]658 fun_prop_parse(fun, line);
[c1a8ae52]659 }
[032e0bb]660
661 /* Set device operations to the device. */
[56fd7cf]662 ddf_fun_set_ops(fun->fnode, &isa_fun_ops);
[97a62fe]663
[56fd7cf]664 ddf_msg(LVL_DEBUG, "Binding function %s.", ddf_fun_get_name(fun->fnode));
[032e0bb]665
[97a62fe]666 /* XXX Handle error */
667 (void) ddf_fun_bind(fun->fnode);
[032e0bb]668
[f278930]669 list_append(&fun->bus_link, &isa->functions);
670
[8b1e15ac]671 return fun_conf;
[c1a8ae52]672}
673
[0d7eb0f]674static void isa_functions_add(isa_bus_t *isa)
[c1a8ae52]675{
[7e9e652]676#define BASE_CLASS_BRIDGE 0x06
677#define SUB_CLASS_BRIDGE_ISA 0x01
678 bool isa_bridge = ((isa->pci_class == BASE_CLASS_BRIDGE) &&
679 (isa->pci_subclass == SUB_CLASS_BRIDGE_ISA));
680
[3c5b86c]681#define VENDOR_ID_SUN 0x108e
682#define DEVICE_ID_EBUS 0x1000
[7e9e652]683 bool ebus = ((isa->pci_vendor_id == VENDOR_ID_SUN) &&
684 (isa->pci_device_id == DEVICE_ID_EBUS));
[3c5b86c]685
[7e9e652]686 const char *conf_path = NULL;
687 if (isa_bridge)
[3c5b86c]688 conf_path = ISA_CHILD_FUN_CONF_PATH;
[7e9e652]689 else if (ebus)
690 conf_path = EBUS_CHILD_FUN_CONF_PATH;
[3c5b86c]691
692 char *conf = fun_conf_read(conf_path);
[032e0bb]693 while (conf != NULL && *conf != '\0') {
[f278930]694 conf = isa_fun_read_info(conf, isa);
[032e0bb]695 }
[0d7eb0f]696 free(conf);
[c1a8ae52]697}
[892e4e1]698
[b25970f]699static errno_t isa_read_pci_cfg(isa_bus_t *isa, async_sess_t *sess)
700{
701 errno_t rc;
702
703 rc = pci_config_space_read_16(sess, PCI_VENDOR_ID, &isa->pci_vendor_id);
704 if (rc != EOK)
705 return rc;
706 rc = pci_config_space_read_16(sess, PCI_DEVICE_ID, &isa->pci_device_id);
707 if (rc != EOK)
708 return rc;
709 rc = pci_config_space_read_8(sess, PCI_BASE_CLASS, &isa->pci_class);
710 if (rc != EOK)
711 return rc;
712 rc = pci_config_space_read_8(sess, PCI_SUB_CLASS, &isa->pci_subclass);
713 if (rc != EOK)
714 return rc;
715
716 return EOK;
717}
718
[b7fd2a0]719static errno_t isa_dev_add(ddf_dev_t *dev)
[892e4e1]720{
[0a428943]721 async_sess_t *sess;
[b7fd2a0]722 errno_t rc;
[0a428943]723
[0c0f823b]724 ddf_msg(LVL_DEBUG, "isa_dev_add, device handle = %d",
[56fd7cf]725 (int) ddf_dev_get_handle(dev));
[032e0bb]726
[cf56332]727 isa_bus_t *isa = ddf_dev_data_alloc(dev, sizeof(isa_bus_t));
[f278930]728 if (isa == NULL)
729 return ENOMEM;
730
731 fibril_mutex_initialize(&isa->mutex);
732 isa->dev = dev;
733 list_initialize(&isa->functions);
734
[2fd26bb]735 sess = ddf_dev_parent_sess_get(dev);
[0a428943]736 if (sess == NULL) {
737 ddf_msg(LVL_ERROR, "isa_dev_add failed to connect to the "
738 "parent driver.");
739 return ENOENT;
740 }
741
[b25970f]742 rc = isa_read_pci_cfg(isa, sess);
743 if (rc != EOK) {
744 ddf_msg(LVL_NOTE, "Cannot read PCI config. Assuming ISA classic.");
745 isa->pci_vendor_id = 0;
746 isa->pci_device_id = 0;
747 isa->pci_class = BASE_CLASS_BRIDGE;
748 isa->pci_subclass = SUB_CLASS_BRIDGE_ISA;
749 }
[a35b458]750
[0a428943]751 rc = pio_window_get(sess, &isa->pio_win);
752 if (rc != EOK) {
753 ddf_msg(LVL_ERROR, "isa_dev_add failed to get PIO window "
754 "for the device.");
755 return rc;
[1b20da0]756 }
[0a428943]757
[8b1e15ac]758 /* Make the bus device more visible. Does not do anything. */
[ebcb05a]759 ddf_msg(LVL_DEBUG, "Adding a 'ctl' function");
[8b1e15ac]760
[f278930]761 fibril_mutex_lock(&isa->mutex);
762
763 isa->fctl = ddf_fun_create(dev, fun_exposed, "ctl");
764 if (isa->fctl == NULL) {
[ebcb05a]765 ddf_msg(LVL_ERROR, "Failed creating control function.");
[97a62fe]766 return EXDEV;
767 }
768
[f278930]769 if (ddf_fun_bind(isa->fctl) != EOK) {
770 ddf_fun_destroy(isa->fctl);
[ebcb05a]771 ddf_msg(LVL_ERROR, "Failed binding control function.");
[97a62fe]772 return EXDEV;
773 }
[8b1e15ac]774
[68414f4a]775 /* Add functions as specified in the configuration file. */
[f278930]776 isa_functions_add(isa);
[ebcb05a]777 ddf_msg(LVL_NOTE, "Finished enumerating legacy functions");
[032e0bb]778
[f278930]779 fibril_mutex_unlock(&isa->mutex);
780
781 return EOK;
782}
783
[b7fd2a0]784static errno_t isa_dev_remove(ddf_dev_t *dev)
[f278930]785{
[56fd7cf]786 isa_bus_t *isa = isa_bus(dev);
[f278930]787
788 fibril_mutex_lock(&isa->mutex);
789
790 while (!list_empty(&isa->functions)) {
791 isa_fun_t *fun = list_get_instance(list_first(&isa->functions),
792 isa_fun_t, bus_link);
793
[b7fd2a0]794 errno_t rc = ddf_fun_offline(fun->fnode);
[f278930]795 if (rc != EOK) {
796 fibril_mutex_unlock(&isa->mutex);
[56fd7cf]797 ddf_msg(LVL_ERROR, "Failed offlining %s", ddf_fun_get_name(fun->fnode));
[f278930]798 return rc;
799 }
800
801 rc = ddf_fun_unbind(fun->fnode);
802 if (rc != EOK) {
803 fibril_mutex_unlock(&isa->mutex);
[56fd7cf]804 ddf_msg(LVL_ERROR, "Failed unbinding %s", ddf_fun_get_name(fun->fnode));
[f278930]805 return rc;
806 }
807
808 list_remove(&fun->bus_link);
809
810 ddf_fun_destroy(fun->fnode);
811 }
812
813 if (ddf_fun_unbind(isa->fctl) != EOK) {
814 fibril_mutex_unlock(&isa->mutex);
815 ddf_msg(LVL_ERROR, "Failed unbinding control function.");
816 return EXDEV;
817 }
818
819 fibril_mutex_unlock(&isa->mutex);
820
[df747b9c]821 return EOK;
[892e4e1]822}
823
[b7fd2a0]824static errno_t isa_fun_online(ddf_fun_t *fun)
[5b68e0c]825{
826 ddf_msg(LVL_DEBUG, "isa_fun_online()");
827 return ddf_fun_online(fun);
828}
829
[b7fd2a0]830static errno_t isa_fun_offline(ddf_fun_t *fun)
[5b68e0c]831{
832 ddf_msg(LVL_DEBUG, "isa_fun_offline()");
833 return ddf_fun_offline(fun);
834}
835
[892e4e1]836int main(int argc, char *argv[])
837{
[032e0bb]838 printf(NAME ": HelenOS ISA bus driver\n");
[03362fbd]839 ddf_log_init(NAME);
[83a2f43]840 return ddf_driver_main(&isa_driver);
[892e4e1]841}
842
843/**
844 * @}
845 */
Note: See TracBrowser for help on using the repository browser.