Subversion Repositories HelenOS

Rev

Rev 1897 | Rev 1903 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1897 Rev 1899
1 
/*
 1 
/*
2 
 * Copyright (C) 2005 Martin Decky
 2 
 * Copyright (C) 2005 Martin Decky
3 
 * All rights reserved.
 3 
 * All rights reserved.
4 
 *
 4 
 *
5 
 * Redistribution and use in source and binary forms, with or without
 5 
 * Redistribution and use in source and binary forms, with or without
6 
 * modification, are permitted provided that the following conditions
 6 
 * modification, are permitted provided that the following conditions
7 
 * are met:
 7 
 * are met:
8 
 *
 8 
 *
9 
 * - Redistributions of source code must retain the above copyright
 9 
 * - Redistributions of source code must retain the above copyright
10 
 *   notice, this list of conditions and the following disclaimer.
 10 
 *   notice, this list of conditions and the following disclaimer.
11 
 * - Redistributions in binary form must reproduce the above copyright
 11 
 * - Redistributions in binary form must reproduce the above copyright
12 
 *   notice, this list of conditions and the following disclaimer in the
 12 
 *   notice, this list of conditions and the following disclaimer in the
13 
 *   documentation and/or other materials provided with the distribution.
 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
 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.
 15 
 *   derived from this software without specific prior written permission.
16 
 *
 16 
 *
17 
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 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
 18 
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 19 
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 20 
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 21 
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 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
 23 
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 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
 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.
 26 
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 
 */
 27 
 */
28 
 
 28 
 
29 
/**
 29 
/**
30 
 * @file
 30 
 * @file
31 
 * @brief   Architecture dependent parts of OpenFirmware interface.
 31 
 * @brief   Architecture dependent parts of OpenFirmware interface.
32 
 */
 32 
 */
33 
 
 33 
 
34 
#include <ofwarch.h>  
 34 
#include <ofwarch.h>  
35 
#include <ofw.h>
 35 
#include <ofw.h>
36 
#include <printf.h>
 36 
#include <printf.h>
37 
#include <string.h>
 37 
#include <string.h>
38 
#include "main.h"
 38 
#include "main.h"
39 
 
 39 
 
40 
void write(const char *str, const int len)
 40 
void write(const char *str, const int len)
41 
{
 41 
{
42 
    int i;
 42 
    int i;
43 
   
 43 
   
44 
    for (i = 0; i < len; i++) {
 44 
    for (i = 0; i < len; i++) {
45 
        if (str[i] == '\n')
 45 
        if (str[i] == '\n')
46 
            ofw_write("\r", 1);
 46 
            ofw_write("\r", 1);
47 
        ofw_write(&str[i], 1);
 47 
        ofw_write(&str[i], 1);
48 
    }
 48 
    }
49 
}
 49 
}
50 
 
 50 
 
51 
int ofw_translate_failed(ofw_arg_t flag)
 51 
int ofw_translate_failed(ofw_arg_t flag)
52 
{
 52 
{
53 
    return flag != -1;
 53 
    return flag != -1;
54 
}
 54 
}
55 
 
 55 
 
- 
 
 56 
 
- 
 
 57 
#define ASI_UPA_CONFIG      0x4a
- 
 
 58 
#define UPA_CONFIG_MID_SHIFT    17
- 
 
 59 
#define UPA_CONFIG_MID_MASK 0x1f
- 
 
 60 
 
56 
int ofw_cpu(cpu_t *cpu)
 61 
int ofw_cpu(void)
57 
{
 62 
{
58 
    char type_name[BUF_SIZE];
 63 
    char type_name[BUF_SIZE];
59 
 
 64 
 
60 
    phandle node;
 65 
    phandle node;
61 
    node = ofw_get_child_node(ofw_root);
 66 
    node = ofw_get_child_node(ofw_root);
62 
    if (node == 0 || node == -1) {
 67 
    if (node == 0 || node == -1) {
63 
        printf("Could not find any child nodes of the root node.\n");
 68 
        printf("Could not find any child nodes of the root node.\n");
64 
        return;
 69 
        return 0;
65 
    }
 70 
    }
66 
   
 71 
   
- 
 
 72 
    uint64_t current_mid;
- 
 
 73 
   
- 
 
 74 
    __asm__ volatile ("ldxa [%1] %2, %0\n" : "=r" (current_mid) : "r" (0), "i" (ASI_UPA_CONFIG));
- 
 
 75 
    current_mid >>= UPA_CONFIG_MID_SHIFT;
- 
 
 76 
    current_mid &= UPA_CONFIG_MID_MASK;
- 
 
 77 
   
67 
    for (; node != 0 && node != -1; node = ofw_get_peer_node(node)) {
 78 
    for (; node != 0 && node != -1; node = ofw_get_peer_node(node)) {
68 
        if (ofw_get_property(node, "device_type", type_name, sizeof(type_name)) > 0) {
 79 
        if (ofw_get_property(node, "device_type", type_name, sizeof(type_name)) > 0) {
69 
            if (strcmp(type_name, "cpu") == 0) {
 80 
            if (strcmp(type_name, "cpu") == 0) {
70 
                uint32_t mhz;
 81 
                uint32_t mid;
71 
               
 82 
               
72 
                if (ofw_get_property(node, "clock-frequency", &mhz, sizeof(mhz)) <= 0)
 83 
                if (ofw_get_property(node, "upa-portid", &mid, sizeof(mid)) <= 0)
73 
                    continue;
 84 
                    continue;
74 
                   
 85 
                   
75 
                cpu->clock_frequency = mhz;
 86 
                if (current_mid != mid) {
- 
 
 87 
                    /*
- 
 
 88 
                     * Start secondary processor.
76 
                return 1;
 89 
                     */
- 
 
 90 
                    (void) ofw_call("SUNW,start-cpu", 3, 1, NULL, node, KERNEL_VIRTUAL_ADDRESS, 0);
- 
 
 91 
                }
77 
            }
 92 
            }
78 
        }
 93 
        }
79 
    };
 94 
    }
80 
 
 95 
 
81 
    return 0;
 96 
    return 1;
82 
}
 97 
}
83 
 
 98