[qemu.git] / hw / ppc4xx_devs.c

/*
 * QEMU PowerPC 4xx embedded processors shared devices emulation
 *
 * Copyright (c) 2007 Jocelyn Mayer
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
#include "hw.h"
#include "ppc.h"
#include "ppc4xx.h"
#include "sysemu.h"
#include "qemu-log.h"

//#define DEBUG_MMIO
//#define DEBUG_UNASSIGNED
#define DEBUG_UIC


#ifdef DEBUG_UIC
#  define LOG_UIC(...) qemu_log_mask(CPU_LOG_INT, ## __VA_ARGS__)
#else
#  define LOG_UIC(...) do { } while (0)
#endif

/*****************************************************************************/
/* Generic PowerPC 4xx processor instanciation */
CPUState *ppc4xx_init (const char *cpu_model,
                       clk_setup_t *cpu_clk, clk_setup_t *tb_clk,
                       uint32_t sysclk)
{
    CPUState *env;

    /* init CPUs */
    env = cpu_init(cpu_model);
    if (!env) {
        fprintf(stderr, "Unable to find PowerPC %s CPU definition\n",
                cpu_model);
        exit(1);
    }
    cpu_clk->cb = NULL; /* We don't care about CPU clock frequency changes */
    cpu_clk->opaque = env;
    /* Set time-base frequency to sysclk */
    tb_clk->cb = ppc_emb_timers_init(env, sysclk);
    tb_clk->opaque = env;
    ppc_dcr_init(env, NULL, NULL);
    /* Register qemu callbacks */
    qemu_register_reset((QEMUResetHandler*)&cpu_reset, env);

    return env;
}

/*****************************************************************************/
/* "Universal" Interrupt controller */
enum {
    DCR_UICSR  = 0x000,
    DCR_UICSRS = 0x001,
    DCR_UICER  = 0x002,
    DCR_UICCR  = 0x003,
    DCR_UICPR  = 0x004,
    DCR_UICTR  = 0x005,
    DCR_UICMSR = 0x006,
    DCR_UICVR  = 0x007,
    DCR_UICVCR = 0x008,
    DCR_UICMAX = 0x009,
};

#define UIC_MAX_IRQ 32
typedef struct ppcuic_t ppcuic_t;
struct ppcuic_t {
    uint32_t dcr_base;
    int use_vectors;
    uint32_t level;  /* Remembers the state of level-triggered interrupts. */
    uint32_t uicsr;  /* Status register */
    uint32_t uicer;  /* Enable register */
    uint32_t uiccr;  /* Critical register */
    uint32_t uicpr;  /* Polarity register */
    uint32_t uictr;  /* Triggering register */
    uint32_t uicvcr; /* Vector configuration register */
    uint32_t uicvr;
    qemu_irq *irqs;
};

static void ppcuic_trigger_irq (ppcuic_t *uic)
{
    uint32_t ir, cr;
    int start, end, inc, i;

    /* Trigger interrupt if any is pending */
    ir = uic->uicsr & uic->uicer & (~uic->uiccr);
    cr = uic->uicsr & uic->uicer & uic->uiccr;
    LOG_UIC("%s: uicsr %08" PRIx32 " uicer %08" PRIx32
                " uiccr %08" PRIx32 "\n"
                "   %08" PRIx32 " ir %08" PRIx32 " cr %08" PRIx32 "\n",
                __func__, uic->uicsr, uic->uicer, uic->uiccr,
                uic->uicsr & uic->uicer, ir, cr);
    if (ir != 0x0000000) {
        LOG_UIC("Raise UIC interrupt\n");
        qemu_irq_raise(uic->irqs[PPCUIC_OUTPUT_INT]);
    } else {
        LOG_UIC("Lower UIC interrupt\n");
        qemu_irq_lower(uic->irqs[PPCUIC_OUTPUT_INT]);
    }
    /* Trigger critical interrupt if any is pending and update vector */
    if (cr != 0x0000000) {
        qemu_irq_raise(uic->irqs[PPCUIC_OUTPUT_CINT]);
        if (uic->use_vectors) {
            /* Compute critical IRQ vector */
            if (uic->uicvcr & 1) {
                start = 31;
                end = 0;
                inc = -1;
            } else {
                start = 0;
                end = 31;
                inc = 1;
            }
            uic->uicvr = uic->uicvcr & 0xFFFFFFFC;
            for (i = start; i <= end; i += inc) {
                if (cr & (1 << i)) {
                    uic->uicvr += (i - start) * 512 * inc;
                    break;
                }
            }
        }
        LOG_UIC("Raise UIC critical interrupt - "
                    "vector %08" PRIx32 "\n", uic->uicvr);
    } else {
        LOG_UIC("Lower UIC critical interrupt\n");
        qemu_irq_lower(uic->irqs[PPCUIC_OUTPUT_CINT]);
        uic->uicvr = 0x00000000;
    }
}

static void ppcuic_set_irq (void *opaque, int irq_num, int level)
{
    ppcuic_t *uic;
    uint32_t mask, sr;

    uic = opaque;
    mask = 1 << (31-irq_num);
    LOG_UIC("%s: irq %d level %d uicsr %08" PRIx32
                " mask %08" PRIx32 " => %08" PRIx32 " %08" PRIx32 "\n",
                __func__, irq_num, level,
                uic->uicsr, mask, uic->uicsr & mask, level << irq_num);
    if (irq_num < 0 || irq_num > 31)
        return;
    sr = uic->uicsr;

    /* Update status register */
    if (uic->uictr & mask) {
        /* Edge sensitive interrupt */
        if (level == 1)
            uic->uicsr |= mask;
    } else {
        /* Level sensitive interrupt */
        if (level == 1) {
            uic->uicsr |= mask;
            uic->level |= mask;
        } else {
            uic->uicsr &= ~mask;
            uic->level &= ~mask;
        }
    }
    LOG_UIC("%s: irq %d level %d sr %" PRIx32 " => "
                "%08" PRIx32 "\n", __func__, irq_num, level, uic->uicsr, sr);
    if (sr != uic->uicsr)
        ppcuic_trigger_irq(uic);
}

