180 lines
4.4 KiB
C
180 lines
4.4 KiB
C
/*-
|
|
* Copyright (c) 2005 Peter Grehan
|
|
* Copyright (c) 2009 Nathan Whitehorn
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
/*
|
|
* Dispatch platform calls to the appropriate platform implementation
|
|
* through a previously registered kernel object.
|
|
*/
|
|
|
|
#define _ARM32_BUS_DMA_PRIVATE
|
|
#include <sys/param.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/lock.h>
|
|
#include <sys/ktr.h>
|
|
#include <sys/mutex.h>
|
|
#include <sys/rman.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/smp.h>
|
|
#include <sys/sysctl.h>
|
|
#include <sys/types.h>
|
|
|
|
#include <vm/vm.h>
|
|
#include <vm/vm_page.h>
|
|
|
|
#include <machine/bus_dma.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/intr.h>
|
|
#include <machine/md_var.h>
|
|
#include <machine/platform.h>
|
|
#include <machine/platformvar.h>
|
|
#include <machine/smp.h>
|
|
|
|
#include "platform_if.h"
|
|
|
|
static platform_def_t *plat_def_impl;
|
|
static platform_t plat_obj;
|
|
static struct kobj_ops plat_kernel_kops;
|
|
static struct platform_kobj plat_kernel_obj;
|
|
|
|
static char plat_name[64];
|
|
SYSCTL_STRING(_hw, OID_AUTO, platform, CTLFLAG_RDTUN | CTLFLAG_NOFETCH, plat_name, 0,
|
|
"Platform currently in use");
|
|
|
|
/*
|
|
* Platform install routines. Highest priority wins, using the same
|
|
* algorithm as bus attachment.
|
|
*/
|
|
SET_DECLARE(platform_set, platform_def_t);
|
|
|
|
void
|
|
platform_probe_and_attach(void)
|
|
{
|
|
platform_def_t **platpp, *platp;
|
|
int prio, best_prio;
|
|
|
|
plat_obj = &plat_kernel_obj;
|
|
best_prio = 0;
|
|
|
|
/*
|
|
* We are unable to use TUNABLE_STR as the read will happen
|
|
* well after this function has returned.
|
|
*/
|
|
TUNABLE_STR_FETCH("hw.platform", plat_name, sizeof(plat_name));
|
|
|
|
/*
|
|
* Try to locate the best platform kobj
|
|
*/
|
|
SET_FOREACH(platpp, platform_set) {
|
|
platp = *platpp;
|
|
|
|
/*
|
|
* Take care of compiling the selected class, and
|
|
* then statically initialise the MMU object
|
|
*/
|
|
kobj_class_compile_static(platp, &plat_kernel_kops);
|
|
kobj_init_static((kobj_t)plat_obj, platp);
|
|
|
|
plat_obj->cls = platp;
|
|
|
|
prio = PLATFORM_PROBE(plat_obj);
|
|
|
|
/* Check for errors */
|
|
if (prio > 0)
|
|
continue;
|
|
|
|
/*
|
|
* Check if this module was specifically requested through
|
|
* the loader tunable we provide.
|
|
*/
|
|
if (strcmp(platp->name,plat_name) == 0) {
|
|
plat_def_impl = platp;
|
|
break;
|
|
}
|
|
|
|
/* Otherwise, see if it is better than our current best */
|
|
if (plat_def_impl == NULL || prio > best_prio) {
|
|
best_prio = prio;
|
|
plat_def_impl = platp;
|
|
}
|
|
|
|
/*
|
|
* We can't free the KOBJ, since it is static. Reset the ops
|
|
* member of this class so that we can come back later.
|
|
*/
|
|
platp->ops = NULL;
|
|
}
|
|
|
|
if (plat_def_impl == NULL)
|
|
panic("No platform module found!");
|
|
|
|
/*
|
|
* Recompile to make sure we ended with the
|
|
* correct one, and then attach.
|
|
*/
|
|
|
|
kobj_class_compile_static(plat_def_impl, &plat_kernel_kops);
|
|
kobj_init_static((kobj_t)plat_obj, plat_def_impl);
|
|
|
|
strlcpy(plat_name,plat_def_impl->name,sizeof(plat_name));
|
|
|
|
PLATFORM_ATTACH(plat_obj);
|
|
}
|
|
|
|
int
|
|
platform_devmap_init(void)
|
|
{
|
|
|
|
return PLATFORM_DEVMAP_INIT(plat_obj);
|
|
}
|
|
|
|
vm_offset_t
|
|
platform_lastaddr(void)
|
|
{
|
|
|
|
return PLATFORM_LASTADDR(plat_obj);
|
|
}
|
|
|
|
void
|
|
platform_gpio_init(void)
|
|
{
|
|
|
|
PLATFORM_GPIO_INIT(plat_obj);
|
|
}
|
|
|
|
void
|
|
platform_late_init(void)
|
|
{
|
|
|
|
PLATFORM_LATE_INIT(plat_obj);
|
|
}
|
|
|