Subversion Repositories HelenOS

Rev

Rev 2082 | 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
 
2082 decky 72
    asm volatile ("ldxa [%1] %2, %0\n" : "=r" (current_mid) : "r" (0), "i" (ASI_UPA_CONFIG));
1899 jermar 73
    current_mid >>= UPA_CONFIG_MID_SHIFT;
74
    current_mid &= UPA_CONFIG_MID_MASK;
1903 jermar 75
 
76
    int cpus;
1899 jermar 77
 
1903 jermar 78
    for (cpus = 0; node != 0 && node != -1; node = ofw_get_peer_node(node), cpus++) {
1881 jermar 79
        if (ofw_get_property(node, "device_type", type_name, sizeof(type_name)) > 0) {
1896 jermar 80
            if (strcmp(type_name, "cpu") == 0) {
1899 jermar 81
                uint32_t mid;
1881 jermar 82
 
1899 jermar 83
                if (ofw_get_property(node, "upa-portid", &mid, sizeof(mid)) <= 0)
1881 jermar 84
                    continue;
85
 
1899 jermar 86
                if (current_mid != mid) {
87
                    /*
88
                     * Start secondary processor.
89
                     */
1978 jermar 90
                    (void) ofw_call("SUNW,start-cpu", 3, 1, NULL, node,
91
                         KERNEL_VIRTUAL_ADDRESS,
92
                         bootinfo.physmem_start | AP_PROCESSOR);
1899 jermar 93
                }
1881 jermar 94
            }
95
        }
1899 jermar 96
    }
1881 jermar 97
 
1903 jermar 98
    return cpus;
1881 jermar 99
}
1978 jermar 100
 
101
/** Get physical memory starting address.
102
 *
103
 * @param start Pointer to variable where the physical memory starting
104
 *      address will be stored.
105
 *
106
 * @return Non-zero on succes, zero on failure.
107
 */
108
int ofw_get_physmem_start(uintptr_t *start)
109
{
110
    uint32_t memreg[4];
111
 
112
    if (ofw_get_property(ofw_memory, "reg", &memreg, sizeof(memreg)) <= 0)
113
        return 0;
114
 
115
    *start = (((uint64_t) memreg[0]) << 32) | memreg[1];
116
    return 1;
117
}
118