static uint32_t dcr_read_uic (void *opaque, int dcrn)
{
    ppcuic_t *uic;
    uint32_t ret;

    uic = opaque;
    dcrn -= uic->dcr_base;
    switch (dcrn) {
    case DCR_UICSR:
    case DCR_UICSRS:
        ret = uic->uicsr;
        break;
    case DCR_UICER:
        ret = uic->uicer;
        break;
    case DCR_UICCR:
        ret = uic->uiccr;
        break;
    case DCR_UICPR:
        ret = uic->uicpr;
        break;
    case DCR_UICTR:
        ret = uic->uictr;
        break;
    case DCR_UICMSR:
        ret = uic->uicsr & uic->uicer;
        break;
    case DCR_UICVR:
        if (!uic->use_vectors)
            goto no_read;
        ret = uic->uicvr;
        break;
    case DCR_UICVCR:
        if (!uic->use_vectors)
            goto no_read;
        ret = uic->uicvcr;
        break;
    default:
    no_read:
        ret = 0x00000000;
        break;
    }

    return ret;
}

static void dcr_write_uic (void *opaque, int dcrn, uint32_t val)
{
    ppcuic_t *uic;

    uic = opaque;
    dcrn -= uic->dcr_base;
    LOG_UIC("%s: dcr %d val 0x%x\n", __func__, dcrn, val);
    switch (dcrn) {
    case DCR_UICSR:
        uic->uicsr &= ~val;
        uic->uicsr |= uic->level;
        ppcuic_trigger_irq(uic);
        break;
    case DCR_UICSRS:
        uic->uicsr |= val;
        ppcuic_trigger_irq(uic);
        break;
    case DCR_UICER:
        uic->uicer = val;
        ppcuic_trigger_irq(uic);
        break;
    case DCR_UICCR:
        uic->uiccr = val;
        ppcuic_trigger_irq(uic);
        break;
    case DCR_UICPR:
        uic->uicpr = val;
        break;
    case DCR_UICTR:
        uic->uictr = val;
        ppcuic_trigger_irq(uic);
        break;
    case DCR_UICMSR:
        break;
    case DCR_UICVR:
        break;
    case DCR_UICVCR:
        uic->uicvcr = val & 0xFFFFFFFD;
        ppcuic_trigger_irq(uic);
        break;
    }
}

static void ppcuic_reset (void *opaque)
{
    ppcuic_t *uic;

    uic = opaque;
    uic->uiccr = 0x00000000;
    uic->uicer = 0x00000000;
    uic->uicpr = 0x00000000;
    uic->uicsr = 0x00000000;
    uic->uictr = 0x00000000;
    if (uic->use_vectors) {
        uic->uicvcr = 0x00000000;
        uic->uicvr = 0x0000000;
    }
}

qemu_irq *ppcuic_init (CPUState *env, qemu_irq *irqs,
                       uint32_t dcr_base, int has_ssr, int has_vr)
{
    ppcuic_t *uic;
    int i;

    uic = qemu_mallocz(sizeof(ppcuic_t));
    uic->dcr_base = dcr_base;
    uic->irqs = irqs;
    if (has_vr)
        uic->use_vectors = 1;
    for (i = 0; i < DCR_UICMAX; i++) {
        ppc_dcr_register(env, dcr_base + i, uic,
                         &dcr_read_uic, &dcr_write_uic);
    }
    qemu_register_reset(ppcuic_reset, uic);

    return qemu_allocate_irqs(&ppcuic_set_irq, uic, UIC_MAX_IRQ);
}

/*****************************************************************************/
/* SDRAM controller */
typedef struct ppc4xx_sdram_t ppc4xx_sdram_t;
struct ppc4xx_sdram_t {
    uint32_t addr;
    int nbanks;
    target_phys_addr_t ram_bases[4];
    target_phys_addr_t ram_sizes[4];
    uint32_t besr0;
    uint32_t besr1;
    uint32_t bear;
    uint32_t cfg;
    uint32_t status;
    uint32_t rtr;
    uint32_t pmit;
    uint32_t bcr[4];
    uint32_t tr;
    uint32_t ecccfg;
    uint32_t eccesr;
    qemu_irq irq;
};

enum {
    SDRAM0_CFGADDR = 0x010,
    SDRAM0_CFGDATA = 0x011,
};

/* XXX: TOFIX: some patches have made this code become inconsistent:
 *      there are type inconsistencies, mixing target_phys_addr_t, target_ulong
 *      and uint32_t
 */
static uint32_t sdram_bcr (target_phys_addr_t ram_base,
                           target_phys_addr_t ram_size)
{
    uint32_t bcr;

    switch (ram_size) {
    case (4 * 1024 * 1024):
        bcr = 0x00000000;
        break;
    case (8 * 1024 * 1024):
        bcr = 0x00020000;
        break;
    case (16 * 1024 * 1024):
        bcr = 0x00040000;
        break;
    case (32 * 1024 * 1024):
        bcr = 0x00060000;
        break;
    case (64 * 1024 * 1024):
        bcr = 0x00080000;
        break;
    case (128 * 1024 * 1024):
        bcr = 0x000A0000;
        break;
    case (256 * 1024 * 1024):
        bcr = 0x000C0000;
        break;
    default:
        printf("%s: invalid RAM size " TARGET_FMT_plx "\n", __func__,
               ram_size);
        return 0x00000000;
    }
    bcr |= ram_base & 0xFF800000;
    bcr |= 1;

    return bcr;
}

static inline target_phys_addr_t sdram_base(uint32_t bcr)
{
    return bcr & 0xFF800000;
}

static target_ulong sdram_size (uint32_t bcr)
{
    target_ulong size;
    int sh;

    sh = (bcr >> 17) & 0x7;
    if (sh == 7)
        size = -1;
    else
        size = (4 * 1024 * 1024) << sh;

    return size;
}

static void sdram_set_bcr (uint32_t *bcrp, uint32_t bcr, int enabled)
{
    if (*bcrp & 0x00000001) {
        /* Unmap RAM */
#ifdef DEBUG_SDRAM
        printf("%s: unmap RAM area " TARGET_FMT_plx " " TARGET_FMT_lx "\n",
               __func__, sdram_base(*bcrp), sdram_size(*bcrp));
#endif
        cpu_register_physical_memory(sdram_base(*bcrp), sdram_size(*bcrp),
                                     IO_MEM_UNASSIGNED);
    }
    *bcrp = bcr & 0xFFDEE001;
    if (enabled && (bcr & 0x00000001)) {
#ifdef DEBUG_SDRAM
        printf("%s: Map RAM area " TARGET_FMT_plx " " TARGET_FMT_lx "\n",
               __func__, sdram_base(bcr), sdram_size(bcr));
#endif
        cpu_register_physical_memory(sdram_base(bcr), sdram_size(bcr),
                                     sdram_base(bcr) | IO_MEM_RAM);
    }
}

