[qemu.git] / hw / omap_i2c.c

/*
 * TI OMAP on-chip I2C controller.  Only "new I2C" mode supported.
 *
 * Copyright (C) 2007 Andrzej Zaborowski  <[email protected]>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 */
#include "hw.h"
#include "i2c.h"
#include "omap.h"

struct omap_i2c_s {
    qemu_irq irq;
    qemu_irq drq[2];
    i2c_slave slave;
    i2c_bus *bus;

    uint8_t revision;
    uint8_t mask;
    uint16_t stat;
    uint16_t dma;
    uint16_t count;
    int count_cur;
    uint32_t fifo;
    int rxlen;
    int txlen;
    uint16_t control;
    uint16_t addr[2];
    uint8_t divider;
    uint8_t times[2];
    uint16_t test;
};

#define OMAP2_INTR_REV	0x34
#define OMAP2_GC_REV	0x34

static void omap_i2c_interrupts_update(struct omap_i2c_s *s)
{
    qemu_set_irq(s->irq, s->stat & s->mask);
    if ((s->dma >> 15) & 1)					/* RDMA_EN */
        qemu_set_irq(s->drq[0], (s->stat >> 3) & 1);		/* RRDY */
    if ((s->dma >> 7) & 1)					/* XDMA_EN */
        qemu_set_irq(s->drq[1], (s->stat >> 4) & 1);		/* XRDY */
}

/* These are only stubs now.  */
static void omap_i2c_event(i2c_slave *i2c, enum i2c_event event)
{
    struct omap_i2c_s *s = (struct omap_i2c_s *) i2c;

    if ((~s->control >> 15) & 1)				/* I2C_EN */
        return;

    switch (event) {
    case I2C_START_SEND:
    case I2C_START_RECV:
        s->stat |= 1 << 9;					/* AAS */
        break;
    case I2C_FINISH:
        s->stat |= 1 << 2;					/* ARDY */
        break;
    case I2C_NACK:
        s->stat |= 1 << 1;					/* NACK */
        break;
    }

    omap_i2c_interrupts_update(s);
}

static int omap_i2c_rx(i2c_slave *i2c)
{
    struct omap_i2c_s *s = (struct omap_i2c_s *) i2c;
    uint8_t ret = 0;

    if ((~s->control >> 15) & 1)				/* I2C_EN */
        return -1;

    if (s->txlen)
        ret = s->fifo >> ((-- s->txlen) << 3) & 0xff;
    else
        s->stat |= 1 << 10;					/* XUDF */
    s->stat |= 1 << 4;						/* XRDY */

    omap_i2c_interrupts_update(s);
    return ret;
}

static int omap_i2c_tx(i2c_slave *i2c, uint8_t data)
{
    struct omap_i2c_s *s = (struct omap_i2c_s *) i2c;

    if ((~s->control >> 15) & 1)				/* I2C_EN */
        return 1;

    if (s->rxlen < 4)
        s->fifo |= data << ((s->rxlen ++) << 3);
    else
        s->stat |= 1 << 11;					/* ROVR */
    s->stat |= 1 << 3;						/* RRDY */

    omap_i2c_interrupts_update(s);
    return 1;
}

static void omap_i2c_fifo_run(struct omap_i2c_s *s)
{
    int ack = 1;

    if (!i2c_bus_busy(s->bus))
        return;

    if ((s->control >> 2) & 1) {				/* RM */
        if ((s->control >> 1) & 1) {				/* STP */
            i2c_end_transfer(s->bus);
            s->control &= ~(1 << 1);				/* STP */
            s->count_cur = s->count;
            s->txlen = 0;
        } else if ((s->control >> 9) & 1) {			/* TRX */
            while (ack && s->txlen)
                ack = (i2c_send(s->bus,
                                        (s->fifo >> ((-- s->txlen) << 3)) &
                                        0xff) >= 0);
            s->stat |= 1 << 4;					/* XRDY */
        } else {
            while (s->rxlen < 4)
                s->fifo |= i2c_recv(s->bus) << ((s->rxlen ++) << 3);
            s->stat |= 1 << 3;					/* RRDY */
        }
    } else {
        if ((s->control >> 9) & 1) {				/* TRX */
            while (ack && s->count_cur && s->txlen) {
                ack = (i2c_send(s->bus,
                                        (s->fifo >> ((-- s->txlen) << 3)) &
                                        0xff) >= 0);
                s->count_cur --;
            }
            if (ack && s->count_cur)
                s->stat |= 1 << 4;				/* XRDY */
            else
                s->stat &= ~(1 << 4);				/* XRDY */
            if (!s->count_cur) {
                s->stat |= 1 << 2;				/* ARDY */
                s->control &= ~(1 << 10);			/* MST */
            }
        } else {
            while (s->count_cur && s->rxlen < 4) {
                s->fifo |= i2c_recv(s->bus) << ((s->rxlen ++) << 3);
                s->count_cur --;
            }
            if (s->rxlen)
                s->stat |= 1 << 3;				/* RRDY */
            else
                s->stat &= ~(1 << 3);				/* RRDY */
        }
        if (!s->count_cur) {
            if ((s->control >> 1) & 1) {			/* STP */
                i2c_end_transfer(s->bus);
                s->control &= ~(1 << 1);			/* STP */
                s->count_cur = s->count;
                s->txlen = 0;
            } else {
                s->stat |= 1 << 2;				/* ARDY */
                s->control &= ~(1 << 10);			/* MST */
            }
        }
    }

    s->stat |= (!ack) << 1;					/* NACK */
    if (!ack)
        s->control &= ~(1 << 1);				/* STP */
}

