Subversion Repositories HelenOS

Rev

Rev 1896 | Rev 1910 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1896 jermar 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>
1909 jermar 39
#include <arch/drivers/fhc.h>
1896 jermar 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
 
1909 jermar 112
bool ofw_fhc_map_interrupts(ofw_tree_node_t *node, ofw_fhc_reg_t *reg, uint32_t interrupt, int *ino)
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
    *ino = interrupt;
129
    return true;
130
}
131
 
1896 jermar 132
/** @}
133
 */