static void sdram_map_bcr (ppc4xx_sdram_t *sdram)
{
    int i;

    for (i = 0; i < sdram->nbanks; i++) {
        if (sdram->ram_sizes[i] != 0) {
            sdram_set_bcr(&sdram->bcr[i],
                          sdram_bcr(sdram->ram_bases[i], sdram->ram_sizes[i]),
                          1);
        } else {
            sdram_set_bcr(&sdram->bcr[i], 0x00000000, 0);
        }
    }
}

static void sdram_unmap_bcr (ppc4xx_sdram_t *sdram)
{
    int i;

    for (i = 0; i < sdram->nbanks; i++) {
#ifdef DEBUG_SDRAM
        printf("%s: Unmap RAM area " TARGET_FMT_plx " " TARGET_FMT_lx "\n",
               __func__, sdram_base(sdram->bcr[i]), sdram_size(sdram->bcr[i]));
#endif
        cpu_register_physical_memory(sdram_base(sdram->bcr[i]),
                                     sdram_size(sdram->bcr[i]),
                                     IO_MEM_UNASSIGNED);
    }
}

static uint32_t dcr_read_sdram (void *opaque, int dcrn)
{
    ppc4xx_sdram_t *sdram;
    uint32_t ret;

    sdram = opaque;
    switch (dcrn) {
    case SDRAM0_CFGADDR:
        ret = sdram->addr;
        break;
    case SDRAM0_CFGDATA:
        switch (sdram->addr) {
        case 0x00: /* SDRAM_BESR0 */
            ret = sdram->besr0;
            break;
        case 0x08: /* SDRAM_BESR1 */
            ret = sdram->besr1;
            break;
        case 0x10: /* SDRAM_BEAR */
            ret = sdram->bear;
            break;
        case 0x20: /* SDRAM_CFG */
            ret = sdram->cfg;
            break;
        case 0x24: /* SDRAM_STATUS */
            ret = sdram->status;
            break;
        case 0x30: /* SDRAM_RTR */
            ret = sdram->rtr;
            break;
        case 0x34: /* SDRAM_PMIT */
            ret = sdram->pmit;
            break;
        case 0x40: /* SDRAM_B0CR */
            ret = sdram->bcr[0];
            break;
        case 0x44: /* SDRAM_B1CR */
            ret = sdram->bcr[1];
            break;
        case 0x48: /* SDRAM_B2CR */
            ret = sdram->bcr[2];
            break;
        case 0x4C: /* SDRAM_B3CR */
            ret = sdram->bcr[3];
            break;
        case 0x80: /* SDRAM_TR */
            ret = -1; /* ? */
            break;
        case 0x94: /* SDRAM_ECCCFG */
            ret = sdram->ecccfg;
            break;
        case 0x98: /* SDRAM_ECCESR */
            ret = sdram->eccesr;
            break;
        default: /* Error */
            ret = -1;
            break;
        }
        break;
    default:
        /* Avoid gcc warning */
        ret = 0x00000000;
        break;
    }

    return ret;
}

static void dcr_write_sdram (void *opaque, int dcrn, uint32_t val)
{
    ppc4xx_sdram_t *sdram;

    sdram = opaque;
    switch (dcrn) {
    case SDRAM0_CFGADDR:
        sdram->addr = val;
        break;
    case SDRAM0_CFGDATA:
        switch (sdram->addr) {
        case 0x00: /* SDRAM_BESR0 */
            sdram->besr0 &= ~val;
            break;
        case 0x08: /* SDRAM_BESR1 */
            sdram->besr1 &= ~val;
            break;
        case 0x10: /* SDRAM_BEAR */
            sdram->bear = val;
            break;
        case 0x20: /* SDRAM_CFG */
            val &= 0xFFE00000;
            if (!(sdram->cfg & 0x80000000) && (val & 0x80000000)) {
#ifdef DEBUG_SDRAM
                printf("%s: enable SDRAM controller\n", __func__);
#endif
                /* validate all RAM mappings */
                sdram_map_bcr(sdram);
                sdram->status &= ~0x80000000;
            } else if ((sdram->cfg & 0x80000000) && !(val & 0x80000000)) {
#ifdef DEBUG_SDRAM
                printf("%s: disable SDRAM controller\n", __func__);
#endif
                /* invalidate all RAM mappings */
                sdram_unmap_bcr(sdram);
                sdram->status |= 0x80000000;
            }
            if (!(sdram->cfg & 0x40000000) && (val & 0x40000000))
                sdram->status |= 0x40000000;
            else if ((sdram->cfg & 0x40000000) && !(val & 0x40000000))
                sdram->status &= ~0x40000000;
            sdram->cfg = val;
            break;
        case 0x24: /* SDRAM_STATUS */
            /* Read-only register */
            break;
        case 0x30: /* SDRAM_RTR */
            sdram->rtr = val & 0x3FF80000;
            break;
        case 0x34: /* SDRAM_PMIT */
            sdram->pmit = (val & 0xF8000000) | 0x07C00000;
            break;
        case 0x40: /* SDRAM_B0CR */
            sdram_set_bcr(&sdram->bcr[0], val, sdram->cfg & 0x80000000);
            break;
        case 0x44: /* SDRAM_B1CR */
            sdram_set_bcr(&sdram->bcr[1], val, sdram->cfg & 0x80000000);
            break;
        case 0x48: /* SDRAM_B2CR */
            sdram_set_bcr(&sdram->bcr[2], val, sdram->cfg & 0x80000000);
            break;
        case 0x4C: /* SDRAM_B3CR */
            sdram_set_bcr(&sdram->bcr[3], val, sdram->cfg & 0x80000000);
            break;
        case 0x80: /* SDRAM_TR */
            sdram->tr = val & 0x018FC01F;
            break;
        case 0x94: /* SDRAM_ECCCFG */
            sdram->ecccfg = val & 0x00F00000;
            break;
        case 0x98: /* SDRAM_ECCESR */
            val &= 0xFFF0F000;
            if (sdram->eccesr == 0 && val != 0)
                qemu_irq_raise(sdram->irq);
            else if (sdram->eccesr != 0 && val == 0)
                qemu_irq_lower(sdram->irq);
            sdram->eccesr = val;
            break;
        default: /* Error */
            break;
        }
        break;
    }
}