void omap_i2c_reset(struct omap_i2c_s *s)
{
    s->mask = 0;
    s->stat = 0;
    s->dma = 0;
    s->count = 0;
    s->count_cur = 0;
    s->fifo = 0;
    s->rxlen = 0;
    s->txlen = 0;
    s->control = 0;
    s->addr[0] = 0;
    s->addr[1] = 0;
    s->divider = 0;
    s->times[0] = 0;
    s->times[1] = 0;
    s->test = 0;
}

static uint32_t omap_i2c_read(void *opaque, target_phys_addr_t addr)
{
    struct omap_i2c_s *s = (struct omap_i2c_s *) opaque;
    int offset = addr & OMAP_MPUI_REG_MASK;
    uint16_t ret;

    switch (offset) {
    case 0x00:	/* I2C_REV */
        return s->revision;					/* REV */

    case 0x04:	/* I2C_IE */
        return s->mask;

    case 0x08:	/* I2C_STAT */
        return s->stat | (i2c_bus_busy(s->bus) << 12);

    case 0x0c:	/* I2C_IV */
        if (s->revision >= OMAP2_INTR_REV)
            break;
        ret = ffs(s->stat & s->mask);
        if (ret)
            s->stat ^= 1 << (ret - 1);
        omap_i2c_interrupts_update(s);
        return ret;

    case 0x10:	/* I2C_SYSS */
        return (s->control >> 15) & 1;				/* I2C_EN */

    case 0x14:	/* I2C_BUF */
        return s->dma;

    case 0x18:	/* I2C_CNT */
        return s->count_cur;					/* DCOUNT */

    case 0x1c:	/* I2C_DATA */
        ret = 0;
        if (s->control & (1 << 14)) {				/* BE */
            ret |= ((s->fifo >> 0) & 0xff) << 8;
            ret |= ((s->fifo >> 8) & 0xff) << 0;
        } else {
            ret |= ((s->fifo >> 8) & 0xff) << 8;
            ret |= ((s->fifo >> 0) & 0xff) << 0;
        }
        if (s->rxlen == 1) {
            s->stat |= 1 << 15;					/* SBD */
            s->rxlen = 0;
        } else if (s->rxlen > 1) {
            if (s->rxlen > 2)
                s->fifo >>= 16;
            s->rxlen -= 2;
        } else
            /* XXX: remote access (qualifier) error - what's that?  */;
        if (!s->rxlen) {
            s->stat &= ~(1 << 3);				/* RRDY */
            if (((s->control >> 10) & 1) &&			/* MST */
                            ((~s->control >> 9) & 1)) {		/* TRX */
                s->stat |= 1 << 2;				/* ARDY */
                s->control &= ~(1 << 10);			/* MST */
            }
        }
        s->stat &= ~(1 << 11);					/* ROVR */
        omap_i2c_fifo_run(s);
        omap_i2c_interrupts_update(s);
        return ret;

    case 0x20:	/* I2C_SYSC */
        return 0;

    case 0x24:	/* I2C_CON */
        return s->control;

    case 0x28:	/* I2C_OA */
        return s->addr[0];

    case 0x2c:	/* I2C_SA */
        return s->addr[1];

    case 0x30:	/* I2C_PSC */
        return s->divider;

    case 0x34:	/* I2C_SCLL */
        return s->times[0];

    case 0x38:	/* I2C_SCLH */
        return s->times[1];

    case 0x3c:	/* I2C_SYSTEST */
        if (s->test & (1 << 15)) {				/* ST_EN */
            s->test ^= 0xa;
            return s->test;
        } else
            return s->test & ~0x300f;
    }

    OMAP_BAD_REG(addr);
    return 0;
}

