/*

 * Syborg platform device

 *

 * Copyright (c) 2008 CodeSourcery

 *

 * 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 "syborg.h"

#include "devtree.h"

//#define DEBUG_SYBORG_PLATFORM

#ifdef DEBUG_SYBORG_PLATFORM

#define DPRINTF(fmt, args...) \

do { printf("syborg_platform: " fmt , ##args); } while (0)

#define BADF(fmt, args...) \

do { fprintf(stderr, "syborg_platform: error: " fmt , ##args); exit(1);} while (0)

#else

#define DPRINTF(fmt, args...) do {} while(0)

#define BADF(fmt, args...) \

do { fprintf(stderr, "syborg_platform: error: " fmt , ##args);} while (0)

#endif

enum {

    PLATFORM_ID         = 0,

    PLATFORM_TREE_START = 1

};

#define PLATFORM_TREE_OFFSET  0x1000

typedef struct {

    QEMUDevice *qdev;

} syborg_platform_state;

static uint32_t syborg_platform_readl(void *opaque, target_phys_addr_t offset)

{

    offset &= 0xffffff;

    if (offset >= PLATFORM_TREE_OFFSET) {

        offset -= PLATFORM_TREE_OFFSET;

        if (offset >= machine_devtree_size)

            return 0;

        return ldl_p((char *)machine_devtree + offset);

    }

    DPRINTF("read 0x%x\n", (int)offset);

    switch(offset >> 2) {

    case PLATFORM_ID:

        return SYBORG_ID_PLATFORM;

    case PLATFORM_TREE_START:

        return PLATFORM_TREE_OFFSET;

    default:

        cpu_abort(cpu_single_env, "syborg_platform_read: Bad offset %x\n",

                  (int)offset);

        return 0;  

    }

}

static uint32_t syborg_platform_readw(void *opaque, target_phys_addr_t offset)

{

    offset &= 0xffffff;

    if (offset >= PLATFORM_TREE_OFFSET) {

        offset -= PLATFORM_TREE_OFFSET;

        if (offset >= machine_devtree_size)

            return 0;

        return lduw_p((char *)machine_devtree + offset);

    }

    cpu_abort(cpu_single_env, "syborg_platform_readw: Bad offset %x\n",

              (int)offset);

}

static uint32_t syborg_platform_readb(void *opaque, target_phys_addr_t offset)

{

    offset &= 0xffffff;

    if (offset >= PLATFORM_TREE_OFFSET) {

        offset -= PLATFORM_TREE_OFFSET;

        if (offset >= machine_devtree_size)

            return 0;

        return ldub_p((char *)machine_devtree + offset);

    }

    cpu_abort(cpu_single_env, "syborg_platform_readb: Bad offset %x\n",

              (int)offset);

}

static void syborg_platform_write(void *opaque, target_phys_addr_t offset,

                                  uint32_t value)

{

    offset &= 0xffffff;

    cpu_abort(cpu_single_env, "syborg_platform_write: Bad offset %x\n",

              (int)offset);

}

static CPUReadMemoryFunc *syborg_platform_readfn[] = {

     syborg_platform_readb,

     syborg_platform_readw,

     syborg_platform_readl

};

static CPUWriteMemoryFunc *syborg_platform_writefn[] = {

     syborg_platform_write,

     syborg_platform_write,

     syborg_platform_write

};

static void syborg_platform_create(QEMUDevice *dev)

{

    syborg_platform_state *s;

    s = (syborg_platform_state *)qemu_mallocz(sizeof(syborg_platform_state));

    s->qdev = dev;

    qdev_set_opaque(dev, s);

    /* Device has no state, so savevm not needed.  */

}

void syborg_platform_register(void)

{

    QEMUDeviceClass *dc;

    dc = qdev_new("syborg,platform", syborg_platform_create, 0);

    qdev_add_registers(dc, syborg_platform_readfn, syborg_platform_writefn,

                       0x1000000);

}