| 32,6 → 32,7 |
|---|
| /** @file |
| */ |
| |
| #include <arch/cpu_family.h> |
| #include <cpu.h> |
| #include <arch.h> |
| #include <genarch/ofw/ofw_tree.h> |
| 39,6 → 40,38 |
|---|
| #include <print.h> |
| #include <arch/cpu_node.h> |
| |
| /** |
| * Finds out the clock frequency of the current CPU. |
| * |
| * @param node node representing the current CPU in the OFW tree |
| * @return clock frequency if "node" is the current CPU and no error |
| * occurs, -1 if "node" is not the current CPU or on error |
| */ |
| static int find_cpu_frequency(ofw_tree_node_t *node) |
| { |
| ofw_tree_property_t *prop; |
| uint32_t mid; |
| |
| /* 'upa-portid' for US, 'portid' for US-III, 'cpuid' for US-IV */ |
| prop = ofw_tree_getprop(node, "upa-portid"); |
| if ((!prop) || (!prop->value)) |
| prop = ofw_tree_getprop(node, "portid"); |
| if ((!prop) || (!prop->value)) |
| prop = ofw_tree_getprop(node, "cpuid"); |
| |
| if (prop && prop->value) { |
| mid = *((uint32_t *) prop->value); |
| if (mid == CPU->arch.mid) { |
| prop = ofw_tree_getprop(node, "clock-frequency"); |
| if (prop && prop->value) { |
| return *((uint32_t *) prop->value); |
| } |
| } |
| } |
| |
| return -1; |
| } |
| |
| /** Perform sparc64 specific initialization of the processor structure for the |
| * current processor. |
| */ |
| 45,7 → 78,6 |
|---|
| void cpu_arch_init(void) |
| { |
| ofw_tree_node_t *node; |
| uint32_t mid; |
| uint32_t clock_frequency = 0; |
| icbus_config_t icbus_config; |
| |
| 55,24 → 87,28 |
|---|
| /* |
| * Detect processor frequency. |
| */ |
| node = ofw_tree_find_child_by_device_type(cpus_parent(), "cpu"); |
| while (node) { |
| ofw_tree_property_t *prop; |
| |
| prop = ofw_tree_getprop(node, PORTID_NAME); |
| if (prop && prop->value) { |
| mid = *((uint32_t *) prop->value); |
| if (mid == CPU->arch.mid) { |
| prop = ofw_tree_getprop(node, |
| "clock-frequency"); |
| if (prop && prop->value) |
| clock_frequency = *((uint32_t *) |
| prop->value); |
| } |
| if (is_us() || is_us_iii()) { |
| node = ofw_tree_find_child_by_device_type(cpus_parent(), "cpu"); |
| while (node) { |
| int f = find_cpu_frequency(node); |
| if (f != -1) |
| clock_frequency = (uint32_t) f; |
| node = ofw_tree_find_peer_by_device_type(node, "cpu"); |
| } |
| node = ofw_tree_find_peer_by_device_type(node, "cpu"); |
| } else if (is_us_iv()) { |
| node = ofw_tree_find_child(cpus_parent(), "cmp"); |
| while (node) { |
| int f; |
| f = find_cpu_frequency(ofw_tree_find_child(node, "cpu@0")); |
| if (f != -1) |
| clock_frequency = (uint32_t) f; |
| f = find_cpu_frequency(ofw_tree_find_child(node, "cpu@1")); |
| if (f != -1) |
| clock_frequency = (uint32_t) f; |
| node = ofw_tree_find_peer_by_name(node, "cmp"); |
| } |
| } |
| |
| |
| CPU->arch.clock_frequency = clock_frequency; |
| tick_init(); |
| } |