static void omap_i2c_write(void *opaque, target_phys_addr_t addr,
                uint32_t value)
{
    struct omap_i2c_s *s = (struct omap_i2c_s *) opaque;
    int offset = addr & OMAP_MPUI_REG_MASK;
    int nack;

    switch (offset) {
    case 0x00:	/* I2C_REV */
    case 0x0c:	/* I2C_IV */
    case 0x10:	/* I2C_SYSS */
        OMAP_RO_REG(addr);
        return;

    case 0x04:	/* I2C_IE */
        s->mask = value & (s->revision < OMAP2_GC_REV ? 0x1f : 0x3f);
        break;

    case 0x08:	/* I2C_STAT */
        if (s->revision < OMAP2_INTR_REV) {
            OMAP_RO_REG(addr);
            return;
        }

        /* RRDY and XRDY are reset by hardware. (in all versions???) */
        s->stat &= ~(value & 0x27);
        omap_i2c_interrupts_update(s);
        break;

    case 0x14:	/* I2C_BUF */
        s->dma = value & 0x8080;
        if (value & (1 << 15))					/* RDMA_EN */
            s->mask &= ~(1 << 3);				/* RRDY_IE */
        if (value & (1 << 7))					/* XDMA_EN */
            s->mask &= ~(1 << 4);				/* XRDY_IE */
        break;

    case 0x18:	/* I2C_CNT */
        s->count = value;					/* DCOUNT */
        break;

    case 0x1c:	/* I2C_DATA */
        if (s->txlen > 2) {
            /* XXX: remote access (qualifier) error - what's that?  */
            break;
        }
        s->fifo <<= 16;
        s->txlen += 2;
        if (s->control & (1 << 14)) {				/* BE */
            s->fifo |= ((value >> 8) & 0xff) << 8;
            s->fifo |= ((value >> 0) & 0xff) << 0;
        } else {
            s->fifo |= ((value >> 0) & 0xff) << 8;
            s->fifo |= ((value >> 8) & 0xff) << 0;
        }
        s->stat &= ~(1 << 10);					/* XUDF */
        if (s->txlen > 2)
            s->stat &= ~(1 << 4);				/* XRDY */
        omap_i2c_fifo_run(s);
        omap_i2c_interrupts_update(s);
        break;

    case 0x20:	/* I2C_SYSC */
        if (s->revision < OMAP2_INTR_REV) {
            OMAP_BAD_REG(addr);
            return;
        }

        if (value & 2)
            omap_i2c_reset(s);
        break;

    case 0x24:	/* I2C_CON */
        s->control = value & 0xcf87;
        if (~value & (1 << 15)) {				/* I2C_EN */
            if (s->revision < OMAP2_INTR_REV)
                omap_i2c_reset(s);
            break;
        }
        if ((value & (1 << 15)) && !(value & (1 << 10))) {	/* MST */
            fprintf(stderr, "%s: I^2C slave mode not supported\n",
                            __FUNCTION__);
            break;
        }
        if ((value & (1 << 15)) && value & (1 << 8)) {		/* XA */
            fprintf(stderr, "%s: 10-bit addressing mode not supported\n",
                            __FUNCTION__);
            break;
        }
        if ((value & (1 << 15)) && value & (1 << 0)) {		/* STT */
            nack = !!i2c_start_transfer(s->bus, s->addr[1],	/* SA */
                            (~value >> 9) & 1);			/* TRX */
            s->stat |= nack << 1;				/* NACK */
            s->control &= ~(1 << 0);				/* STT */
            s->fifo = 0;
            if (nack)
                s->control &= ~(1 << 1);			/* STP */
            else {
                s->count_cur = s->count;
                omap_i2c_fifo_run(s);
            }
            omap_i2c_interrupts_update(s);
        }
        break;

    case 0x28:	/* I2C_OA */
        s->addr[0] = value & 0x3ff;
        i2c_set_slave_address(&s->slave, value & 0x7f);
        break;

    case 0x2c:	/* I2C_SA */
        s->addr[1] = value & 0x3ff;
        break;

    case 0x30:	/* I2C_PSC */
        s->divider = value;
        break;

    case 0x34:	/* I2C_SCLL */
        s->times[0] = value;
        break;

    case 0x38:	/* I2C_SCLH */
        s->times[1] = value;
        break;

    case 0x3c:	/* I2C_SYSTEST */
        s->test = value & 0xf80f;
        if (value & (1 << 11))					/* SBB */
            if (s->revision >= OMAP2_INTR_REV) {
                s->stat |= 0x3f;
                omap_i2c_interrupts_update(s);
            }
        if (value & (1 << 15))					/* ST_EN */
            fprintf(stderr, "%s: System Test not supported\n", __FUNCTION__);
        break;

    default:
        OMAP_BAD_REG(addr);
        return;
    }
}

static void omap_i2c_writeb(void *opaque, target_phys_addr_t addr,
                uint32_t value)
{
    struct omap_i2c_s *s = (struct omap_i2c_s *) opaque;
    int offset = addr & OMAP_MPUI_REG_MASK;

    switch (offset) {
    case 0x1c:	/* I2C_DATA */
        if (s->txlen > 2) {
            /* XXX: remote access (qualifier) error - what's that?  */
            break;
        }
        s->fifo <<= 8;
        s->txlen += 1;
        s->fifo |= value & 0xff;
        s->stat &= ~(1 << 10);					/* XUDF */
        if (s->txlen > 2)
            s->stat &= ~(1 << 4);				/* XRDY */
        omap_i2c_fifo_run(s);
        omap_i2c_interrupts_update(s);
        break;

    default:
        OMAP_BAD_REG(addr);
        return;
    }
}

