340dc03c79
After previous changes we can now remove the legacy init function and move the device creation to board code. Signed-off-by: BALATON Zoltan <balaton@eik.bme.hu> Reviewed-by: Philippe Mathieu-Daudé <philmd@linaro.org> Message-ID: <29aafeea9f1c871c739600a7b093c5456e8a1dc8.1688586835.git.balaton@eik.bme.hu> Signed-off-by: Daniel Henrique Barboza <danielhb413@gmail.com>
1095 lines
30 KiB
C
1095 lines
30 KiB
C
/*
|
|
* QEMU PowerPC 440 embedded processors emulation
|
|
*
|
|
* Copyright (c) 2012 François Revol
|
|
* Copyright (c) 2016-2019 BALATON Zoltan
|
|
*
|
|
* This work is licensed under the GNU GPL license version 2 or later.
|
|
*
|
|
*/
|
|
|
|
#include "qemu/osdep.h"
|
|
#include "qemu/units.h"
|
|
#include "qapi/error.h"
|
|
#include "qemu/log.h"
|
|
#include "hw/irq.h"
|
|
#include "hw/ppc/ppc4xx.h"
|
|
#include "hw/qdev-properties.h"
|
|
#include "hw/pci/pci.h"
|
|
#include "sysemu/reset.h"
|
|
#include "cpu.h"
|
|
#include "ppc440.h"
|
|
|
|
/*****************************************************************************/
|
|
/* L2 Cache as SRAM */
|
|
/* FIXME:fix names */
|
|
enum {
|
|
DCR_L2CACHE_BASE = 0x30,
|
|
DCR_L2CACHE_CFG = DCR_L2CACHE_BASE,
|
|
DCR_L2CACHE_CMD,
|
|
DCR_L2CACHE_ADDR,
|
|
DCR_L2CACHE_DATA,
|
|
DCR_L2CACHE_STAT,
|
|
DCR_L2CACHE_CVER,
|
|
DCR_L2CACHE_SNP0,
|
|
DCR_L2CACHE_SNP1,
|
|
DCR_L2CACHE_END = DCR_L2CACHE_SNP1,
|
|
};
|
|
|
|
/* base is 460ex-specific, cf. U-Boot, ppc4xx-isram.h */
|
|
enum {
|
|
DCR_ISRAM0_BASE = 0x20,
|
|
DCR_ISRAM0_SB0CR = DCR_ISRAM0_BASE,
|
|
DCR_ISRAM0_SB1CR,
|
|
DCR_ISRAM0_SB2CR,
|
|
DCR_ISRAM0_SB3CR,
|
|
DCR_ISRAM0_BEAR,
|
|
DCR_ISRAM0_BESR0,
|
|
DCR_ISRAM0_BESR1,
|
|
DCR_ISRAM0_PMEG,
|
|
DCR_ISRAM0_CID,
|
|
DCR_ISRAM0_REVID,
|
|
DCR_ISRAM0_DPC,
|
|
DCR_ISRAM0_END = DCR_ISRAM0_DPC
|
|
};
|
|
|
|
enum {
|
|
DCR_ISRAM1_BASE = 0xb0,
|
|
DCR_ISRAM1_SB0CR = DCR_ISRAM1_BASE,
|
|
/* single bank */
|
|
DCR_ISRAM1_BEAR = DCR_ISRAM1_BASE + 0x04,
|
|
DCR_ISRAM1_BESR0,
|
|
DCR_ISRAM1_BESR1,
|
|
DCR_ISRAM1_PMEG,
|
|
DCR_ISRAM1_CID,
|
|
DCR_ISRAM1_REVID,
|
|
DCR_ISRAM1_DPC,
|
|
DCR_ISRAM1_END = DCR_ISRAM1_DPC
|
|
};
|
|
|
|
typedef struct ppc4xx_l2sram_t {
|
|
MemoryRegion bank[4];
|
|
uint32_t l2cache[8];
|
|
uint32_t isram0[11];
|
|
} ppc4xx_l2sram_t;
|
|
|
|
#ifdef MAP_L2SRAM
|
|
static void l2sram_update_mappings(ppc4xx_l2sram_t *l2sram,
|
|
uint32_t isarc, uint32_t isacntl,
|
|
uint32_t dsarc, uint32_t dsacntl)
|
|
{
|
|
if (l2sram->isarc != isarc ||
|
|
(l2sram->isacntl & 0x80000000) != (isacntl & 0x80000000)) {
|
|
if (l2sram->isacntl & 0x80000000) {
|
|
/* Unmap previously assigned memory region */
|
|
memory_region_del_subregion(get_system_memory(),
|
|
&l2sram->isarc_ram);
|
|
}
|
|
if (isacntl & 0x80000000) {
|
|
/* Map new instruction memory region */
|
|
memory_region_add_subregion(get_system_memory(), isarc,
|
|
&l2sram->isarc_ram);
|
|
}
|
|
}
|
|
if (l2sram->dsarc != dsarc ||
|
|
(l2sram->dsacntl & 0x80000000) != (dsacntl & 0x80000000)) {
|
|
if (l2sram->dsacntl & 0x80000000) {
|
|
/* Beware not to unmap the region we just mapped */
|
|
if (!(isacntl & 0x80000000) || l2sram->dsarc != isarc) {
|
|
/* Unmap previously assigned memory region */
|
|
memory_region_del_subregion(get_system_memory(),
|
|
&l2sram->dsarc_ram);
|
|
}
|
|
}
|
|
if (dsacntl & 0x80000000) {
|
|
/* Beware not to remap the region we just mapped */
|
|
if (!(isacntl & 0x80000000) || dsarc != isarc) {
|
|
/* Map new data memory region */
|
|
memory_region_add_subregion(get_system_memory(), dsarc,
|
|
&l2sram->dsarc_ram);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
static uint32_t dcr_read_l2sram(void *opaque, int dcrn)
|
|
{
|
|
ppc4xx_l2sram_t *l2sram = opaque;
|
|
uint32_t ret = 0;
|
|
|
|
switch (dcrn) {
|
|
case DCR_L2CACHE_CFG:
|
|
case DCR_L2CACHE_CMD:
|
|
case DCR_L2CACHE_ADDR:
|
|
case DCR_L2CACHE_DATA:
|
|
case DCR_L2CACHE_STAT:
|
|
case DCR_L2CACHE_CVER:
|
|
case DCR_L2CACHE_SNP0:
|
|
case DCR_L2CACHE_SNP1:
|
|
ret = l2sram->l2cache[dcrn - DCR_L2CACHE_BASE];
|
|
break;
|
|
|
|
case DCR_ISRAM0_SB0CR:
|
|
case DCR_ISRAM0_SB1CR:
|
|
case DCR_ISRAM0_SB2CR:
|
|
case DCR_ISRAM0_SB3CR:
|
|
case DCR_ISRAM0_BEAR:
|
|
case DCR_ISRAM0_BESR0:
|
|
case DCR_ISRAM0_BESR1:
|
|
case DCR_ISRAM0_PMEG:
|
|
case DCR_ISRAM0_CID:
|
|
case DCR_ISRAM0_REVID:
|
|
case DCR_ISRAM0_DPC:
|
|
ret = l2sram->isram0[dcrn - DCR_ISRAM0_BASE];
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void dcr_write_l2sram(void *opaque, int dcrn, uint32_t val)
|
|
{
|
|
/*ppc4xx_l2sram_t *l2sram = opaque;*/
|
|
/* FIXME: Actually handle L2 cache mapping */
|
|
|
|
switch (dcrn) {
|
|
case DCR_L2CACHE_CFG:
|
|
case DCR_L2CACHE_CMD:
|
|
case DCR_L2CACHE_ADDR:
|
|
case DCR_L2CACHE_DATA:
|
|
case DCR_L2CACHE_STAT:
|
|
case DCR_L2CACHE_CVER:
|
|
case DCR_L2CACHE_SNP0:
|
|
case DCR_L2CACHE_SNP1:
|
|
/*l2sram->l2cache[dcrn - DCR_L2CACHE_BASE] = val;*/
|
|
break;
|
|
|
|
case DCR_ISRAM0_SB0CR:
|
|
case DCR_ISRAM0_SB1CR:
|
|
case DCR_ISRAM0_SB2CR:
|
|
case DCR_ISRAM0_SB3CR:
|
|
case DCR_ISRAM0_BEAR:
|
|
case DCR_ISRAM0_BESR0:
|
|
case DCR_ISRAM0_BESR1:
|
|
case DCR_ISRAM0_PMEG:
|
|
case DCR_ISRAM0_CID:
|
|
case DCR_ISRAM0_REVID:
|
|
case DCR_ISRAM0_DPC:
|
|
/*l2sram->isram0[dcrn - DCR_L2CACHE_BASE] = val;*/
|
|
break;
|
|
|
|
case DCR_ISRAM1_SB0CR:
|
|
case DCR_ISRAM1_BEAR:
|
|
case DCR_ISRAM1_BESR0:
|
|
case DCR_ISRAM1_BESR1:
|
|
case DCR_ISRAM1_PMEG:
|
|
case DCR_ISRAM1_CID:
|
|
case DCR_ISRAM1_REVID:
|
|
case DCR_ISRAM1_DPC:
|
|
/*l2sram->isram1[dcrn - DCR_L2CACHE_BASE] = val;*/
|
|
break;
|
|
}
|
|
/*l2sram_update_mappings(l2sram, isarc, isacntl, dsarc, dsacntl);*/
|
|
}
|
|
|
|
static void l2sram_reset(void *opaque)
|
|
{
|
|
ppc4xx_l2sram_t *l2sram = opaque;
|
|
|
|
memset(l2sram->l2cache, 0, sizeof(l2sram->l2cache));
|
|
l2sram->l2cache[DCR_L2CACHE_STAT - DCR_L2CACHE_BASE] = 0x80000000;
|
|
memset(l2sram->isram0, 0, sizeof(l2sram->isram0));
|
|
/*l2sram_update_mappings(l2sram, isarc, isacntl, dsarc, dsacntl);*/
|
|
}
|
|
|
|
void ppc4xx_l2sram_init(CPUPPCState *env)
|
|
{
|
|
ppc4xx_l2sram_t *l2sram;
|
|
|
|
l2sram = g_malloc0(sizeof(*l2sram));
|
|
/* XXX: Size is 4*64kB for 460ex, cf. U-Boot, ppc4xx-isram.h */
|
|
memory_region_init_ram(&l2sram->bank[0], NULL, "ppc4xx.l2sram_bank0",
|
|
64 * KiB, &error_abort);
|
|
memory_region_init_ram(&l2sram->bank[1], NULL, "ppc4xx.l2sram_bank1",
|
|
64 * KiB, &error_abort);
|
|
memory_region_init_ram(&l2sram->bank[2], NULL, "ppc4xx.l2sram_bank2",
|
|
64 * KiB, &error_abort);
|
|
memory_region_init_ram(&l2sram->bank[3], NULL, "ppc4xx.l2sram_bank3",
|
|
64 * KiB, &error_abort);
|
|
qemu_register_reset(&l2sram_reset, l2sram);
|
|
ppc_dcr_register(env, DCR_L2CACHE_CFG,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_L2CACHE_CMD,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_L2CACHE_ADDR,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_L2CACHE_DATA,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_L2CACHE_STAT,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_L2CACHE_CVER,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_L2CACHE_SNP0,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_L2CACHE_SNP1,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
|
|
ppc_dcr_register(env, DCR_ISRAM0_SB0CR,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_ISRAM0_SB1CR,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_ISRAM0_SB2CR,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_ISRAM0_SB3CR,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_ISRAM0_PMEG,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_ISRAM0_DPC,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
|
|
ppc_dcr_register(env, DCR_ISRAM1_SB0CR,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_ISRAM1_PMEG,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
ppc_dcr_register(env, DCR_ISRAM1_DPC,
|
|
l2sram, &dcr_read_l2sram, &dcr_write_l2sram);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* Clocking Power on Reset */
|
|
enum {
|
|
CPR0_CFGADDR = 0xC,
|
|
CPR0_CFGDATA = 0xD,
|
|
|
|
CPR0_PLLD = 0x060,
|
|
CPR0_PLBED = 0x080,
|
|
CPR0_OPBD = 0x0C0,
|
|
CPR0_PERD = 0x0E0,
|
|
CPR0_AHBD = 0x100,
|
|
};
|
|
|
|
typedef struct ppc4xx_cpr_t {
|
|
uint32_t addr;
|
|
} ppc4xx_cpr_t;
|
|
|
|
static uint32_t dcr_read_cpr(void *opaque, int dcrn)
|
|
{
|
|
ppc4xx_cpr_t *cpr = opaque;
|
|
uint32_t ret = 0;
|
|
|
|
switch (dcrn) {
|
|
case CPR0_CFGADDR:
|
|
ret = cpr->addr;
|
|
break;
|
|
case CPR0_CFGDATA:
|
|
switch (cpr->addr) {
|
|
case CPR0_PLLD:
|
|
ret = (0xb5 << 24) | (1 << 16) | (9 << 8);
|
|
break;
|
|
case CPR0_PLBED:
|
|
ret = (5 << 24);
|
|
break;
|
|
case CPR0_OPBD:
|
|
ret = (2 << 24);
|
|
break;
|
|
case CPR0_PERD:
|
|
case CPR0_AHBD:
|
|
ret = (1 << 24);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void dcr_write_cpr(void *opaque, int dcrn, uint32_t val)
|
|
{
|
|
ppc4xx_cpr_t *cpr = opaque;
|
|
|
|
switch (dcrn) {
|
|
case CPR0_CFGADDR:
|
|
cpr->addr = val;
|
|
break;
|
|
case CPR0_CFGDATA:
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void ppc4xx_cpr_reset(void *opaque)
|
|
{
|
|
ppc4xx_cpr_t *cpr = opaque;
|
|
|
|
cpr->addr = 0;
|
|
}
|
|
|
|
void ppc4xx_cpr_init(CPUPPCState *env)
|
|
{
|
|
ppc4xx_cpr_t *cpr;
|
|
|
|
cpr = g_malloc0(sizeof(*cpr));
|
|
ppc_dcr_register(env, CPR0_CFGADDR, cpr, &dcr_read_cpr, &dcr_write_cpr);
|
|
ppc_dcr_register(env, CPR0_CFGDATA, cpr, &dcr_read_cpr, &dcr_write_cpr);
|
|
qemu_register_reset(ppc4xx_cpr_reset, cpr);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* System DCRs */
|
|
typedef struct ppc4xx_sdr_t ppc4xx_sdr_t;
|
|
struct ppc4xx_sdr_t {
|
|
uint32_t addr;
|
|
};
|
|
|
|
enum {
|
|
SDR0_CFGADDR = 0x00e,
|
|
SDR0_CFGDATA,
|
|
SDR0_STRP0 = 0x020,
|
|
SDR0_STRP1,
|
|
SDR0_102 = 0x66,
|
|
SDR0_103,
|
|
SDR0_128 = 0x80,
|
|
SDR0_ECID3 = 0x083,
|
|
SDR0_DDR0 = 0x0e1,
|
|
SDR0_USB0 = 0x320,
|
|
};
|
|
|
|
enum {
|
|
PESDR0_LOOP = 0x303,
|
|
PESDR0_RCSSET,
|
|
PESDR0_RCSSTS,
|
|
PESDR0_RSTSTA = 0x310,
|
|
PESDR1_LOOP = 0x343,
|
|
PESDR1_RCSSET,
|
|
PESDR1_RCSSTS,
|
|
PESDR1_RSTSTA = 0x365,
|
|
};
|
|
|
|
static uint32_t dcr_read_sdr(void *opaque, int dcrn)
|
|
{
|
|
ppc4xx_sdr_t *sdr = opaque;
|
|
uint32_t ret = 0;
|
|
|
|
switch (dcrn) {
|
|
case SDR0_CFGADDR:
|
|
ret = sdr->addr;
|
|
break;
|
|
case SDR0_CFGDATA:
|
|
switch (sdr->addr) {
|
|
case SDR0_STRP0:
|
|
ret = (0xb5 << 8) | (1 << 4) | 9;
|
|
break;
|
|
case SDR0_STRP1:
|
|
ret = (5 << 29) | (2 << 26) | (1 << 24);
|
|
break;
|
|
case SDR0_ECID3:
|
|
ret = 1 << 20; /* No Security/Kasumi support */
|
|
break;
|
|
case SDR0_DDR0:
|
|
ret = SDR0_DDR0_DDRM_ENCODE(1) | SDR0_DDR0_DDRM_DDR1;
|
|
break;
|
|
case PESDR0_RCSSET:
|
|
case PESDR1_RCSSET:
|
|
ret = (1 << 24) | (1 << 16);
|
|
break;
|
|
case PESDR0_RCSSTS:
|
|
case PESDR1_RCSSTS:
|
|
ret = (1 << 16) | (1 << 12);
|
|
break;
|
|
case PESDR0_RSTSTA:
|
|
case PESDR1_RSTSTA:
|
|
ret = 1;
|
|
break;
|
|
case PESDR0_LOOP:
|
|
case PESDR1_LOOP:
|
|
ret = 1 << 12;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void dcr_write_sdr(void *opaque, int dcrn, uint32_t val)
|
|
{
|
|
ppc4xx_sdr_t *sdr = opaque;
|
|
|
|
switch (dcrn) {
|
|
case SDR0_CFGADDR:
|
|
sdr->addr = val;
|
|
break;
|
|
case SDR0_CFGDATA:
|
|
switch (sdr->addr) {
|
|
case 0x00: /* B0CR */
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void sdr_reset(void *opaque)
|
|
{
|
|
ppc4xx_sdr_t *sdr = opaque;
|
|
|
|
sdr->addr = 0;
|
|
}
|
|
|
|
void ppc4xx_sdr_init(CPUPPCState *env)
|
|
{
|
|
ppc4xx_sdr_t *sdr;
|
|
|
|
sdr = g_malloc0(sizeof(*sdr));
|
|
qemu_register_reset(&sdr_reset, sdr);
|
|
ppc_dcr_register(env, SDR0_CFGADDR,
|
|
sdr, &dcr_read_sdr, &dcr_write_sdr);
|
|
ppc_dcr_register(env, SDR0_CFGDATA,
|
|
sdr, &dcr_read_sdr, &dcr_write_sdr);
|
|
ppc_dcr_register(env, SDR0_102,
|
|
sdr, &dcr_read_sdr, &dcr_write_sdr);
|
|
ppc_dcr_register(env, SDR0_103,
|
|
sdr, &dcr_read_sdr, &dcr_write_sdr);
|
|
ppc_dcr_register(env, SDR0_128,
|
|
sdr, &dcr_read_sdr, &dcr_write_sdr);
|
|
ppc_dcr_register(env, SDR0_USB0,
|
|
sdr, &dcr_read_sdr, &dcr_write_sdr);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* PLB to AHB bridge */
|
|
enum {
|
|
AHB_TOP = 0xA4,
|
|
AHB_BOT = 0xA5,
|
|
};
|
|
|
|
typedef struct ppc4xx_ahb_t {
|
|
uint32_t top;
|
|
uint32_t bot;
|
|
} ppc4xx_ahb_t;
|
|
|
|
static uint32_t dcr_read_ahb(void *opaque, int dcrn)
|
|
{
|
|
ppc4xx_ahb_t *ahb = opaque;
|
|
uint32_t ret = 0;
|
|
|
|
switch (dcrn) {
|
|
case AHB_TOP:
|
|
ret = ahb->top;
|
|
break;
|
|
case AHB_BOT:
|
|
ret = ahb->bot;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void dcr_write_ahb(void *opaque, int dcrn, uint32_t val)
|
|
{
|
|
ppc4xx_ahb_t *ahb = opaque;
|
|
|
|
switch (dcrn) {
|
|
case AHB_TOP:
|
|
ahb->top = val;
|
|
break;
|
|
case AHB_BOT:
|
|
ahb->bot = val;
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void ppc4xx_ahb_reset(void *opaque)
|
|
{
|
|
ppc4xx_ahb_t *ahb = opaque;
|
|
|
|
/* No error */
|
|
ahb->top = 0;
|
|
ahb->bot = 0;
|
|
}
|
|
|
|
void ppc4xx_ahb_init(CPUPPCState *env)
|
|
{
|
|
ppc4xx_ahb_t *ahb;
|
|
|
|
ahb = g_malloc0(sizeof(*ahb));
|
|
ppc_dcr_register(env, AHB_TOP, ahb, &dcr_read_ahb, &dcr_write_ahb);
|
|
ppc_dcr_register(env, AHB_BOT, ahb, &dcr_read_ahb, &dcr_write_ahb);
|
|
qemu_register_reset(ppc4xx_ahb_reset, ahb);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* DMA controller */
|
|
|
|
#define DMA0_CR_CE (1 << 31)
|
|
#define DMA0_CR_PW (1 << 26 | 1 << 25)
|
|
#define DMA0_CR_DAI (1 << 24)
|
|
#define DMA0_CR_SAI (1 << 23)
|
|
#define DMA0_CR_DEC (1 << 2)
|
|
|
|
enum {
|
|
DMA0_CR = 0x00,
|
|
DMA0_CT,
|
|
DMA0_SAH,
|
|
DMA0_SAL,
|
|
DMA0_DAH,
|
|
DMA0_DAL,
|
|
DMA0_SGH,
|
|
DMA0_SGL,
|
|
|
|
DMA0_SR = 0x20,
|
|
DMA0_SGC = 0x23,
|
|
DMA0_SLP = 0x25,
|
|
DMA0_POL = 0x26,
|
|
};
|
|
|
|
typedef struct {
|
|
uint32_t cr;
|
|
uint32_t ct;
|
|
uint64_t sa;
|
|
uint64_t da;
|
|
uint64_t sg;
|
|
} PPC4xxDmaChnl;
|
|
|
|
typedef struct {
|
|
int base;
|
|
PPC4xxDmaChnl ch[4];
|
|
uint32_t sr;
|
|
} PPC4xxDmaState;
|
|
|
|
static uint32_t dcr_read_dma(void *opaque, int dcrn)
|
|
{
|
|
PPC4xxDmaState *dma = opaque;
|
|
uint32_t val = 0;
|
|
int addr = dcrn - dma->base;
|
|
int chnl = addr / 8;
|
|
|
|
switch (addr) {
|
|
case 0x00 ... 0x1f:
|
|
switch (addr % 8) {
|
|
case DMA0_CR:
|
|
val = dma->ch[chnl].cr;
|
|
break;
|
|
case DMA0_CT:
|
|
val = dma->ch[chnl].ct;
|
|
break;
|
|
case DMA0_SAH:
|
|
val = dma->ch[chnl].sa >> 32;
|
|
break;
|
|
case DMA0_SAL:
|
|
val = dma->ch[chnl].sa;
|
|
break;
|
|
case DMA0_DAH:
|
|
val = dma->ch[chnl].da >> 32;
|
|
break;
|
|
case DMA0_DAL:
|
|
val = dma->ch[chnl].da;
|
|
break;
|
|
case DMA0_SGH:
|
|
val = dma->ch[chnl].sg >> 32;
|
|
break;
|
|
case DMA0_SGL:
|
|
val = dma->ch[chnl].sg;
|
|
break;
|
|
}
|
|
break;
|
|
case DMA0_SR:
|
|
val = dma->sr;
|
|
break;
|
|
default:
|
|
qemu_log_mask(LOG_UNIMP, "%s: unimplemented register %x (%d, %x)\n",
|
|
__func__, dcrn, chnl, addr);
|
|
}
|
|
|
|
return val;
|
|
}
|
|
|
|
static void dcr_write_dma(void *opaque, int dcrn, uint32_t val)
|
|
{
|
|
PPC4xxDmaState *dma = opaque;
|
|
int addr = dcrn - dma->base;
|
|
int chnl = addr / 8;
|
|
|
|
switch (addr) {
|
|
case 0x00 ... 0x1f:
|
|
switch (addr % 8) {
|
|
case DMA0_CR:
|
|
dma->ch[chnl].cr = val;
|
|
if (val & DMA0_CR_CE) {
|
|
int count = dma->ch[chnl].ct & 0xffff;
|
|
|
|
if (count) {
|
|
int width, i, sidx, didx;
|
|
uint8_t *rptr, *wptr;
|
|
hwaddr rlen, wlen;
|
|
hwaddr xferlen;
|
|
|
|
sidx = didx = 0;
|
|
width = 1 << ((val & DMA0_CR_PW) >> 25);
|
|
xferlen = count * width;
|
|
wlen = rlen = xferlen;
|
|
rptr = cpu_physical_memory_map(dma->ch[chnl].sa, &rlen,
|
|
false);
|
|
wptr = cpu_physical_memory_map(dma->ch[chnl].da, &wlen,
|
|
true);
|
|
if (rptr && rlen == xferlen && wptr && wlen == xferlen) {
|
|
if (!(val & DMA0_CR_DEC) &&
|
|
val & DMA0_CR_SAI && val & DMA0_CR_DAI) {
|
|
/* optimise common case */
|
|
memmove(wptr, rptr, count * width);
|
|
sidx = didx = count * width;
|
|
} else {
|
|
/* do it the slow way */
|
|
for (sidx = didx = i = 0; i < count; i++) {
|
|
uint64_t v = ldn_le_p(rptr + sidx, width);
|
|
stn_le_p(wptr + didx, width, v);
|
|
if (val & DMA0_CR_SAI) {
|
|
sidx += width;
|
|
}
|
|
if (val & DMA0_CR_DAI) {
|
|
didx += width;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
if (wptr) {
|
|
cpu_physical_memory_unmap(wptr, wlen, 1, didx);
|
|
}
|
|
if (rptr) {
|
|
cpu_physical_memory_unmap(rptr, rlen, 0, sidx);
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
case DMA0_CT:
|
|
dma->ch[chnl].ct = val;
|
|
break;
|
|
case DMA0_SAH:
|
|
dma->ch[chnl].sa &= 0xffffffffULL;
|
|
dma->ch[chnl].sa |= (uint64_t)val << 32;
|
|
break;
|
|
case DMA0_SAL:
|
|
dma->ch[chnl].sa &= 0xffffffff00000000ULL;
|
|
dma->ch[chnl].sa |= val;
|
|
break;
|
|
case DMA0_DAH:
|
|
dma->ch[chnl].da &= 0xffffffffULL;
|
|
dma->ch[chnl].da |= (uint64_t)val << 32;
|
|
break;
|
|
case DMA0_DAL:
|
|
dma->ch[chnl].da &= 0xffffffff00000000ULL;
|
|
dma->ch[chnl].da |= val;
|
|
break;
|
|
case DMA0_SGH:
|
|
dma->ch[chnl].sg &= 0xffffffffULL;
|
|
dma->ch[chnl].sg |= (uint64_t)val << 32;
|
|
break;
|
|
case DMA0_SGL:
|
|
dma->ch[chnl].sg &= 0xffffffff00000000ULL;
|
|
dma->ch[chnl].sg |= val;
|
|
break;
|
|
}
|
|
break;
|
|
case DMA0_SR:
|
|
dma->sr &= ~val;
|
|
break;
|
|
default:
|
|
qemu_log_mask(LOG_UNIMP, "%s: unimplemented register %x (%d, %x)\n",
|
|
__func__, dcrn, chnl, addr);
|
|
}
|
|
}
|
|
|
|
static void ppc4xx_dma_reset(void *opaque)
|
|
{
|
|
PPC4xxDmaState *dma = opaque;
|
|
int dma_base = dma->base;
|
|
|
|
memset(dma, 0, sizeof(*dma));
|
|
dma->base = dma_base;
|
|
}
|
|
|
|
void ppc4xx_dma_init(CPUPPCState *env, int dcr_base)
|
|
{
|
|
PPC4xxDmaState *dma;
|
|
int i;
|
|
|
|
dma = g_malloc0(sizeof(*dma));
|
|
dma->base = dcr_base;
|
|
qemu_register_reset(&ppc4xx_dma_reset, dma);
|
|
for (i = 0; i < 4; i++) {
|
|
ppc_dcr_register(env, dcr_base + i * 8 + DMA0_CR,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
ppc_dcr_register(env, dcr_base + i * 8 + DMA0_CT,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
ppc_dcr_register(env, dcr_base + i * 8 + DMA0_SAH,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
ppc_dcr_register(env, dcr_base + i * 8 + DMA0_SAL,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
ppc_dcr_register(env, dcr_base + i * 8 + DMA0_DAH,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
ppc_dcr_register(env, dcr_base + i * 8 + DMA0_DAL,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
ppc_dcr_register(env, dcr_base + i * 8 + DMA0_SGH,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
ppc_dcr_register(env, dcr_base + i * 8 + DMA0_SGL,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
}
|
|
ppc_dcr_register(env, dcr_base + DMA0_SR,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
ppc_dcr_register(env, dcr_base + DMA0_SGC,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
ppc_dcr_register(env, dcr_base + DMA0_SLP,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
ppc_dcr_register(env, dcr_base + DMA0_POL,
|
|
dma, &dcr_read_dma, &dcr_write_dma);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* PCI Express controller */
|
|
/*
|
|
* FIXME: This is not complete and does not work, only implemented partially
|
|
* to allow firmware and guests to find an empty bus. Cards should use PCI.
|
|
*/
|
|
#include "hw/pci/pcie_host.h"
|
|
|
|
OBJECT_DECLARE_SIMPLE_TYPE(PPC460EXPCIEState, PPC460EX_PCIE_HOST)
|
|
|
|
struct PPC460EXPCIEState {
|
|
PCIExpressHost parent_obj;
|
|
|
|
MemoryRegion busmem;
|
|
MemoryRegion iomem;
|
|
qemu_irq irq[4];
|
|
int32_t num;
|
|
int32_t dcrn_base;
|
|
PowerPCCPU *cpu;
|
|
|
|
uint64_t cfg_base;
|
|
uint32_t cfg_mask;
|
|
uint64_t msg_base;
|
|
uint32_t msg_mask;
|
|
uint64_t omr1_base;
|
|
uint64_t omr1_mask;
|
|
uint64_t omr2_base;
|
|
uint64_t omr2_mask;
|
|
uint64_t omr3_base;
|
|
uint64_t omr3_mask;
|
|
uint64_t reg_base;
|
|
uint32_t reg_mask;
|
|
uint32_t special;
|
|
uint32_t cfg;
|
|
};
|
|
|
|
enum {
|
|
PEGPL_CFGBAH = 0x0,
|
|
PEGPL_CFGBAL,
|
|
PEGPL_CFGMSK,
|
|
PEGPL_MSGBAH,
|
|
PEGPL_MSGBAL,
|
|
PEGPL_MSGMSK,
|
|
PEGPL_OMR1BAH,
|
|
PEGPL_OMR1BAL,
|
|
PEGPL_OMR1MSKH,
|
|
PEGPL_OMR1MSKL,
|
|
PEGPL_OMR2BAH,
|
|
PEGPL_OMR2BAL,
|
|
PEGPL_OMR2MSKH,
|
|
PEGPL_OMR2MSKL,
|
|
PEGPL_OMR3BAH,
|
|
PEGPL_OMR3BAL,
|
|
PEGPL_OMR3MSKH,
|
|
PEGPL_OMR3MSKL,
|
|
PEGPL_REGBAH,
|
|
PEGPL_REGBAL,
|
|
PEGPL_REGMSK,
|
|
PEGPL_SPECIAL,
|
|
PEGPL_CFG,
|
|
};
|
|
|
|
static uint32_t dcr_read_pcie(void *opaque, int dcrn)
|
|
{
|
|
PPC460EXPCIEState *s = opaque;
|
|
uint32_t ret = 0;
|
|
|
|
switch (dcrn - s->dcrn_base) {
|
|
case PEGPL_CFGBAH:
|
|
ret = s->cfg_base >> 32;
|
|
break;
|
|
case PEGPL_CFGBAL:
|
|
ret = s->cfg_base;
|
|
break;
|
|
case PEGPL_CFGMSK:
|
|
ret = s->cfg_mask;
|
|
break;
|
|
case PEGPL_MSGBAH:
|
|
ret = s->msg_base >> 32;
|
|
break;
|
|
case PEGPL_MSGBAL:
|
|
ret = s->msg_base;
|
|
break;
|
|
case PEGPL_MSGMSK:
|
|
ret = s->msg_mask;
|
|
break;
|
|
case PEGPL_OMR1BAH:
|
|
ret = s->omr1_base >> 32;
|
|
break;
|
|
case PEGPL_OMR1BAL:
|
|
ret = s->omr1_base;
|
|
break;
|
|
case PEGPL_OMR1MSKH:
|
|
ret = s->omr1_mask >> 32;
|
|
break;
|
|
case PEGPL_OMR1MSKL:
|
|
ret = s->omr1_mask;
|
|
break;
|
|
case PEGPL_OMR2BAH:
|
|
ret = s->omr2_base >> 32;
|
|
break;
|
|
case PEGPL_OMR2BAL:
|
|
ret = s->omr2_base;
|
|
break;
|
|
case PEGPL_OMR2MSKH:
|
|
ret = s->omr2_mask >> 32;
|
|
break;
|
|
case PEGPL_OMR2MSKL:
|
|
ret = s->omr3_mask;
|
|
break;
|
|
case PEGPL_OMR3BAH:
|
|
ret = s->omr3_base >> 32;
|
|
break;
|
|
case PEGPL_OMR3BAL:
|
|
ret = s->omr3_base;
|
|
break;
|
|
case PEGPL_OMR3MSKH:
|
|
ret = s->omr3_mask >> 32;
|
|
break;
|
|
case PEGPL_OMR3MSKL:
|
|
ret = s->omr3_mask;
|
|
break;
|
|
case PEGPL_REGBAH:
|
|
ret = s->reg_base >> 32;
|
|
break;
|
|
case PEGPL_REGBAL:
|
|
ret = s->reg_base;
|
|
break;
|
|
case PEGPL_REGMSK:
|
|
ret = s->reg_mask;
|
|
break;
|
|
case PEGPL_SPECIAL:
|
|
ret = s->special;
|
|
break;
|
|
case PEGPL_CFG:
|
|
ret = s->cfg;
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void dcr_write_pcie(void *opaque, int dcrn, uint32_t val)
|
|
{
|
|
PPC460EXPCIEState *s = opaque;
|
|
uint64_t size;
|
|
|
|
switch (dcrn - s->dcrn_base) {
|
|
case PEGPL_CFGBAH:
|
|
s->cfg_base = ((uint64_t)val << 32) | (s->cfg_base & 0xffffffff);
|
|
break;
|
|
case PEGPL_CFGBAL:
|
|
s->cfg_base = (s->cfg_base & 0xffffffff00000000ULL) | val;
|
|
break;
|
|
case PEGPL_CFGMSK:
|
|
s->cfg_mask = val;
|
|
size = ~(val & 0xfffffffe) + 1;
|
|
/*
|
|
* Firmware sets this register to E0000001. Why we are not sure,
|
|
* but the current guess is anything above PCIE_MMCFG_SIZE_MAX is
|
|
* ignored.
|
|
*/
|
|
if (size > PCIE_MMCFG_SIZE_MAX) {
|
|
size = PCIE_MMCFG_SIZE_MAX;
|
|
}
|
|
pcie_host_mmcfg_update(PCIE_HOST_BRIDGE(s), val & 1, s->cfg_base, size);
|
|
break;
|
|
case PEGPL_MSGBAH:
|
|
s->msg_base = ((uint64_t)val << 32) | (s->msg_base & 0xffffffff);
|
|
break;
|
|
case PEGPL_MSGBAL:
|
|
s->msg_base = (s->msg_base & 0xffffffff00000000ULL) | val;
|
|
break;
|
|
case PEGPL_MSGMSK:
|
|
s->msg_mask = val;
|
|
break;
|
|
case PEGPL_OMR1BAH:
|
|
s->omr1_base = ((uint64_t)val << 32) | (s->omr1_base & 0xffffffff);
|
|
break;
|
|
case PEGPL_OMR1BAL:
|
|
s->omr1_base = (s->omr1_base & 0xffffffff00000000ULL) | val;
|
|
break;
|
|
case PEGPL_OMR1MSKH:
|
|
s->omr1_mask = ((uint64_t)val << 32) | (s->omr1_mask & 0xffffffff);
|
|
break;
|
|
case PEGPL_OMR1MSKL:
|
|
s->omr1_mask = (s->omr1_mask & 0xffffffff00000000ULL) | val;
|
|
break;
|
|
case PEGPL_OMR2BAH:
|
|
s->omr2_base = ((uint64_t)val << 32) | (s->omr2_base & 0xffffffff);
|
|
break;
|
|
case PEGPL_OMR2BAL:
|
|
s->omr2_base = (s->omr2_base & 0xffffffff00000000ULL) | val;
|
|
break;
|
|
case PEGPL_OMR2MSKH:
|
|
s->omr2_mask = ((uint64_t)val << 32) | (s->omr2_mask & 0xffffffff);
|
|
break;
|
|
case PEGPL_OMR2MSKL:
|
|
s->omr2_mask = (s->omr2_mask & 0xffffffff00000000ULL) | val;
|
|
break;
|
|
case PEGPL_OMR3BAH:
|
|
s->omr3_base = ((uint64_t)val << 32) | (s->omr3_base & 0xffffffff);
|
|
break;
|
|
case PEGPL_OMR3BAL:
|
|
s->omr3_base = (s->omr3_base & 0xffffffff00000000ULL) | val;
|
|
break;
|
|
case PEGPL_OMR3MSKH:
|
|
s->omr3_mask = ((uint64_t)val << 32) | (s->omr3_mask & 0xffffffff);
|
|
break;
|
|
case PEGPL_OMR3MSKL:
|
|
s->omr3_mask = (s->omr3_mask & 0xffffffff00000000ULL) | val;
|
|
break;
|
|
case PEGPL_REGBAH:
|
|
s->reg_base = ((uint64_t)val << 32) | (s->reg_base & 0xffffffff);
|
|
break;
|
|
case PEGPL_REGBAL:
|
|
s->reg_base = (s->reg_base & 0xffffffff00000000ULL) | val;
|
|
break;
|
|
case PEGPL_REGMSK:
|
|
s->reg_mask = val;
|
|
/* FIXME: how is size encoded? */
|
|
size = (val == 0x7001 ? 4096 : ~(val & 0xfffffffe) + 1);
|
|
break;
|
|
case PEGPL_SPECIAL:
|
|
s->special = val;
|
|
break;
|
|
case PEGPL_CFG:
|
|
s->cfg = val;
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void ppc460ex_set_irq(void *opaque, int irq_num, int level)
|
|
{
|
|
PPC460EXPCIEState *s = opaque;
|
|
qemu_set_irq(s->irq[irq_num], level);
|
|
}
|
|
|
|
#define PPC440_PCIE_DCR(s, dcrn) \
|
|
ppc_dcr_register(&(s)->cpu->env, (s)->dcrn_base + (dcrn), (s), \
|
|
&dcr_read_pcie, &dcr_write_pcie)
|
|
|
|
|
|
static void ppc460ex_pcie_register_dcrs(PPC460EXPCIEState *s)
|
|
{
|
|
PPC440_PCIE_DCR(s, PEGPL_CFGBAH);
|
|
PPC440_PCIE_DCR(s, PEGPL_CFGBAL);
|
|
PPC440_PCIE_DCR(s, PEGPL_CFGMSK);
|
|
PPC440_PCIE_DCR(s, PEGPL_MSGBAH);
|
|
PPC440_PCIE_DCR(s, PEGPL_MSGBAL);
|
|
PPC440_PCIE_DCR(s, PEGPL_MSGMSK);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR1BAH);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR1BAL);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR1MSKH);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR1MSKL);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR2BAH);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR2BAL);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR2MSKH);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR2MSKL);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR3BAH);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR3BAL);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR3MSKH);
|
|
PPC440_PCIE_DCR(s, PEGPL_OMR3MSKL);
|
|
PPC440_PCIE_DCR(s, PEGPL_REGBAH);
|
|
PPC440_PCIE_DCR(s, PEGPL_REGBAL);
|
|
PPC440_PCIE_DCR(s, PEGPL_REGMSK);
|
|
PPC440_PCIE_DCR(s, PEGPL_SPECIAL);
|
|
PPC440_PCIE_DCR(s, PEGPL_CFG);
|
|
}
|
|
|
|
static void ppc460ex_pcie_realize(DeviceState *dev, Error **errp)
|
|
{
|
|
PPC460EXPCIEState *s = PPC460EX_PCIE_HOST(dev);
|
|
PCIHostState *pci = PCI_HOST_BRIDGE(dev);
|
|
int i;
|
|
char buf[20];
|
|
|
|
if (!s->cpu) {
|
|
error_setg(errp, "cpu link property must be set");
|
|
return;
|
|
}
|
|
if (s->num < 0 || s->dcrn_base < 0) {
|
|
error_setg(errp, "busnum and dcrn-base properties must be set");
|
|
return;
|
|
}
|
|
snprintf(buf, sizeof(buf), "pcie%d-mem", s->num);
|
|
memory_region_init(&s->busmem, OBJECT(s), buf, UINT64_MAX);
|
|
snprintf(buf, sizeof(buf), "pcie%d-io", s->num);
|
|
memory_region_init(&s->iomem, OBJECT(s), buf, 64 * KiB);
|
|
for (i = 0; i < 4; i++) {
|
|
sysbus_init_irq(SYS_BUS_DEVICE(dev), &s->irq[i]);
|
|
}
|
|
snprintf(buf, sizeof(buf), "pcie.%d", s->num);
|
|
pci->bus = pci_register_root_bus(DEVICE(s), buf, ppc460ex_set_irq,
|
|
pci_swizzle_map_irq_fn, s, &s->busmem,
|
|
&s->iomem, 0, 4, TYPE_PCIE_BUS);
|
|
ppc460ex_pcie_register_dcrs(s);
|
|
}
|
|
|
|
static Property ppc460ex_pcie_props[] = {
|
|
DEFINE_PROP_INT32("busnum", PPC460EXPCIEState, num, -1),
|
|
DEFINE_PROP_INT32("dcrn-base", PPC460EXPCIEState, dcrn_base, -1),
|
|
DEFINE_PROP_LINK("cpu", PPC460EXPCIEState, cpu, TYPE_POWERPC_CPU,
|
|
PowerPCCPU *),
|
|
DEFINE_PROP_END_OF_LIST(),
|
|
};
|
|
|
|
static void ppc460ex_pcie_class_init(ObjectClass *klass, void *data)
|
|
{
|
|
DeviceClass *dc = DEVICE_CLASS(klass);
|
|
|
|
set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories);
|
|
dc->realize = ppc460ex_pcie_realize;
|
|
device_class_set_props(dc, ppc460ex_pcie_props);
|
|
dc->hotpluggable = false;
|
|
}
|
|
|
|
static const TypeInfo ppc460ex_pcie_host_info = {
|
|
.name = TYPE_PPC460EX_PCIE_HOST,
|
|
.parent = TYPE_PCIE_HOST_BRIDGE,
|
|
.instance_size = sizeof(PPC460EXPCIEState),
|
|
.class_init = ppc460ex_pcie_class_init,
|
|
};
|
|
|
|
static void ppc460ex_pcie_register(void)
|
|
{
|
|
type_register_static(&ppc460ex_pcie_host_info);
|
|
}
|
|
|
|
type_init(ppc460ex_pcie_register)
|