static void sdram_reset (void *opaque)
{
    ppc4xx_sdram_t *sdram;

    sdram = opaque;
    sdram->addr = 0x00000000;
    sdram->bear = 0x00000000;
    sdram->besr0 = 0x00000000; /* No error */
    sdram->besr1 = 0x00000000; /* No error */
    sdram->cfg = 0x00000000;
    sdram->ecccfg = 0x00000000; /* No ECC */
    sdram->eccesr = 0x00000000; /* No error */
    sdram->pmit = 0x07C00000;
    sdram->rtr = 0x05F00000;
    sdram->tr = 0x00854009;
    /* We pre-initialize RAM banks */
    sdram->status = 0x00000000;
    sdram->cfg = 0x00800000;
    sdram_unmap_bcr(sdram);
}

void ppc4xx_sdram_init (CPUState *env, qemu_irq irq, int nbanks,
                        target_phys_addr_t *ram_bases,
                        target_phys_addr_t *ram_sizes,
                        int do_init)
{
    ppc4xx_sdram_t *sdram;

    sdram = qemu_mallocz(sizeof(ppc4xx_sdram_t));
    sdram->irq = irq;
    sdram->nbanks = nbanks;
    memset(sdram->ram_bases, 0, 4 * sizeof(target_phys_addr_t));
    memcpy(sdram->ram_bases, ram_bases,
           nbanks * sizeof(target_phys_addr_t));
    memset(sdram->ram_sizes, 0, 4 * sizeof(target_phys_addr_t));
    memcpy(sdram->ram_sizes, ram_sizes,
           nbanks * sizeof(target_phys_addr_t));
    qemu_register_reset(&sdram_reset, sdram);
    ppc_dcr_register(env, SDRAM0_CFGADDR,
                     sdram, &dcr_read_sdram, &dcr_write_sdram);
    ppc_dcr_register(env, SDRAM0_CFGDATA,
                     sdram, &dcr_read_sdram, &dcr_write_sdram);
    if (do_init)
        sdram_map_bcr(sdram);
}

/* Fill in consecutive SDRAM banks with 'ram_size' bytes of memory.
 *
 * sdram_bank_sizes[] must be 0-terminated.
 *
 * The 4xx SDRAM controller supports a small number of banks, and each bank
 * must be one of a small set of sizes. The number of banks and the supported
 * sizes varies by SoC. */
ram_addr_t ppc4xx_sdram_adjust(ram_addr_t ram_size, int nr_banks,
                               target_phys_addr_t ram_bases[],
                               target_phys_addr_t ram_sizes[],
                               const unsigned int sdram_bank_sizes[])
{
    ram_addr_t size_left = ram_size;
    int i;
    int j;

    for (i = 0; i < nr_banks; i++) {
        for (j = 0; sdram_bank_sizes[j] != 0; j++) {
            unsigned int bank_size = sdram_bank_sizes[j];

            if (bank_size <= size_left) {
                ram_bases[i] = qemu_ram_alloc(bank_size);
                ram_sizes[i] = bank_size;
                size_left -= bank_size;
                break;
            }
        }

        if (!size_left) {
            /* No need to use the remaining banks. */
            break;
        }
    }

    ram_size -= size_left;
    if (ram_size)
        printf("Truncating memory to %d MiB to fit SDRAM controller limits.\n",
               (int)(ram_size >> 20));

    return ram_size;
}
Commit	Line	Data
008ff9d7 JM	1	/*
	2	* QEMU PowerPC 4xx embedded processors shared devices emulation
	3	*
	4	* Copyright (c) 2007 Jocelyn Mayer
	5	*
	6	* Permission is hereby granted, free of charge, to any person obtaining a copy
	7	* of this software and associated documentation files (the "Software"), to deal
	8	* in the Software without restriction, including without limitation the rights
	9	* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
	10	* copies of the Software, and to permit persons to whom the Software is
	11	* furnished to do so, subject to the following conditions:
	12	*
	13	* The above copyright notice and this permission notice shall be included in
	14	* all copies or substantial portions of the Software.
	15	*
	16	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	17	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	18	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	19	* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
	20	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
	21	* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
	22	* THE SOFTWARE.
	23	*/
87ecb68b PB	24	#include "hw.h"
87ecb68b PB	25	#include "ppc.h"
008ff9d7	26	#include "ppc4xx.h"
87ecb68b	27	#include "sysemu.h"
3b3fb322	28	#include "qemu-log.h"
008ff9d7 JM	29
008ff9d7 JM	30	//#define DEBUG_MMIO
aae9366a	31	//#define DEBUG_UNASSIGNED
008ff9d7 JM	32	#define DEBUG_UIC
008ff9d7 JM	33
d12d51d5 AL	34
d12d51d5 AL	35	#ifdef DEBUG_UIC
93fcfe39	36	# define LOG_UIC(...) qemu_log_mask(CPU_LOG_INT, ## __VA_ARGS__)
d12d51d5 AL	37	#else
	38	# define LOG_UIC(...) do { } while (0)
	39	#endif
	40
008ff9d7 JM	41	/*****************************************************************************/
008ff9d7 JM	42	/* Generic PowerPC 4xx processor instanciation */
b55266b5	43	CPUState ppc4xx_init (const char cpu_model,
c227f099	44	clk_setup_t cpu_clk, clk_setup_t tb_clk,
008ff9d7 JM	45	uint32_t sysclk)
	46	{
	47	CPUState *env;
008ff9d7 JM	48
008ff9d7 JM	49	/* init CPUs */
aaed909a FB	50	env = cpu_init(cpu_model);
	51	if (!env) {
	52	fprintf(stderr, "Unable to find PowerPC %s CPU definition\n",
	53	cpu_model);
	54	exit(1);
008ff9d7	55	}
008ff9d7 JM	56	cpu_clk->cb = NULL; /* We don't care about CPU clock frequency changes */
	57	cpu_clk->opaque = env;
	58	/* Set time-base frequency to sysclk */
	59	tb_clk->cb = ppc_emb_timers_init(env, sysclk);
	60	tb_clk->opaque = env;
	61	ppc_dcr_init(env, NULL, NULL);
	62	/* Register qemu callbacks */
d84bda46	63	qemu_register_reset((QEMUResetHandler*)&cpu_reset, env);
008ff9d7 JM	64
	65	return env;
	66	}
	67
008ff9d7 JM	68	/*****************************************************************************/
	69	/* "Universal" Interrupt controller */
	70	enum {
	71	DCR_UICSR = 0x000,
	72	DCR_UICSRS = 0x001,
	73	DCR_UICER = 0x002,
	74	DCR_UICCR = 0x003,
	75	DCR_UICPR = 0x004,
	76	DCR_UICTR = 0x005,
	77	DCR_UICMSR = 0x006,
	78	DCR_UICVR = 0x007,
	79	DCR_UICVCR = 0x008,
	80	DCR_UICMAX = 0x009,
	81	};
	82
	83	#define UIC_MAX_IRQ 32
