Rev 3674 | Details | Compare with Previous | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 1191 | jermar | 1 | /* |
| 4338 | svoboda | 2 | * Copyright (c) 2006 Jakub Jermar |
| 3 | * Copyright (c) 2008 Jakub vana |
||
| 1191 | jermar | 4 | * All rights reserved. |
| 5 | * |
||
| 6 | * Redistribution and use in source and binary forms, with or without |
||
| 7 | * modification, are permitted provided that the following conditions |
||
| 8 | * are met: |
||
| 9 | * |
||
| 10 | * - Redistributions of source code must retain the above copyright |
||
| 11 | * notice, this list of conditions and the following disclaimer. |
||
| 12 | * - Redistributions in binary form must reproduce the above copyright |
||
| 13 | * notice, this list of conditions and the following disclaimer in the |
||
| 14 | * documentation and/or other materials provided with the distribution. |
||
| 15 | * - The name of the author may not be used to endorse or promote products |
||
| 16 | * derived from this software without specific prior written permission. |
||
| 17 | * |
||
| 18 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
||
| 19 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
||
| 20 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
||
| 21 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
||
| 22 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
||
| 23 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
||
| 24 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
||
| 25 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
||
| 26 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
||
| 27 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
||
| 28 | */ |
||
| 29 | |||
| 1731 | jermar | 30 | /** @addtogroup ia64ddi |
| 1702 | cejka | 31 | * @{ |
| 32 | */ |
||
| 33 | /** @file |
||
| 34 | */ |
||
| 35 | |||
| 1191 | jermar | 36 | #include <ddi/ddi.h> |
| 37 | #include <proc/task.h> |
||
| 38 | #include <arch/types.h> |
||
| 3674 | svoboda | 39 | #include <mm/slab.h> |
| 40 | #include <errno.h> |
||
| 1191 | jermar | 41 | |
| 4338 | svoboda | 42 | #define IO_MEMMAP_PAGES 16384 |
| 43 | #define PORTS_PER_PAGE 4 |
||
| 3674 | svoboda | 44 | |
| 1191 | jermar | 45 | /** Enable I/O space range for task. |
| 46 | * |
||
| 47 | * Interrupts are disabled and task is locked. |
||
| 48 | * |
||
| 4338 | svoboda | 49 | * @param task Task. |
| 50 | * @param ioaddr Starting I/O space address. |
||
| 51 | * @param size Size of the enabled I/O range. |
||
| 1191 | jermar | 52 | * |
| 53 | * @return 0 on success or an error code from errno.h. |
||
| 54 | */ |
||
| 1780 | jermar | 55 | int ddi_iospace_enable_arch(task_t *task, uintptr_t ioaddr, size_t size) |
| 1191 | jermar | 56 | { |
| 4338 | svoboda | 57 | if (!task->arch.iomap) { |
| 58 | uint8_t *map; |
||
| 3674 | svoboda | 59 | |
| 4338 | svoboda | 60 | task->arch.iomap = malloc(sizeof(bitmap_t), 0); |
| 61 | map = malloc(BITS2BYTES(IO_MEMMAP_PAGES), 0); |
||
| 3674 | svoboda | 62 | if(!map) |
| 63 | return ENOMEM; |
||
| 4338 | svoboda | 64 | bitmap_initialize(task->arch.iomap, map, IO_MEMMAP_PAGES); |
| 65 | bitmap_clear_range(task->arch.iomap, 0, IO_MEMMAP_PAGES); |
||
| 3674 | svoboda | 66 | } |
| 67 | |||
| 68 | uintptr_t iopage = ioaddr / PORTS_PER_PAGE; |
||
| 4338 | svoboda | 69 | size = ALIGN_UP(size + ioaddr - 4 * iopage, PORTS_PER_PAGE); |
| 70 | bitmap_set_range(task->arch.iomap, iopage, size / 4); |
||
| 3674 | svoboda | 71 | |
| 1191 | jermar | 72 | return 0; |
| 73 | } |
||
| 1702 | cejka | 74 | |
| 1731 | jermar | 75 | /** @} |
| 1702 | cejka | 76 | */ |