98eeb96135
This patch creates a new commonlib/bsd subdirectory with a similar purpose to the existing commonlib, with the difference that all files under this subdirectory shall be licensed under the BSD-3-Clause license (or compatible permissive license). The goal is to allow more code to be shared with libpayload in the future. Initially, I'm going to move a few files there that have already been BSD-licensed in the existing commonlib. I am also exracting most contents of the often-needed <commonlib/helpers.h> as long as they have either been written by me (and are hereby relicensed) or have an existing equivalent in BSD-licensed libpayload code. I am also relicensing <commonlib/compression.h> (written by me) and <commonlib/compiler.h> (same stuff exists in libpayload). Finally, I am extracting the cb_err error code definitions from <types.h> into a new BSD-licensed header so that future commonlib/bsd code can build upon a common set of error values. I am making the assumption here that the enum constants and the half-sentence fragments of documentation next to them by themselves do not meet the threshold of copyrightability. Change-Id: I316cea70930f131e8e93d4218542ddb5ae4b63a2 Signed-off-by: Julius Werner <jwerner@chromium.org> Reviewed-on: https://review.coreboot.org/c/coreboot/+/38420 Tested-by: build bot (Jenkins) <no-reply@coreboot.org> Reviewed-by: Patrick Rudolph <siro@das-labor.org>
88 lines
2.1 KiB
C
88 lines
2.1 KiB
C
/*
|
|
* This file is part of the coreboot project.
|
|
*
|
|
* Copyright (C) 2018 HardenedLinux.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; version 2 of the License.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*/
|
|
|
|
#include <stddef.h>
|
|
#include <arch/encoding.h>
|
|
#include <arch/smp/smp.h>
|
|
#include <arch/smp/spinlock.h>
|
|
#include <mcall.h>
|
|
#include <console/console.h>
|
|
|
|
void smp_pause(int working_hartid)
|
|
{
|
|
#define SYNCA (OTHER_HLS(working_hartid)->entry.sync_a)
|
|
#define SYNCB (OTHER_HLS(working_hartid)->entry.sync_b)
|
|
|
|
int hartid = read_csr(mhartid);
|
|
|
|
if (hartid != working_hartid) {
|
|
/* waiting for work hart */
|
|
do {
|
|
barrier();
|
|
} while (atomic_read(&SYNCA) != 0x01234567);
|
|
|
|
clear_csr(mstatus, MSTATUS_MIE);
|
|
write_csr(mie, MIP_MSIP);
|
|
|
|
/* count how many cores enter the halt */
|
|
atomic_add(&SYNCB, 1);
|
|
|
|
do {
|
|
barrier();
|
|
__asm__ volatile ("wfi");
|
|
} while ((read_csr(mip) & MIP_MSIP) == 0);
|
|
set_msip(hartid, 0);
|
|
HLS()->entry.fn(HLS()->entry.arg);
|
|
} else {
|
|
/* Initialize the counter and
|
|
* mark the work hart into smp_pause */
|
|
atomic_set(&SYNCB, 0);
|
|
atomic_set(&SYNCA, 0x01234567);
|
|
|
|
/* waiting for other Hart to enter the halt */
|
|
do {
|
|
barrier();
|
|
} while (atomic_read(&SYNCB) + 1 < CONFIG_MAX_CPUS);
|
|
|
|
/* initialize for the next call */
|
|
atomic_set(&SYNCA, 0);
|
|
atomic_set(&SYNCB, 0);
|
|
}
|
|
#undef SYNCA
|
|
#undef SYNCB
|
|
}
|
|
|
|
void smp_resume(void (*fn)(void *), void *arg)
|
|
{
|
|
int hartid = read_csr(mhartid);
|
|
|
|
if (fn == NULL)
|
|
die("must pass a non-null function pointer\n");
|
|
|
|
for (int i = 0; i < CONFIG_MAX_CPUS; i++) {
|
|
OTHER_HLS(i)->entry.fn = fn;
|
|
OTHER_HLS(i)->entry.arg = arg;
|
|
}
|
|
|
|
for (int i = 0; i < CONFIG_MAX_CPUS; i++)
|
|
if (i != hartid)
|
|
set_msip(i, 1);
|
|
|
|
if (HLS()->entry.fn == NULL)
|
|
die("entry fn not set\n");
|
|
|
|
HLS()->entry.fn(HLS()->entry.arg);
|
|
}
|