Subversion Repositories HelenOS

Rev

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

  1. /*
  2.  * Copyright (c) 2006 Jakub Jermar
  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 ofw
  30.  * @{
  31.  */
  32. /**
  33.  * @file
  34.  * @brief   FHC 'reg' and 'ranges' properties handling.
  35.  *
  36.  */
  37.  
  38. #include <genarch/ofw/ofw_tree.h>
  39. #include <arch/drivers/fhc.h>
  40. #include <arch/memstr.h>
  41. #include <func.h>
  42. #include <panic.h>
  43. #include <macros.h>
  44.  
  45. bool ofw_fhc_apply_ranges(ofw_tree_node_t *node, ofw_fhc_reg_t *reg, uintptr_t *pa)
  46. {
  47.     ofw_tree_property_t *prop;
  48.     ofw_fhc_range_t *range;
  49.     count_t ranges;
  50.  
  51.     prop = ofw_tree_getprop(node, "ranges");
  52.     if (!prop)
  53.         return false;
  54.        
  55.     ranges = prop->size / sizeof(ofw_fhc_range_t);
  56.     range = prop->value;
  57.    
  58.     int i;
  59.    
  60.     for (i = 0; i < ranges; i++) {
  61.         if (overlaps(reg->addr, reg->size, range[i].child_base, range[i].size)) {
  62.             uintptr_t addr;
  63.            
  64.             addr = range[i].parent_base + (reg->addr - range[i].child_base);
  65.             if (!node->parent->parent) {
  66.                 *pa = addr;
  67.                 return true;
  68.             }
  69.             if (strcmp(ofw_tree_node_name(node->parent), "central") != 0)
  70.                 panic("Unexpected parent node: %s.\n", ofw_tree_node_name(node->parent));
  71.            
  72.             ofw_central_reg_t central_reg;
  73.            
  74.             central_reg.addr = addr;
  75.             central_reg.size = reg->size;
  76.            
  77.             return ofw_central_apply_ranges(node->parent, &central_reg, pa);
  78.         }
  79.     }
  80.  
  81.     return false;
  82. }
  83.  
  84. bool ofw_central_apply_ranges(ofw_tree_node_t *node, ofw_central_reg_t *reg, uintptr_t *pa)
  85. {
  86.     if (node->parent->parent)
  87.         panic("Unexpected parent node: %s.\n", ofw_tree_node_name(node->parent));
  88.    
  89.     ofw_tree_property_t *prop;
  90.     ofw_central_range_t *range;
  91.     count_t ranges;
  92.    
  93.     prop = ofw_tree_getprop(node, "ranges");
  94.     if (!prop)
  95.         return false;
  96.        
  97.     ranges = prop->size / sizeof(ofw_central_range_t);
  98.     range = prop->value;
  99.    
  100.     int i;
  101.    
  102.     for (i = 0; i < ranges; i++) {
  103.         if (overlaps(reg->addr, reg->size, range[i].child_base, range[i].size)) {
  104.             *pa = range[i].parent_base + (reg->addr - range[i].child_base);
  105.             return true;
  106.         }
  107.     }
  108.    
  109.     return false;
  110. }
  111.  
  112. bool ofw_fhc_map_interrupt(ofw_tree_node_t *node, ofw_fhc_reg_t *reg, uint32_t interrupt, int *inr)
  113. {
  114.     fhc_t *fhc = NULL;
  115.     if (!node->device) {
  116.         fhc = fhc_init(node);
  117.         if (!fhc)
  118.             return false;
  119.         node->device = fhc;
  120.         central_fhc = fhc;
  121.     }
  122.    
  123.     /*
  124.      * The interrupt controller for the interrupt is the FHC itself.
  125.      */
  126.     fhc_enable_interrupt(fhc, interrupt);
  127.    
  128.     *inr = interrupt;
  129.     return true;
  130. }
  131.  
  132. /** @}
  133.  */
  134.