Subversion Repositories HelenOS

Rev

Rev 3022 | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (c) 2006 Jakub Jermar
  3.  * Copyright (c) 2008 Jakub vana
  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.  
  30. /** @addtogroup ia64ddi
  31.  * @{
  32.  */
  33. /** @file
  34.  */
  35.  
  36. #include <ddi/ddi.h>
  37. #include <proc/task.h>
  38. #include <arch/types.h>
  39. #include <mm/slab.h>
  40. #include <errno.h>
  41.  
  42. #define IO_MEMMAP_PAGES 16384
  43. #define PORTS_PER_PAGE  4
  44.  
  45. /** Enable I/O space range for task.
  46.  *
  47.  * Interrupts are disabled and task is locked.
  48.  *
  49.  * @param task      Task.
  50.  * @param ioaddr    Starting I/O space address.
  51.  * @param size      Size of the enabled I/O range.
  52.  *
  53.  * @return 0 on success or an error code from errno.h.
  54.  */
  55. int ddi_iospace_enable_arch(task_t *task, uintptr_t ioaddr, size_t size)
  56. {
  57.     if (!task->arch.iomap) {
  58.         uint8_t *map;
  59.  
  60.         task->arch.iomap = malloc(sizeof(bitmap_t), 0);
  61.         map = malloc(BITS2BYTES(IO_MEMMAP_PAGES), 0);
  62.         if(!map)
  63.             return ENOMEM;
  64.         bitmap_initialize(task->arch.iomap, map, IO_MEMMAP_PAGES);
  65.         bitmap_clear_range(task->arch.iomap, 0, IO_MEMMAP_PAGES);
  66.     }
  67.    
  68.     uintptr_t iopage = ioaddr / PORTS_PER_PAGE;
  69.     size = ALIGN_UP(size + ioaddr - 4 * iopage, PORTS_PER_PAGE);
  70.     bitmap_set_range(task->arch.iomap, iopage, size / 4);
  71.  
  72.     return 0;
  73. }
  74.  
  75. /** @}
  76.  */
  77.