source: mainline/kernel/generic/src/cpu/cpu.c@ d1da1ff2

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since d1da1ff2 was d1da1ff2, checked in by Jiří Zárevúcky <zarevucky.jiri@…>, 7 years ago

Fix kernel stack allocation

  • Property mode set to 100644
File size: 3.3 KB
RevLine 
[ae7d03c]1/*
[df4ed85]2 * Copyright (c) 2001-2004 Jakub Jermar
[f761f1eb]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 */
28
[174156fd]29/** @addtogroup kernel_generic
[b45c443]30 * @{
31 */
32
[cf26ba9]33/**
[b45c443]34 * @file
[da1bafb]35 * @brief CPU subsystem initialization and listing.
[cf26ba9]36 */
[da1bafb]37
[f761f1eb]38#include <cpu.h>
[43114c5]39#include <arch.h>
[f761f1eb]40#include <arch/cpu.h>
[085d973]41#include <mm/slab.h>
[f761f1eb]42#include <mm/page.h>
43#include <mm/frame.h>
[d99c1d2]44#include <typedefs.h>
[f761f1eb]45#include <config.h>
46#include <panic.h>
[44a7ee5]47#include <mem.h>
[5c9a08b]48#include <adt/list.h>
[bab75df6]49#include <stdio.h>
[62550dce]50#include <sysinfo/sysinfo.h>
[d0c82c5]51#include <arch/cycle.h>
[181a746]52#include <synch/rcu.h>
[f761f1eb]53
54cpu_t *cpus;
55
[673104e]56/** Initialize CPUs
57 *
58 * Initialize kernel CPUs support.
59 *
60 */
[1433ecda]61void cpu_init(void)
62{
[4e33b6b]63#ifdef CONFIG_SMP
[f761f1eb]64 if (config.cpu_active == 1) {
[4e33b6b]65#endif /* CONFIG_SMP */
[a35b458]66
[11b285d]67 cpus = (cpu_t *) malloc(sizeof(cpu_t) * config.cpu_count);
[f761f1eb]68 if (!cpus)
[f651e80]69 panic("Cannot allocate CPU structures.");
[a35b458]70
[da1bafb]71 /* Initialize everything */
[3bacee1]72 memsetb(cpus, sizeof(cpu_t) * config.cpu_count, 0);
[a35b458]73
[d1da1ff2]74 // XXX: All kernel stacks must be aligned to STACK_SIZE,
75 // see get_current().
[da1bafb]76 size_t i;
[8ecb3067]77 for (i = 0; i < config.cpu_count; i++) {
[cd3b380]78 uintptr_t stack_phys = frame_alloc(STACK_FRAMES,
79 FRAME_LOWMEM | FRAME_ATOMIC, STACK_SIZE - 1);
80 if (!stack_phys)
81 panic("Cannot allocate CPU stack.");
[a35b458]82
[cd3b380]83 cpus[i].stack = (uint8_t *) PA2KA(stack_phys);
[f761f1eb]84 cpus[i].id = i;
[a35b458]85
[da1bafb]86 irq_spinlock_initialize(&cpus[i].lock, "cpus[].lock");
[a35b458]87
[cd3b380]88 for (unsigned int j = 0; j < RQ_COUNT; j++) {
[da1bafb]89 irq_spinlock_initialize(&cpus[i].rq[j].lock, "cpus[].rq[].lock");
[55b77d9]90 list_initialize(&cpus[i].rq[j].rq);
[f761f1eb]91 }
92 }
[a35b458]93
[4e33b6b]94#ifdef CONFIG_SMP
[f761f1eb]95 }
[4e33b6b]96#endif /* CONFIG_SMP */
[a35b458]97
[76fca31]98 CPU = &cpus[config.cpu_active - 1];
[a35b458]99
[da1bafb]100 CPU->active = true;
101 CPU->tlb_active = true;
[a35b458]102
[d0c82c5]103 CPU->idle = false;
104 CPU->last_cycle = get_cycle();
105 CPU->idle_cycles = 0;
106 CPU->busy_cycles = 0;
[a35b458]107
[f761f1eb]108 cpu_identify();
109 cpu_arch_init();
[181a746]110 rcu_cpu_init();
[f761f1eb]111}
[0132630]112
113/** List all processors. */
114void cpu_list(void)
115{
[7e752b2]116 unsigned int i;
[a35b458]117
[0132630]118 for (i = 0; i < config.cpu_count; i++) {
119 if (cpus[i].active)
120 cpu_print_report(&cpus[i]);
121 else
[0f269c2]122 printf("cpu%u: not active\n", i);
[0132630]123 }
124}
[b45c443]125
[9a5b556]126/** @}
[b45c443]127 */
Note: See TracBrowser for help on using the repository browser.