static CPUReadMemoryFunc *omap_i2c_readfn[] = {
    omap_badwidth_read16,
    omap_i2c_read,
    omap_badwidth_read16,
};

static CPUWriteMemoryFunc *omap_i2c_writefn[] = {
    omap_i2c_writeb,	/* Only the last fifo write can be 8 bit.  */
    omap_i2c_write,
    omap_badwidth_write16,
};

struct omap_i2c_s *omap_i2c_init(target_phys_addr_t base,
                qemu_irq irq, qemu_irq *dma, omap_clk clk)
{
    int iomemtype;
    struct omap_i2c_s *s = (struct omap_i2c_s *)
            qemu_mallocz(sizeof(struct omap_i2c_s));

    /* TODO: set a value greater or equal to real hardware */
    s->revision = 0x11;
    s->irq = irq;
    s->drq[0] = dma[0];
    s->drq[1] = dma[1];
    s->slave.event = omap_i2c_event;
    s->slave.recv = omap_i2c_rx;
    s->slave.send = omap_i2c_tx;
    s->bus = i2c_init_bus();
    omap_i2c_reset(s);

    iomemtype = cpu_register_io_memory(0, omap_i2c_readfn,
                    omap_i2c_writefn, s);
    cpu_register_physical_memory(base, 0x800, iomemtype);

    return s;
}

struct omap_i2c_s *omap2_i2c_init(struct omap_target_agent_s *ta,
                qemu_irq irq, qemu_irq *dma, omap_clk fclk, omap_clk iclk)
{
    int iomemtype;
    struct omap_i2c_s *s = (struct omap_i2c_s *)
            qemu_mallocz(sizeof(struct omap_i2c_s));

    s->revision = 0x34;
    s->irq = irq;
    s->drq[0] = dma[0];
    s->drq[1] = dma[1];
    s->slave.event = omap_i2c_event;
    s->slave.recv = omap_i2c_rx;
    s->slave.send = omap_i2c_tx;
    s->bus = i2c_init_bus();
    omap_i2c_reset(s);

    iomemtype = l4_register_io_memory(0, omap_i2c_readfn,
                    omap_i2c_writefn, s);
    omap_l4_attach(ta, 0, iomemtype);

    return s;
}

i2c_bus *omap_i2c_bus(struct omap_i2c_s *s)
{
    return s->bus;
}
Commit	Line	Data
02645926 AZ	1	/*
	2	* TI OMAP on-chip I2C controller. Only "new I2C" mode supported.
	3	*
	4	* Copyright (C) 2007 Andrzej Zaborowski <[email protected]>
	5	*
	6	* This program is free software; you can redistribute it and/or
	7	* modify it under the terms of the GNU General Public License as
	8	* published by the Free Software Foundation; either version 2 of
	9	* the License, or (at your option) any later version.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*
fad6cb1a AJ	16	* You should have received a copy of the GNU General Public License along
	17	* with this program; if not, write to the Free Software Foundation, Inc.,
	18	* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
02645926	19	*/
87ecb68b PB	20	#include "hw.h"
	21	#include "i2c.h"
	22	#include "omap.h"
02645926 AZ	23
02645926 AZ	24	struct omap_i2c_s {
02645926 AZ	25	qemu_irq irq;
	26	qemu_irq drq[2];
	27	i2c_slave slave;
	28	i2c_bus *bus;
	29
29885477	30	uint8_t revision;
02645926 AZ	31	uint8_t mask;
	32	uint16_t stat;
	33	uint16_t dma;
	34	uint16_t count;
	35	int count_cur;
	36	uint32_t fifo;
	37	int rxlen;
	38	int txlen;
	39	uint16_t control;
	40	uint16_t addr[2];
	41	uint8_t divider;
	42	uint8_t times[2];
	43	uint16_t test;
	44	};
	45
29885477 AZ	46	#define OMAP2_INTR_REV 0x34
	47	#define OMAP2_GC_REV 0x34
	48
