#include <sys/cdefs.h>
#include <sys/types.h>
#include <sys/systm.h>
#include <dev/ofw/openfirm.h>
#include <dev/ofw/ofw_bus.h>
#include <dev/ofw/ofw_bus_subr.h>
#include <machine/bus.h>
#include <arm/broadcom/bcm2835/bcm2835_vcbus.h>
struct bcm283x_memory_mapping {
vm_paddr_t armc_start;
vm_paddr_t armc_size;
vm_paddr_t vcbus_start;
};
static struct bcm283x_memory_mapping bcm2835_memmap[] = {
{
.armc_start = 0x00000000,
.armc_size = BCM2835_ARM_IO_BASE,
.vcbus_start = BCM2835_VCBUS_SDRAM_BASE,
},
{
.armc_start = BCM2835_ARM_IO_BASE,
.armc_size = BCM28XX_ARM_IO_SIZE,
.vcbus_start = BCM2835_VCBUS_IO_BASE,
},
{ 0, 0, 0 },
};
static struct bcm283x_memory_mapping bcm2836_memmap[] = {
{
.armc_start = 0x00000000,
.armc_size = BCM2836_ARM_IO_BASE,
.vcbus_start = BCM2836_VCBUS_SDRAM_BASE,
},
{
.armc_start = BCM2836_ARM_IO_BASE,
.armc_size = BCM28XX_ARM_IO_SIZE,
.vcbus_start = BCM2836_VCBUS_IO_BASE,
},
{ 0, 0, 0 },
};
static struct bcm283x_memory_mapping bcm2837_memmap[] = {
{
.armc_start = 0x00000000,
.armc_size = BCM2837_ARM_IO_BASE,
.vcbus_start = BCM2837_VCBUS_SDRAM_BASE,
},
{
.armc_start = BCM2837_ARM_IO_BASE,
.armc_size = BCM28XX_ARM_IO_SIZE,
.vcbus_start = BCM2837_VCBUS_IO_BASE,
},
{ 0, 0, 0 },
};
static struct bcm283x_memory_mapping bcm2838_memmap[] = {
{
.armc_start = 0x00000000,
.armc_size = 0x40000000,
.vcbus_start = BCM2838_VCBUS_SDRAM_BASE,
},
{
.armc_start = BCM2838_ARM_IO_BASE,
.armc_size = BCM28XX_ARM_IO_SIZE,
.vcbus_start = BCM2838_VCBUS_IO_BASE,
},
{ 0, 0, 0 },
};
static struct bcm283x_memory_soc_cfg {
struct bcm283x_memory_mapping *memmap;
const char *soc_compat;
bus_addr_t busdma_lowaddr;
} bcm283x_memory_configs[] = {
{
.memmap = bcm2835_memmap,
.soc_compat = "raspberrypi,model-b",
.busdma_lowaddr = BUS_SPACE_MAXADDR_32BIT,
},
{
.memmap = bcm2835_memmap,
.soc_compat = "brcm,bcm2835",
.busdma_lowaddr = BUS_SPACE_MAXADDR_32BIT,
},
{
.memmap = bcm2836_memmap,
.soc_compat = "brcm,bcm2709",
.busdma_lowaddr = BUS_SPACE_MAXADDR_32BIT,
},
{
.memmap = bcm2836_memmap,
.soc_compat = "brcm,bcm2836",
.busdma_lowaddr = BUS_SPACE_MAXADDR_32BIT,
},
{
.memmap = bcm2837_memmap,
.soc_compat = "brcm,bcm2837",
.busdma_lowaddr = BUS_SPACE_MAXADDR_32BIT,
},
{
.memmap = bcm2838_memmap,
.soc_compat = "brcm,bcm2711",
.busdma_lowaddr = BCM2838_PERIPH_MAXADDR,
},
{
.memmap = bcm2838_memmap,
.soc_compat = "brcm,bcm2838",
.busdma_lowaddr = BCM2838_PERIPH_MAXADDR,
},
};
static struct bcm283x_memory_soc_cfg *booted_soc_memcfg;
static struct bcm283x_memory_soc_cfg *
bcm283x_get_current_memcfg(void)
{
phandle_t root;
int i;
if (booted_soc_memcfg != NULL)
return (booted_soc_memcfg);
KASSERT(nitems(bcm283x_memory_configs) != 0,
("No SOC memory configurations enabled!"));
root = OF_finddevice("/");
for (i = 0; i < nitems(bcm283x_memory_configs); ++i) {
booted_soc_memcfg = &bcm283x_memory_configs[i];
if (bootverbose)
printf("Checking root against %s\n",
booted_soc_memcfg->soc_compat);
if (ofw_bus_node_is_compatible(root,
booted_soc_memcfg->soc_compat))
return (booted_soc_memcfg);
}
panic("No suitable SOC memory configuration found.");
}
#define BCM283X_MEMMAP_ISTERM(ent) \
((ent)->armc_start == 0 && (ent)->armc_size == 0 && \
(ent)->vcbus_start == 0)
vm_paddr_t
bcm283x_armc_to_vcbus(vm_paddr_t pa)
{
struct bcm283x_memory_soc_cfg *cfg;
struct bcm283x_memory_mapping *map, *ment;
cfg = bcm283x_get_current_memcfg();
map = cfg->memmap;
for (ment = map; !BCM283X_MEMMAP_ISTERM(ment); ++ment) {
if (pa >= ment->armc_start &&
pa < ment->armc_start + ment->armc_size) {
return (pa - ment->armc_start) + ment->vcbus_start;
}
}
if (bootverbose)
printf("bcm283x_vcbus: No armc -> vcbus mapping found: %jx\n",
(uintmax_t)pa);
return (pa);
}
vm_paddr_t
bcm283x_vcbus_to_armc(vm_paddr_t vca)
{
struct bcm283x_memory_soc_cfg *cfg;
struct bcm283x_memory_mapping *map, *ment;
cfg = bcm283x_get_current_memcfg();
map = cfg->memmap;
for (ment = map; !BCM283X_MEMMAP_ISTERM(ment); ++ment) {
if (vca >= ment->vcbus_start &&
vca < ment->vcbus_start + ment->armc_size) {
return (vca - ment->vcbus_start) + ment->armc_start;
}
}
if (bootverbose)
printf("bcm283x_vcbus: No vcbus -> armc mapping found: %jx\n",
(uintmax_t)vca);
return (vca);
}
bus_addr_t
bcm283x_dmabus_peripheral_lowaddr(void)
{
struct bcm283x_memory_soc_cfg *cfg;
cfg = bcm283x_get_current_memcfg();
return (cfg->busdma_lowaddr);
}