c227f099 AL	84	typedef struct ppcuic_t ppcuic_t;
c227f099 AL	85	struct ppcuic_t {
008ff9d7 JM	86	uint32_t dcr_base;
008ff9d7 JM	87	int use_vectors;
4c54e875	88	uint32_t level; /* Remembers the state of level-triggered interrupts. */
008ff9d7 JM	89	uint32_t uicsr; /* Status register */
	90	uint32_t uicer; /* Enable register */
	91	uint32_t uiccr; /* Critical register */
	92	uint32_t uicpr; /* Polarity register */
	93	uint32_t uictr; /* Triggering register */
	94	uint32_t uicvcr; /* Vector configuration register */
	95	uint32_t uicvr;
	96	qemu_irq *irqs;
	97	};
	98
c227f099	99	static void ppcuic_trigger_irq (ppcuic_t *uic)
008ff9d7 JM	100	{
	101	uint32_t ir, cr;
	102	int start, end, inc, i;
	103
	104	/* Trigger interrupt if any is pending */
	105	ir = uic->uicsr & uic->uicer & (~uic->uiccr);
	106	cr = uic->uicsr & uic->uicer & uic->uiccr;
d12d51d5	107	LOG_UIC("%s: uicsr %08" PRIx32 " uicer %08" PRIx32
aae9366a JM	108	" uiccr %08" PRIx32 "\n"
	109	" %08" PRIx32 " ir %08" PRIx32 " cr %08" PRIx32 "\n",
	110	__func__, uic->uicsr, uic->uicer, uic->uiccr,
008ff9d7	111	uic->uicsr & uic->uicer, ir, cr);
008ff9d7	112	if (ir != 0x0000000) {
d12d51d5	113	LOG_UIC("Raise UIC interrupt\n");
008ff9d7 JM	114	qemu_irq_raise(uic->irqs[PPCUIC_OUTPUT_INT]);
008ff9d7 JM	115	} else {
d12d51d5	116	LOG_UIC("Lower UIC interrupt\n");
008ff9d7 JM	117	qemu_irq_lower(uic->irqs[PPCUIC_OUTPUT_INT]);
	118	}
	119	/* Trigger critical interrupt if any is pending and update vector */
	120	if (cr != 0x0000000) {
	121	qemu_irq_raise(uic->irqs[PPCUIC_OUTPUT_CINT]);
	122	if (uic->use_vectors) {
	123	/* Compute critical IRQ vector */
	124	if (uic->uicvcr & 1) {
	125	start = 31;
	126	end = 0;
	127	inc = -1;
	128	} else {
	129	start = 0;
	130	end = 31;
	131	inc = 1;
	132	}
	133	uic->uicvr = uic->uicvcr & 0xFFFFFFFC;
	134	for (i = start; i <= end; i += inc) {
	135	if (cr & (1 << i)) {
	136	uic->uicvr += (i - start) * 512 * inc;
	137	break;
	138	}
	139	}
	140	}
d12d51d5	141	LOG_UIC("Raise UIC critical interrupt - "
aae9366a	142	"vector %08" PRIx32 "\n", uic->uicvr);
008ff9d7	143	} else {
d12d51d5	144	LOG_UIC("Lower UIC critical interrupt\n");
008ff9d7 JM	145	qemu_irq_lower(uic->irqs[PPCUIC_OUTPUT_CINT]);
	146	uic->uicvr = 0x00000000;
	147	}
	148	}
	149
	150	static void ppcuic_set_irq (void *opaque, int irq_num, int level)
	151	{
c227f099	152	ppcuic_t *uic;
008ff9d7 JM	153	uint32_t mask, sr;
	154
	155	uic = opaque;
923e5e33	156	mask = 1 << (31-irq_num);
d12d51d5	157	LOG_UIC("%s: irq %d level %d uicsr %08" PRIx32
aae9366a JM	158	" mask %08" PRIx32 " => %08" PRIx32 " %08" PRIx32 "\n",
aae9366a JM	159	__func__, irq_num, level,
008ff9d7	160	uic->uicsr, mask, uic->uicsr & mask, level << irq_num);
008ff9d7 JM	161	if (irq_num < 0 \|\| irq_num > 31)
	162	return;
	163	sr = uic->uicsr;
50bf72b3	164
008ff9d7 JM	165	/* Update status register */
	166	if (uic->uictr & mask) {
	167	/* Edge sensitive interrupt */
	168	if (level == 1)
	169	uic->uicsr \|= mask;
	170	} else {
	171	/* Level sensitive interrupt */
4c54e875	172	if (level == 1) {
008ff9d7	173	uic->uicsr \|= mask;
4c54e875 AJ	174	uic->level \|= mask;
4c54e875 AJ	175	} else {
008ff9d7	176	uic->uicsr &= ~mask;
4c54e875 AJ	177	uic->level &= ~mask;
4c54e875 AJ	178	}
008ff9d7	179	}
d12d51d5	180	LOG_UIC("%s: irq %d level %d sr %" PRIx32 " => "
aae9366a	181	"%08" PRIx32 "\n", __func__, irq_num, level, uic->uicsr, sr);
008ff9d7 JM	182	if (sr != uic->uicsr)
	183	ppcuic_trigger_irq(uic);
	184	}
	185
73b01960	186	static uint32_t dcr_read_uic (void *opaque, int dcrn)
008ff9d7	187	{
c227f099	188	ppcuic_t *uic;
73b01960	189	uint32_t ret;
008ff9d7 JM	190
	191	uic = opaque;
	192	dcrn -= uic->dcr_base;
	193	switch (dcrn) {
	194	case DCR_UICSR:
	195	case DCR_UICSRS:
	196	ret = uic->uicsr;
	197	break;
	198	case DCR_UICER:
	199	ret = uic->uicer;
	200	break;
	201	case DCR_UICCR:
	202	ret = uic->uiccr;
	203	break;
	204	case DCR_UICPR:
	205	ret = uic->uicpr;
	206	break;
	207	case DCR_UICTR:
	208	ret = uic->uictr;
	209	break;
	210	case DCR_UICMSR:
	211	ret = uic->uicsr & uic->uicer;
	212	break;
	213	case DCR_UICVR:
	214	if (!uic->use_vectors)
	215	goto no_read;
	216	ret = uic->uicvr;
	217	break;
	218	case DCR_UICVCR:
	219	if (!uic->use_vectors)
	220	goto no_read;
	221	ret = uic->uicvcr;
	222	break;
	223	default:
	224	no_read:
	225	ret = 0x00000000;
	226	break;
	227	}
	228
	229	return ret;
	230	}
	231
