#include "opt_acpi.h"
#include "opt_platform.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/bus.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <dev/psci/psci.h>
#include <dev/psci/smccc.h>
#define SMCCC_VERSION_1_0 0x10000
static uint32_t smccc_version;
void
smccc_init(void)
{
int32_t features;
uint32_t ret;
smccc_version = SMCCC_VERSION_1_0;
features = psci_features(SMCCC_VERSION);
if (features != PSCI_RETVAL_NOT_SUPPORTED) {
ret = psci_call(SMCCC_VERSION, 0, 0, 0);
if (ret > 0)
smccc_version = ret;
}
if (bootverbose) {
printf("Found SMCCC version %u.%u\n",
SMCCC_VERSION_MAJOR(smccc_version),
SMCCC_VERSION_MINOR(smccc_version));
}
}
static int
smccc_probe(device_t dev)
{
int32_t version;
if (psci_features(SMCCC_VERSION) == PSCI_RETVAL_NOT_SUPPORTED ||
(version = arm_smccc_invoke(SMCCC_VERSION, NULL)) <= 0) {
device_set_desc(dev, "ARM SMCCC v1.0");
return (0);
}
device_set_descf(dev, "ARM SMCCC v%d.%d", SMCCC_VERSION_MAJOR(version),
SMCCC_VERSION_MINOR(version));
return (0);
}
static int
smccc_attach(device_t dev)
{
bus_attach_children(dev);
return (0);
}
uint32_t
smccc_get_version(void)
{
MPASS(smccc_version != 0);
return (smccc_version);
}
int32_t
smccc_arch_features(uint32_t smccc_func_id)
{
MPASS(smccc_version != 0);
if (smccc_version == SMCCC_VERSION_1_0)
return (SMCCC_RET_NOT_SUPPORTED);
return (arm_smccc_invoke(SMCCC_ARCH_FEATURES, smccc_func_id, NULL));
}
int
smccc_arch_workaround_1(void)
{
MPASS(smccc_version != 0);
KASSERT(smccc_version != SMCCC_VERSION_1_0,
("SMCCC arch workaround 1 called with an invalid SMCCC interface"));
return (arm_smccc_invoke(SMCCC_ARCH_WORKAROUND_1, NULL));
}
int
smccc_arch_workaround_2(int enable)
{
MPASS(smccc_version != 0);
KASSERT(smccc_version != SMCCC_VERSION_1_0,
("SMCCC arch workaround 2 called with an invalid SMCCC interface"));
return (arm_smccc_invoke(SMCCC_ARCH_WORKAROUND_2, enable, NULL));
}
static device_method_t smccc_methods[] = {
DEVMETHOD(device_probe, smccc_probe),
DEVMETHOD(device_attach, smccc_attach),
DEVMETHOD(bus_add_child, bus_generic_add_child),
DEVMETHOD_END
};
static driver_t smccc_driver = {
"smccc",
smccc_methods,
0,
};
EARLY_DRIVER_MODULE(smccc, psci, smccc_driver, 0, 0,
BUS_PASS_CPU + BUS_PASS_ORDER_FIRST);