Subversion Repositories HelenOS

Rev

Rev 2927 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

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