73b01960	232	static void dcr_write_uic (void *opaque, int dcrn, uint32_t val)
008ff9d7	233	{
c227f099	234	ppcuic_t *uic;
008ff9d7 JM	235
	236	uic = opaque;
	237	dcrn -= uic->dcr_base;
73b01960	238	LOG_UIC("%s: dcr %d val 0x%x\n", __func__, dcrn, val);
008ff9d7 JM	239	switch (dcrn) {
	240	case DCR_UICSR:
	241	uic->uicsr &= ~val;
4c54e875	242	uic->uicsr \|= uic->level;
008ff9d7 JM	243	ppcuic_trigger_irq(uic);
	244	break;
	245	case DCR_UICSRS:
	246	uic->uicsr \|= val;
	247	ppcuic_trigger_irq(uic);
	248	break;
	249	case DCR_UICER:
	250	uic->uicer = val;
	251	ppcuic_trigger_irq(uic);
	252	break;
	253	case DCR_UICCR:
	254	uic->uiccr = val;
	255	ppcuic_trigger_irq(uic);
	256	break;
	257	case DCR_UICPR:
	258	uic->uicpr = val;
008ff9d7 JM	259	break;
	260	case DCR_UICTR:
	261	uic->uictr = val;
	262	ppcuic_trigger_irq(uic);
	263	break;
	264	case DCR_UICMSR:
	265	break;
	266	case DCR_UICVR:
	267	break;
	268	case DCR_UICVCR:
	269	uic->uicvcr = val & 0xFFFFFFFD;
	270	ppcuic_trigger_irq(uic);
	271	break;
	272	}
	273	}
	274
	275	static void ppcuic_reset (void *opaque)
	276	{
c227f099	277	ppcuic_t *uic;
008ff9d7 JM	278
	279	uic = opaque;
	280	uic->uiccr = 0x00000000;
	281	uic->uicer = 0x00000000;
	282	uic->uicpr = 0x00000000;
	283	uic->uicsr = 0x00000000;
	284	uic->uictr = 0x00000000;
	285	if (uic->use_vectors) {
	286	uic->uicvcr = 0x00000000;
	287	uic->uicvr = 0x0000000;
	288	}
	289	}
	290
	291	qemu_irq ppcuic_init (CPUState env, qemu_irq *irqs,
	292	uint32_t dcr_base, int has_ssr, int has_vr)
	293	{
c227f099	294	ppcuic_t *uic;
008ff9d7 JM	295	int i;
008ff9d7 JM	296
c227f099	297	uic = qemu_mallocz(sizeof(ppcuic_t));
487414f1 AL	298	uic->dcr_base = dcr_base;
	299	uic->irqs = irqs;
	300	if (has_vr)
	301	uic->use_vectors = 1;
	302	for (i = 0; i < DCR_UICMAX; i++) {
	303	ppc_dcr_register(env, dcr_base + i, uic,
	304	&dcr_read_uic, &dcr_write_uic);
008ff9d7	305	}
a08d4367	306	qemu_register_reset(ppcuic_reset, uic);
008ff9d7 JM	307
	308	return qemu_allocate_irqs(&ppcuic_set_irq, uic, UIC_MAX_IRQ);
	309	}
61b24405 AJ	310
	311	/*****************************************************************************/
	312	/* SDRAM controller */
c227f099 AL	313	typedef struct ppc4xx_sdram_t ppc4xx_sdram_t;
c227f099 AL	314	struct ppc4xx_sdram_t {
61b24405 AJ	315	uint32_t addr;
61b24405 AJ	316	int nbanks;
c227f099 AL	317	target_phys_addr_t ram_bases[4];
c227f099 AL	318	target_phys_addr_t ram_sizes[4];
61b24405 AJ	319	uint32_t besr0;
	320	uint32_t besr1;
	321	uint32_t bear;
	322	uint32_t cfg;
	323	uint32_t status;
	324	uint32_t rtr;
	325	uint32_t pmit;
	326	uint32_t bcr[4];
	327	uint32_t tr;
	328	uint32_t ecccfg;
	329	uint32_t eccesr;
	330	qemu_irq irq;
	331	};
	332
	333	enum {
	334	SDRAM0_CFGADDR = 0x010,
	335	SDRAM0_CFGDATA = 0x011,
	336	};
	337
	338	/* XXX: TOFIX: some patches have made this code become inconsistent:
c227f099	339	* there are type inconsistencies, mixing target_phys_addr_t, target_ulong
61b24405 AJ	340	* and uint32_t
61b24405 AJ	341	*/
c227f099 AL	342	static uint32_t sdram_bcr (target_phys_addr_t ram_base,
c227f099 AL	343	target_phys_addr_t ram_size)
61b24405 AJ	344	{
	345	uint32_t bcr;
	346
	347	switch (ram_size) {
	348	case (4 * 1024 * 1024):
	349	bcr = 0x00000000;
	350	break;
	351	case (8 * 1024 * 1024):
	352	bcr = 0x00020000;
	353	break;
	354	case (16 * 1024 * 1024):
	355	bcr = 0x00040000;
	356	break;
	357	case (32 * 1024 * 1024):
	358	bcr = 0x00060000;
	359	break;
	360	case (64 * 1024 * 1024):
	361	bcr = 0x00080000;
	362	break;
	363	case (128 * 1024 * 1024):
	364	bcr = 0x000A0000;
	365	break;
	366	case (256 * 1024 * 1024):
	367	bcr = 0x000C0000;
	368	break;
	369	default:
90e189ec BS	370	printf("%s: invalid RAM size " TARGET_FMT_plx "\n", __func__,
90e189ec BS	371	ram_size);
61b24405 AJ	372	return 0x00000000;
	373	}
	374	bcr \|= ram_base & 0xFF800000;
	375	bcr \|= 1;
	376
	377	return bcr;
	378	}
	379
