Subversion Repositories HelenOS

Rev

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

Rev Author Line No. Line
885 decky 1
/*
2071 jermar 2
 * Copyright (c) 2005 Martin Decky
3
 * Copyright (c) 2006 Jakub Jermar
885 decky 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
 */
1789 jermar 29
 
30
/**
31
 * @file
32
 * @brief   Architecture dependent parts of OpenFirmware interface.
33
 */
34
 
35
#include <ofwarch.h>  
1764 jermar 36
#include <ofw.h>
37
#include <printf.h>
1881 jermar 38
#include <string.h>
1903 jermar 39
#include <register.h>
1881 jermar 40
#include "main.h"
1978 jermar 41
#include "asm.h"
885 decky 42
 
1764 jermar 43
void write(const char *str, const int len)
885 decky 44
{
1773 jermar 45
    int i;
46
 
47
    for (i = 0; i < len; i++) {
48
        if (str[i] == '\n')
49
            ofw_write("\r", 1);
50
        ofw_write(&str[i], 1);
51
    }
885 decky 52
}
1783 jermar 53
 
54
int ofw_translate_failed(ofw_arg_t flag)
55
{
56
    return flag != -1;
57
}
1789 jermar 58
 
1899 jermar 59
int ofw_cpu(void)
1881 jermar 60
{
61
    char type_name[BUF_SIZE];
62
 
63
    phandle node;
64
    node = ofw_get_child_node(ofw_root);
65
    if (node == 0 || node == -1) {
66
        printf("Could not find any child nodes of the root node.\n");
1899 jermar 67
        return 0;
1881 jermar 68
    }
69
 
1899 jermar 70
    uint64_t current_mid;
71
 
3424 svoboda 72
    asm volatile ("ldxa [%1] %2, %0\n"
73
        : "=r" (current_mid)
74
        : "r" (0), "i" (ASI_UPA_CONFIG));
1899 jermar 75
    current_mid >>= UPA_CONFIG_MID_SHIFT;
76
    current_mid &= UPA_CONFIG_MID_MASK;
1903 jermar 77
 
78
    int cpus;
1899 jermar 79
 
3424 svoboda 80
    for (cpus = 0; node != 0 && node != -1; node = ofw_get_peer_node(node),
81
        cpus++) {
82
        if (ofw_get_property(node, "device_type", type_name,
83
            sizeof(type_name)) > 0) {
1896 jermar 84
            if (strcmp(type_name, "cpu") == 0) {
1899 jermar 85
                uint32_t mid;
1881 jermar 86
 
3424 svoboda 87
                if (ofw_get_property(node, "upa-portid", &mid,
88
                    sizeof(mid)) <= 0)
1881 jermar 89
                    continue;
90
 
1899 jermar 91
                if (current_mid != mid) {
92
                    /*
93
                     * Start secondary processor.
94
                     */
3424 svoboda 95
                    (void) ofw_call("SUNW,start-cpu", 3, 1,
96
                        NULL, node, KERNEL_VIRTUAL_ADDRESS,
97
                        bootinfo.physmem_start |
98
                        AP_PROCESSOR);
1899 jermar 99
                }
1881 jermar 100
            }
101
        }
1899 jermar 102
    }
1881 jermar 103
 
1903 jermar 104
    return cpus;
1881 jermar 105
}
1978 jermar 106
 
107
/** Get physical memory starting address.
108
 *
109
 * @param start Pointer to variable where the physical memory starting
110
 *      address will be stored.
111
 *
112
 * @return Non-zero on succes, zero on failure.
113
 */
114
int ofw_get_physmem_start(uintptr_t *start)
115
{
116
    uint32_t memreg[4];
117
 
118
    if (ofw_get_property(ofw_memory, "reg", &memreg, sizeof(memreg)) <= 0)
119
        return 0;
120
 
121
    *start = (((uint64_t) memreg[0]) << 32) | memreg[1];
122
    return 1;
123
}
124