02645926 AZ	49	static void omap_i2c_interrupts_update(struct omap_i2c_s *s)
	50	{
	51	qemu_set_irq(s->irq, s->stat & s->mask);
	52	if ((s->dma >> 15) & 1) /* RDMA_EN */
	53	qemu_set_irq(s->drq[0], (s->stat >> 3) & 1); /* RRDY */
	54	if ((s->dma >> 7) & 1) /* XDMA_EN */
	55	qemu_set_irq(s->drq[1], (s->stat >> 4) & 1); /* XRDY */
	56	}
	57
	58	/* These are only stubs now. */
	59	static void omap_i2c_event(i2c_slave *i2c, enum i2c_event event)
	60	{
	61	struct omap_i2c_s s = (struct omap_i2c_s ) i2c;
	62
	63	if ((~s->control >> 15) & 1) /* I2C_EN */
	64	return;
	65
	66	switch (event) {
	67	case I2C_START_SEND:
	68	case I2C_START_RECV:
	69	s->stat \|= 1 << 9; /* AAS */
	70	break;
	71	case I2C_FINISH:
	72	s->stat \|= 1 << 2; /* ARDY */
	73	break;
	74	case I2C_NACK:
	75	s->stat \|= 1 << 1; /* NACK */
	76	break;
	77	}
	78
	79	omap_i2c_interrupts_update(s);
	80	}
	81
	82	static int omap_i2c_rx(i2c_slave *i2c)
	83	{
	84	struct omap_i2c_s s = (struct omap_i2c_s ) i2c;
	85	uint8_t ret = 0;
	86
	87	if ((~s->control >> 15) & 1) /* I2C_EN */
	88	return -1;
	89
	90	if (s->txlen)
	91	ret = s->fifo >> ((-- s->txlen) << 3) & 0xff;
	92	else
	93	s->stat \|= 1 << 10; /* XUDF */
	94	s->stat \|= 1 << 4; /* XRDY */
	95
	96	omap_i2c_interrupts_update(s);
	97	return ret;
	98	}
	99
	100	static int omap_i2c_tx(i2c_slave *i2c, uint8_t data)
	101	{
	102	struct omap_i2c_s s = (struct omap_i2c_s ) i2c;
	103
	104	if ((~s->control >> 15) & 1) /* I2C_EN */
	105	return 1;
	106
	107	if (s->rxlen < 4)
	108	s->fifo \|= data << ((s->rxlen ++) << 3);
	109	else
	110	s->stat \|= 1 << 11; /* ROVR */
	111	s->stat \|= 1 << 3; /* RRDY */
	112
113	omap_i2c_interrupts_update(s);
114	return 1;
115	}
116
117	static void omap_i2c_fifo_run(struct omap_i2c_s *s)
118	{
119	int ack = 1;
120
121	if (!i2c_bus_busy(s->bus))
122	return;
123
124	if ((s->control >> 2) & 1) { /* RM */
125	if ((s->control >> 1) & 1) { /* STP */
126	i2c_end_transfer(s->bus);
127	s->control &= ~(1 << 1); /* STP */
128	s->count_cur = s->count;
29885477	129	s->txlen = 0;
02645926 AZ	130	} else if ((s->control >> 9) & 1) { /* TRX */
	131	while (ack && s->txlen)
	132	ack = (i2c_send(s->bus,
	133	(s->fifo >> ((-- s->txlen) << 3)) &
	134	0xff) >= 0);
	135	s->stat \|= 1 << 4; /* XRDY */
	136	} else {
	137	while (s->rxlen < 4)
	138	s->fifo \|= i2c_recv(s->bus) << ((s->rxlen ++) << 3);
	139	s->stat \|= 1 << 3; /* RRDY */
	140	}
	141	} else {
	142	if ((s->control >> 9) & 1) { /* TRX */
	143	while (ack && s->count_cur && s->txlen) {
	144	ack = (i2c_send(s->bus,
	145	(s->fifo >> ((-- s->txlen) << 3)) &
	146	0xff) >= 0);
	147	s->count_cur --;
	148	}
	149	if (ack && s->count_cur)
	150	s->stat \|= 1 << 4; /* XRDY */
827df9f3 AZ	151	else
827df9f3 AZ	152	s->stat &= ~(1 << 4); /* XRDY */
02645926 AZ	153	if (!s->count_cur) {
	154	s->stat \|= 1 << 2; /* ARDY */
	155	s->control &= ~(1 << 10); /* MST */
	156	}
	157	} else {
	158	while (s->count_cur && s->rxlen < 4) {
	159	s->fifo \|= i2c_recv(s->bus) << ((s->rxlen ++) << 3);
	160	s->count_cur --;
	161	}
	162	if (s->rxlen)
	163	s->stat \|= 1 << 3; /* RRDY */
827df9f3 AZ	164	else
827df9f3 AZ	165	s->stat &= ~(1 << 3); /* RRDY */
02645926 AZ	166	}
	167	if (!s->count_cur) {
	168	if ((s->control >> 1) & 1) { /* STP */
	169	i2c_end_transfer(s->bus);
	170	s->control &= ~(1 << 1); /* STP */
	171	s->count_cur = s->count;
29885477	172	s->txlen = 0;
02645926 AZ	173	} else {
	174	s->stat \|= 1 << 2; /* ARDY */
	175	s->control &= ~(1 << 10); /* MST */
	176	}
	177	}
	178	}
	179
	180	s->stat \|= (!ack) << 1; /* NACK */
	181	if (!ack)
	182	s->control &= ~(1 << 1); /* STP */
	183	}
	184
	185	void omap_i2c_reset(struct omap_i2c_s *s)
	186	{
	187	s->mask = 0;
	188	s->stat = 0;
	189	s->dma = 0;
	190	s->count = 0;
	191	s->count_cur = 0;
	192	s->fifo = 0;
	193	s->rxlen = 0;
	194	s->txlen = 0;
	195	s->control = 0;
	196	s->addr[0] = 0;
	197	s->addr[1] = 0;
	198	s->divider = 0;
	199	s->times[0] = 0;
	200	s->times[1] = 0;
	201	s->test = 0;
	202	}
	203
	204	static uint32_t omap_i2c_read(void *opaque, target_phys_addr_t addr)
	205	{
	206	struct omap_i2c_s s = (struct omap_i2c_s ) opaque;
cf965d24	207	int offset = addr & OMAP_MPUI_REG_MASK;
02645926 AZ	208	uint16_t ret;
	209
	210	switch (offset) {
	211	case 0x00: /* I2C_REV */
29885477	212	return s->revision; /* REV */
02645926 AZ	213
	214	case 0x04: /* I2C_IE */
	215	return s->mask;
	216
	217	case 0x08: /* I2C_STAT */
	218	return s->stat \| (i2c_bus_busy(s->bus) << 12);
	219
	220	case 0x0c: /* I2C_IV */
29885477 AZ	221	if (s->revision >= OMAP2_INTR_REV)
29885477 AZ	222	break;
02645926 AZ	223	ret = ffs(s->stat & s->mask);
	224	if (ret)
	225	s->stat ^= 1 << (ret - 1);
	226	omap_i2c_interrupts_update(s);
	227	return ret;
	228
29885477 AZ	229	case 0x10: /* I2C_SYSS */
	230	return (s->control >> 15) & 1; /* I2C_EN */
	231
02645926 AZ	232	case 0x14: /* I2C_BUF */
	233	return s->dma;
	234
	235	case 0x18: /* I2C_CNT */
	236	return s->count_cur; /* DCOUNT */
	237
	238	case 0x1c: /* I2C_DATA */
	239	ret = 0;
	240	if (s->control & (1 << 14)) { /* BE */
	241	ret \|= ((s->fifo >> 0) & 0xff) << 8;
	242	ret \|= ((s->fifo >> 8) & 0xff) << 0;
	243	} else {
	244	ret \|= ((s->fifo >> 8) & 0xff) << 8;
	245	ret \|= ((s->fifo >> 0) & 0xff) << 0;
	246	}
	247	if (s->rxlen == 1) {
	248	s->stat \|= 1 << 15; /* SBD */
	249	s->rxlen = 0;
	250	} else if (s->rxlen > 1) {
	251	if (s->rxlen > 2)
	252	s->fifo >>= 16;
	253	s->rxlen -= 2;
	254	} else
	255	/* XXX: remote access (qualifier) error - what's that? */;
	256	if (!s->rxlen) {
29885477	257	s->stat &= ~(1 << 3); /* RRDY */
02645926 AZ	258	if (((s->control >> 10) & 1) && /* MST */
	259	((~s->control >> 9) & 1)) { /* TRX */
	260	s->stat \|= 1 << 2; /* ARDY */
	261	s->control &= ~(1 << 10); /* MST */
	262	}
	263	}
	264	s->stat &= ~(1 << 11); /* ROVR */
	265	omap_i2c_fifo_run(s);
	266	omap_i2c_interrupts_update(s);
	267	return ret;
	268
29885477 AZ	269	case 0x20: /* I2C_SYSC */
	270	return 0;
	271
02645926 AZ	272	case 0x24: /* I2C_CON */
	273	return s->control;
	274
	275	case 0x28: /* I2C_OA */
	276	return s->addr[0];
	277
	278	case 0x2c: /* I2C_SA */
	279	return s->addr[1];
	280
	281	case 0x30: /* I2C_PSC */
	282	return s->divider;
	283
	284	case 0x34: /* I2C_SCLL */
	285	return s->times[0];
	286
	287	case 0x38: /* I2C_SCLH */
	288	return s->times[1];
	289
	290	case 0x3c: /* I2C_SYSTEST */
	291	if (s->test & (1 << 15)) { /* ST_EN */
	292	s->test ^= 0xa;
	293	return s->test;
	294	} else
	295	return s->test & ~0x300f;
	296	}
	297
	298	OMAP_BAD_REG(addr);
	299	return 0;
	300	}
	301
	302	static void omap_i2c_write(void *opaque, target_phys_addr_t addr,
	303	uint32_t value)
	304	{
	305	struct omap_i2c_s s = (struct omap_i2c_s ) opaque;
cf965d24	306	int offset = addr & OMAP_MPUI_REG_MASK;
02645926 AZ	307	int nack;
	308
	309	switch (offset) {
	310	case 0x00: /* I2C_REV */
02645926	311	case 0x0c: /* I2C_IV */
29885477 AZ	312	case 0x10: /* I2C_SYSS */
29885477 AZ	313	OMAP_RO_REG(addr);
02645926 AZ	314	return;
	315
	316	case 0x04: /* I2C_IE */
29885477 AZ	317	s->mask = value & (s->revision < OMAP2_GC_REV ? 0x1f : 0x3f);
	318	break;
	319
	320	case 0x08: /* I2C_STAT */
	321	if (s->revision < OMAP2_INTR_REV) {
	322	OMAP_RO_REG(addr);
	323	return;
	324	}
	325
827df9f3 AZ	326	/* RRDY and XRDY are reset by hardware. (in all versions???) */
827df9f3 AZ	327	s->stat &= ~(value & 0x27);
29885477	328	omap_i2c_interrupts_update(s);
02645926 AZ	329	break;
	330
	331	case 0x14: /* I2C_BUF */
	332	s->dma = value & 0x8080;
	333	if (value & (1 << 15)) /* RDMA_EN */
	334	s->mask &= ~(1 << 3); /* RRDY_IE */
	335	if (value & (1 << 7)) /* XDMA_EN */
	336	s->mask &= ~(1 << 4); /* XRDY_IE */
	337	break;
	338
	339	case 0x18: /* I2C_CNT */
	340	s->count = value; /* DCOUNT */
	341	break;
	342
	343	case 0x1c: /* I2C_DATA */
	344	if (s->txlen > 2) {
	345	/* XXX: remote access (qualifier) error - what's that? */
	346	break;
	347	}
	348	s->fifo <<= 16;
	349	s->txlen += 2;
	350	if (s->control & (1 << 14)) { /* BE */
	351	s->fifo \|= ((value >> 8) & 0xff) << 8;
	352	s->fifo \|= ((value >> 0) & 0xff) << 0;
	353	} else {
	354	s->fifo \|= ((value >> 0) & 0xff) << 8;
	355	s->fifo \|= ((value >> 8) & 0xff) << 0;
	356	}
	357	s->stat &= ~(1 << 10); /* XUDF */
	358	if (s->txlen > 2)
	359	s->stat &= ~(1 << 4); /* XRDY */
	360	omap_i2c_fifo_run(s);
	361	omap_i2c_interrupts_update(s);
	362	break;
	363
29885477 AZ	364	case 0x20: /* I2C_SYSC */
	365	if (s->revision < OMAP2_INTR_REV) {
	366	OMAP_BAD_REG(addr);
	367	return;
	368	}
	369
	370	if (value & 2)
	371	omap_i2c_reset(s);
	372	break;
	373
02645926	374	case 0x24: /* I2C_CON */
29885477	375	s->control = value & 0xcf87;
02645926	376	if (~value & (1 << 15)) { /* I2C_EN */
29885477 AZ	377	if (s->revision < OMAP2_INTR_REV)
29885477 AZ	378	omap_i2c_reset(s);
02645926 AZ	379	break;
02645926 AZ	380	}
29885477	381	if ((value & (1 << 15)) && !(value & (1 << 10))) { /* MST */
827df9f3 AZ	382	fprintf(stderr, "%s: I^2C slave mode not supported\n",
827df9f3 AZ	383	__FUNCTION__);
02645926 AZ	384	break;
02645926 AZ	385	}
29885477	386	if ((value & (1 << 15)) && value & (1 << 8)) { /* XA */
827df9f3 AZ	387	fprintf(stderr, "%s: 10-bit addressing mode not supported\n",
827df9f3 AZ	388	__FUNCTION__);
02645926 AZ	389	break;
02645926 AZ	390	}
29885477	391	if ((value & (1 << 15)) && value & (1 << 0)) { /* STT */
02645926 AZ	392	nack = !!i2c_start_transfer(s->bus, s->addr[1], /* SA */
	393	(~value >> 9) & 1); /* TRX */
	394	s->stat \|= nack << 1; /* NACK */
	395	s->control &= ~(1 << 0); /* STT */
51fec3cc	396	s->fifo = 0;
02645926 AZ	397	if (nack)
02645926 AZ	398	s->control &= ~(1 << 1); /* STP */
29885477 AZ	399	else {
29885477 AZ	400	s->count_cur = s->count;
02645926	401	omap_i2c_fifo_run(s);
29885477	402	}
02645926 AZ	403	omap_i2c_interrupts_update(s);
	404	}
	405	break;
	406
	407	case 0x28: /* I2C_OA */
	408	s->addr[0] = value & 0x3ff;
	409	i2c_set_slave_address(&s->slave, value & 0x7f);
	410	break;
	411
	412	case 0x2c: /* I2C_SA */
	413	s->addr[1] = value & 0x3ff;
	414	break;
	415
	416	case 0x30: /* I2C_PSC */
	417	s->divider = value;
	418	break;
	419
	420	case 0x34: /* I2C_SCLL */
	421	s->times[0] = value;
	422	break;
	423
	424	case 0x38: /* I2C_SCLH */
	425	s->times[1] = value;
	426	break;
	427
	428	case 0x3c: /* I2C_SYSTEST */
29885477 AZ	429	s->test = value & 0xf80f;
	430	if (value & (1 << 11)) /* SBB */
	431	if (s->revision >= OMAP2_INTR_REV) {
	432	s->stat \|= 0x3f;
	433	omap_i2c_interrupts_update(s);
	434	}
02645926	435	if (value & (1 << 15)) /* ST_EN */
827df9f3	436	fprintf(stderr, "%s: System Test not supported\n", __FUNCTION__);
02645926 AZ	437	break;
	438
	439	default:
	440	OMAP_BAD_REG(addr);
	441	return;
	442	}
	443	}
	444