c227f099	380	static inline target_phys_addr_t sdram_base(uint32_t bcr)
61b24405 AJ	381	{
	382	return bcr & 0xFF800000;
	383	}
	384
	385	static target_ulong sdram_size (uint32_t bcr)
	386	{
	387	target_ulong size;
	388	int sh;
	389
	390	sh = (bcr >> 17) & 0x7;
	391	if (sh == 7)
	392	size = -1;
	393	else
	394	size = (4 * 1024 * 1024) << sh;
	395
	396	return size;
	397	}
	398
	399	static void sdram_set_bcr (uint32_t *bcrp, uint32_t bcr, int enabled)
	400	{
	401	if (*bcrp & 0x00000001) {
	402	/* Unmap RAM */
	403	#ifdef DEBUG_SDRAM
90e189ec	404	printf("%s: unmap RAM area " TARGET_FMT_plx " " TARGET_FMT_lx "\n",
61b24405 AJ	405	__func__, sdram_base(bcrp), sdram_size(bcrp));
	406	#endif
	407	cpu_register_physical_memory(sdram_base(bcrp), sdram_size(bcrp),
	408	IO_MEM_UNASSIGNED);
	409	}
	410	*bcrp = bcr & 0xFFDEE001;
	411	if (enabled && (bcr & 0x00000001)) {
	412	#ifdef DEBUG_SDRAM
90e189ec	413	printf("%s: Map RAM area " TARGET_FMT_plx " " TARGET_FMT_lx "\n",
61b24405 AJ	414	__func__, sdram_base(bcr), sdram_size(bcr));
	415	#endif
	416	cpu_register_physical_memory(sdram_base(bcr), sdram_size(bcr),
	417	sdram_base(bcr) \| IO_MEM_RAM);
	418	}
	419	}
	420
c227f099	421	static void sdram_map_bcr (ppc4xx_sdram_t *sdram)
61b24405 AJ	422	{
	423	int i;
	424
	425	for (i = 0; i < sdram->nbanks; i++) {
	426	if (sdram->ram_sizes[i] != 0) {
	427	sdram_set_bcr(&sdram->bcr[i],
	428	sdram_bcr(sdram->ram_bases[i], sdram->ram_sizes[i]),
	429	1);
	430	} else {
	431	sdram_set_bcr(&sdram->bcr[i], 0x00000000, 0);
	432	}
	433	}
	434	}
	435
c227f099	436	static void sdram_unmap_bcr (ppc4xx_sdram_t *sdram)
61b24405 AJ	437	{
	438	int i;
	439
	440	for (i = 0; i < sdram->nbanks; i++) {
	441	#ifdef DEBUG_SDRAM
90e189ec	442	printf("%s: Unmap RAM area " TARGET_FMT_plx " " TARGET_FMT_lx "\n",
61b24405 AJ	443	__func__, sdram_base(sdram->bcr[i]), sdram_size(sdram->bcr[i]));
	444	#endif
	445	cpu_register_physical_memory(sdram_base(sdram->bcr[i]),
	446	sdram_size(sdram->bcr[i]),
	447	IO_MEM_UNASSIGNED);
	448	}
	449	}
	450
73b01960	451	static uint32_t dcr_read_sdram (void *opaque, int dcrn)
61b24405	452	{
c227f099	453	ppc4xx_sdram_t *sdram;
73b01960	454	uint32_t ret;
61b24405 AJ	455
	456	sdram = opaque;
	457	switch (dcrn) {
	458	case SDRAM0_CFGADDR:
	459	ret = sdram->addr;
	460	break;
	461	case SDRAM0_CFGDATA:
	462	switch (sdram->addr) {
	463	case 0x00: /* SDRAM_BESR0 */
	464	ret = sdram->besr0;
	465	break;
	466	case 0x08: /* SDRAM_BESR1 */
	467	ret = sdram->besr1;
	468	break;
	469	case 0x10: /* SDRAM_BEAR */
	470	ret = sdram->bear;
	471	break;
	472	case 0x20: /* SDRAM_CFG */
	473	ret = sdram->cfg;
	474	break;
	475	case 0x24: /* SDRAM_STATUS */
	476	ret = sdram->status;
	477	break;
	478	case 0x30: /* SDRAM_RTR */
	479	ret = sdram->rtr;
	480	break;
	481	case 0x34: /* SDRAM_PMIT */
	482	ret = sdram->pmit;
	483	break;
	484	case 0x40: /* SDRAM_B0CR */
	485	ret = sdram->bcr[0];
	486	break;
	487	case 0x44: /* SDRAM_B1CR */
	488	ret = sdram->bcr[1];
	489	break;
	490	case 0x48: /* SDRAM_B2CR */
	491	ret = sdram->bcr[2];
	492	break;
	493	case 0x4C: /* SDRAM_B3CR */
	494	ret = sdram->bcr[3];
	495	break;
	496	case 0x80: /* SDRAM_TR */
	497	ret = -1; /* ? */
	498	break;
	499	case 0x94: /* SDRAM_ECCCFG */
	500	ret = sdram->ecccfg;
	501	break;
	502	case 0x98: /* SDRAM_ECCESR */
	503	ret = sdram->eccesr;
	504	break;
	505	default: /* Error */
	506	ret = -1;
	507	break;
	508	}
	509	break;
	510	default:
	511	/* Avoid gcc warning */
	512	ret = 0x00000000;
	513	break;
	514	}
	515
	516	return ret;
	517	}
	518
