Subversion Repositories HelenOS

Rev

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

Rev Author Line No. Line
885 decky 1 
/*
2 
 * Copyright (C) 2005 Martin Decky
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 
 */
1789 jermar 28 
 
29 
/**
30 
 * @file
31 
 * @brief   Architecture dependent parts of OpenFirmware interface.
32 
 */
33 
 
34 
#include <ofwarch.h>  
1764 jermar 35 
#include <ofw.h>
36 
#include <printf.h>
1881 jermar 37 
#include <string.h>
1903 jermar 38 
#include <register.h>
1881 jermar 39 
#include "main.h"
885 decky 40 
 
1764 jermar 41 
void write(const char *str, const int len)
885 decky 42 
{
1773 jermar 43 
    int i;
44 
 
45 
    for (i = 0; i < len; i++) {
46 
        if (str[i] == '\n')
47 
            ofw_write("\r", 1);
48 
        ofw_write(&str[i], 1);
49 
    }
885 decky 50 
}
1783 jermar 51 
 
52 
int ofw_translate_failed(ofw_arg_t flag)
53 
{
54 
    return flag != -1;
55 
}
1789 jermar 56 
 
1899 jermar 57 
int ofw_cpu(void)
1881 jermar 58 
{
59 
    char type_name[BUF_SIZE];
60 
 
61 
    phandle node;
62 
    node = ofw_get_child_node(ofw_root);
63 
    if (node == 0 || node == -1) {
64 
        printf("Could not find any child nodes of the root node.\n");
1899 jermar 65 
        return 0;
1881 jermar 66 
    }
67 
 
1899 jermar 68 
    uint64_t current_mid;
69 
 
70 
    __asm__ volatile ("ldxa [%1] %2, %0\n" : "=r" (current_mid) : "r" (0), "i" (ASI_UPA_CONFIG));
71 
    current_mid >>= UPA_CONFIG_MID_SHIFT;
72 
    current_mid &= UPA_CONFIG_MID_MASK;
1903 jermar 73 
 
74 
    int cpus;
1899 jermar 75 
 
1903 jermar 76 
    for (cpus = 0; node != 0 && node != -1; node = ofw_get_peer_node(node), cpus++) {
1881 jermar 77 
        if (ofw_get_property(node, "device_type", type_name, sizeof(type_name)) > 0) {
1896 jermar 78 
            if (strcmp(type_name, "cpu") == 0) {
1899 jermar 79 
                uint32_t mid;
1881 jermar 80 
 
1899 jermar 81 
                if (ofw_get_property(node, "upa-portid", &mid, sizeof(mid)) <= 0)
1881 jermar 82 
                    continue;
83 
 
1899 jermar 84 
                if (current_mid != mid) {
85 
                    /*
86 
                     * Start secondary processor.
87 
                     */
88 
                    (void) ofw_call("SUNW,start-cpu", 3, 1, NULL, node, KERNEL_VIRTUAL_ADDRESS, 0);
89 
                }
1881 jermar 90 
            }
91 
        }
1899 jermar 92 
    }
1881 jermar 93 
 
1903 jermar 94 
    return cpus;
1881 jermar 95 
}