29885477 AZ	445	static void omap_i2c_writeb(void *opaque, target_phys_addr_t addr,
	446	uint32_t value)
	447	{
	448	struct omap_i2c_s s = (struct omap_i2c_s ) opaque;
	449	int offset = addr & OMAP_MPUI_REG_MASK;
	450
	451	switch (offset) {
	452	case 0x1c: /* I2C_DATA */
	453	if (s->txlen > 2) {
	454	/* XXX: remote access (qualifier) error - what's that? */
	455	break;
	456	}
	457	s->fifo <<= 8;
	458	s->txlen += 1;
	459	s->fifo \|= value & 0xff;
	460	s->stat &= ~(1 << 10); /* XUDF */
	461	if (s->txlen > 2)
	462	s->stat &= ~(1 << 4); /* XRDY */
	463	omap_i2c_fifo_run(s);
	464	omap_i2c_interrupts_update(s);
	465	break;
	466
	467	default:
	468	OMAP_BAD_REG(addr);
	469	return;
	470	}
	471	}
	472
02645926 AZ	473	static CPUReadMemoryFunc *omap_i2c_readfn[] = {
	474	omap_badwidth_read16,
	475	omap_i2c_read,
	476	omap_badwidth_read16,
	477	};
	478
	479	static CPUWriteMemoryFunc *omap_i2c_writefn[] = {
29885477	480	omap_i2c_writeb, /* Only the last fifo write can be 8 bit. */
02645926	481	omap_i2c_write,
29885477	482	omap_badwidth_write16,
02645926 AZ	483	};
	484
	485	struct omap_i2c_s *omap_i2c_init(target_phys_addr_t base,
	486	qemu_irq irq, qemu_irq *dma, omap_clk clk)
	487	{
	488	int iomemtype;
	489	struct omap_i2c_s s = (struct omap_i2c_s )
	490	qemu_mallocz(sizeof(struct omap_i2c_s));
	491
29885477 AZ	492	/* TODO: set a value greater or equal to real hardware */
29885477 AZ	493	s->revision = 0x11;
02645926 AZ	494	s->irq = irq;
	495	s->drq[0] = dma[0];
	496	s->drq[1] = dma[1];
	497	s->slave.event = omap_i2c_event;
	498	s->slave.recv = omap_i2c_rx;
	499	s->slave.send = omap_i2c_tx;
	500	s->bus = i2c_init_bus();
	501	omap_i2c_reset(s);
	502
	503	iomemtype = cpu_register_io_memory(0, omap_i2c_readfn,
	504	omap_i2c_writefn, s);
8da3ff18	505	cpu_register_physical_memory(base, 0x800, iomemtype);
02645926 AZ	506
	507	return s;
	508	}
	509
29885477 AZ	510	struct omap_i2c_s omap2_i2c_init(struct omap_target_agent_s ta,
	511	qemu_irq irq, qemu_irq *dma, omap_clk fclk, omap_clk iclk)
	512	{
	513	int iomemtype;
	514	struct omap_i2c_s s = (struct omap_i2c_s )
	515	qemu_mallocz(sizeof(struct omap_i2c_s));
	516
	517	s->revision = 0x34;
	518	s->irq = irq;
	519	s->drq[0] = dma[0];
	520	s->drq[1] = dma[1];
	521	s->slave.event = omap_i2c_event;
	522	s->slave.recv = omap_i2c_rx;
	523	s->slave.send = omap_i2c_tx;
	524	s->bus = i2c_init_bus();
	525	omap_i2c_reset(s);
	526
c66fb5bc	527	iomemtype = l4_register_io_memory(0, omap_i2c_readfn,
29885477	528	omap_i2c_writefn, s);
8da3ff18	529	omap_l4_attach(ta, 0, iomemtype);
29885477 AZ	530
	531	return s;
	532	}
	533
02645926 AZ	534	i2c_bus omap_i2c_bus(struct omap_i2c_s s)
	535	{
	536	return s->bus;
	537	}