73b01960	519	static void dcr_write_sdram (void *opaque, int dcrn, uint32_t val)
61b24405	520	{
c227f099	521	ppc4xx_sdram_t *sdram;
61b24405 AJ	522
	523	sdram = opaque;
	524	switch (dcrn) {
	525	case SDRAM0_CFGADDR:
	526	sdram->addr = val;
	527	break;
	528	case SDRAM0_CFGDATA:
	529	switch (sdram->addr) {
	530	case 0x00: /* SDRAM_BESR0 */
	531	sdram->besr0 &= ~val;
	532	break;
	533	case 0x08: /* SDRAM_BESR1 */
	534	sdram->besr1 &= ~val;
	535	break;
	536	case 0x10: /* SDRAM_BEAR */
	537	sdram->bear = val;
	538	break;
	539	case 0x20: /* SDRAM_CFG */
	540	val &= 0xFFE00000;
	541	if (!(sdram->cfg & 0x80000000) && (val & 0x80000000)) {
	542	#ifdef DEBUG_SDRAM
	543	printf("%s: enable SDRAM controller\n", __func__);
	544	#endif
	545	/* validate all RAM mappings */
	546	sdram_map_bcr(sdram);
	547	sdram->status &= ~0x80000000;
	548	} else if ((sdram->cfg & 0x80000000) && !(val & 0x80000000)) {
	549	#ifdef DEBUG_SDRAM
	550	printf("%s: disable SDRAM controller\n", __func__);
	551	#endif
	552	/* invalidate all RAM mappings */
	553	sdram_unmap_bcr(sdram);
	554	sdram->status \|= 0x80000000;
	555	}
	556	if (!(sdram->cfg & 0x40000000) && (val & 0x40000000))
	557	sdram->status \|= 0x40000000;
	558	else if ((sdram->cfg & 0x40000000) && !(val & 0x40000000))
	559	sdram->status &= ~0x40000000;
	560	sdram->cfg = val;
	561	break;
	562	case 0x24: /* SDRAM_STATUS */
	563	/* Read-only register */
	564	break;
	565	case 0x30: /* SDRAM_RTR */
	566	sdram->rtr = val & 0x3FF80000;
	567	break;
	568	case 0x34: /* SDRAM_PMIT */
	569	sdram->pmit = (val & 0xF8000000) \| 0x07C00000;
	570	break;
	571	case 0x40: /* SDRAM_B0CR */
	572	sdram_set_bcr(&sdram->bcr[0], val, sdram->cfg & 0x80000000);
	573	break;
	574	case 0x44: /* SDRAM_B1CR */
	575	sdram_set_bcr(&sdram->bcr[1], val, sdram->cfg & 0x80000000);
	576	break;
	577	case 0x48: /* SDRAM_B2CR */
	578	sdram_set_bcr(&sdram->bcr[2], val, sdram->cfg & 0x80000000);
	579	break;
	580	case 0x4C: /* SDRAM_B3CR */
	581	sdram_set_bcr(&sdram->bcr[3], val, sdram->cfg & 0x80000000);
	582	break;
	583	case 0x80: /* SDRAM_TR */
	584	sdram->tr = val & 0x018FC01F;
	585	break;
586	case 0x94: /* SDRAM_ECCCFG */
587	sdram->ecccfg = val & 0x00F00000;
588	break;
589	case 0x98: /* SDRAM_ECCESR */
590	val &= 0xFFF0F000;
591	if (sdram->eccesr == 0 && val != 0)
592	qemu_irq_raise(sdram->irq);
593	else if (sdram->eccesr != 0 && val == 0)
594	qemu_irq_lower(sdram->irq);
595	sdram->eccesr = val;
596	break;
597	default: /* Error */
598	break;
599	}
600	break;
601	}
602	}
603
604	static void sdram_reset (void *opaque)
605	{
c227f099	606	ppc4xx_sdram_t *sdram;
61b24405 AJ	607
	608	sdram = opaque;
	609	sdram->addr = 0x00000000;
	610	sdram->bear = 0x00000000;
	611	sdram->besr0 = 0x00000000; /* No error */
	612	sdram->besr1 = 0x00000000; /* No error */
	613	sdram->cfg = 0x00000000;
	614	sdram->ecccfg = 0x00000000; /* No ECC */
	615	sdram->eccesr = 0x00000000; /* No error */
	616	sdram->pmit = 0x07C00000;
	617	sdram->rtr = 0x05F00000;
	618	sdram->tr = 0x00854009;
	619	/* We pre-initialize RAM banks */
	620	sdram->status = 0x00000000;
	621	sdram->cfg = 0x00800000;
	622	sdram_unmap_bcr(sdram);
	623	}
	624
80e8bd2b	625	void ppc4xx_sdram_init (CPUState *env, qemu_irq irq, int nbanks,
c227f099 AL	626	target_phys_addr_t *ram_bases,
c227f099 AL	627	target_phys_addr_t *ram_sizes,
61b24405 AJ	628	int do_init)
61b24405 AJ	629	{
c227f099	630	ppc4xx_sdram_t *sdram;
61b24405	631
c227f099	632	sdram = qemu_mallocz(sizeof(ppc4xx_sdram_t));
487414f1 AL	633	sdram->irq = irq;
487414f1 AL	634	sdram->nbanks = nbanks;
c227f099	635	memset(sdram->ram_bases, 0, 4 * sizeof(target_phys_addr_t));
487414f1	636	memcpy(sdram->ram_bases, ram_bases,
c227f099 AL	637	nbanks * sizeof(target_phys_addr_t));
c227f099 AL	638	memset(sdram->ram_sizes, 0, 4 * sizeof(target_phys_addr_t));
487414f1	639	memcpy(sdram->ram_sizes, ram_sizes,
c227f099	640	nbanks * sizeof(target_phys_addr_t));
a08d4367	641	qemu_register_reset(&sdram_reset, sdram);
487414f1 AL	642	ppc_dcr_register(env, SDRAM0_CFGADDR,
	643	sdram, &dcr_read_sdram, &dcr_write_sdram);
	644	ppc_dcr_register(env, SDRAM0_CFGDATA,
	645	sdram, &dcr_read_sdram, &dcr_write_sdram);
	646	if (do_init)
	647	sdram_map_bcr(sdram);
61b24405	648	}
b7da58fd AJ	649
	650	/* Fill in consecutive SDRAM banks with 'ram_size' bytes of memory.
	651	*
	652	* sdram_bank_sizes[] must be 0-terminated.
	653	*
	654	* The 4xx SDRAM controller supports a small number of banks, and each bank
	655	* must be one of a small set of sizes. The number of banks and the supported
	656	* sizes varies by SoC. */
c227f099 AL	657	ram_addr_t ppc4xx_sdram_adjust(ram_addr_t ram_size, int nr_banks,
	658	target_phys_addr_t ram_bases[],
	659	target_phys_addr_t ram_sizes[],
b7da58fd AJ	660	const unsigned int sdram_bank_sizes[])
b7da58fd AJ	661	{
c227f099	662	ram_addr_t size_left = ram_size;
b7da58fd AJ	663	int i;
	664	int j;
	665
	666	for (i = 0; i < nr_banks; i++) {
	667	for (j = 0; sdram_bank_sizes[j] != 0; j++) {
	668	unsigned int bank_size = sdram_bank_sizes[j];
	669
5c130f65 PB	670	if (bank_size <= size_left) {
5c130f65 PB	671	ram_bases[i] = qemu_ram_alloc(bank_size);
b7da58fd	672	ram_sizes[i] = bank_size;
5c130f65	673	size_left -= bank_size;
b7da58fd AJ	674	break;
	675	}
	676	}
	677
5c130f65	678	if (!size_left) {
b7da58fd AJ	679	/* No need to use the remaining banks. */
	680	break;
	681	}
	682	}
	683
5c130f65	684	ram_size -= size_left;
b7da58fd AJ	685	if (ram_size)
b7da58fd AJ	686	printf("Truncating memory to %d MiB to fit SDRAM controller limits.\n",
5c130f65	687	(int)(ram_size >> 20));
b7da58fd	688
5c130f65	689	return ram_size;
b7da58fd	690	}