Skip site navigation (1)Skip section navigation (2)
Date:      Sat, 18 Feb 2012 00:54:30 +0000 (UTC)
From:      Oleksandr Tymoshenko <gonzo@FreeBSD.org>
To:        src-committers@freebsd.org, svn-src-projects@freebsd.org
Subject:   svn commit: r231890 - in projects/armv6/sys/arm: conf ti ti/omap4
Message-ID:  <201202180054.q1I0sUQE003974@svn.freebsd.org>

next in thread | raw e-mail | index | archive | help
Author: gonzo
Date: Sat Feb 18 00:54:30 2012
New Revision: 231890
URL: http://svn.freebsd.org/changeset/base/231890

Log:
  Add I2C controller driver slightly modified by me. Changes include:
  
  - Dropping support for OMAP3. It looks like revision detectin logic is
      incomplete/wrong and I do not have omap3 device for tests so I just
      dropped it to avoid imprssion thap omap3 code works. Possible fix
      points are marked with XXXOMAP3 markers
  - FDT support
  - Minor clean-up

Added:
  projects/armv6/sys/arm/ti/omap_i2c.c
  projects/armv6/sys/arm/ti/omap_i2c.h
Modified:
  projects/armv6/sys/arm/conf/PANDABOARD
  projects/armv6/sys/arm/ti/omap4/files.omap4

Modified: projects/armv6/sys/arm/conf/PANDABOARD
==============================================================================
--- projects/armv6/sys/arm/conf/PANDABOARD	Sat Feb 18 00:49:09 2012	(r231889)
+++ projects/armv6/sys/arm/conf/PANDABOARD	Sat Feb 18 00:54:30 2012	(r231890)
@@ -75,9 +75,9 @@ device		mmc				# mmc/sd bus
 device		mmcsd			# mmc/sd flash cards
 
 # I2C support
-#device		iicbus
-#device		iic
-#device		omap3_i2c
+device		iicbus
+device		iic
+device		omap_i2c
 
 device		loop
 device		ether

Modified: projects/armv6/sys/arm/ti/omap4/files.omap4
==============================================================================
--- projects/armv6/sys/arm/ti/omap4/files.omap4	Sat Feb 18 00:49:09 2012	(r231889)
+++ projects/armv6/sys/arm/ti/omap4/files.omap4	Sat Feb 18 00:54:30 2012	(r231890)
@@ -21,6 +21,7 @@ arm/ti/ti_machdep.c				standard
 
 arm/ti/omap_gpio.c				optional	gpio
 arm/ti/usb/omap_ehci.c				optional	usb ehci
+arm/ti/omap_i2c.c				optional	omap_i2c
 
 arm/ti/omap4/omap4_prcm_clks.c			standard
 arm/ti/omap4/omap4_scm_padconf.c		standard

Added: projects/armv6/sys/arm/ti/omap_i2c.c
==============================================================================
--- /dev/null	00:00:00 1970	(empty, because file is newly added)
+++ projects/armv6/sys/arm/ti/omap_i2c.c	Sat Feb 18 00:54:30 2012	(r231890)
@@ -0,0 +1,1139 @@
+/*-
+ * Copyright (c) 2011
+ *	Ben Gray <ben.r.gray@gmail.com>.
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+/**
+ * Driver for the I2C module on the TI OMAP SoC.
+ *
+ * This driver is heavily based on the TWI driver for the AT91 (at91_twi.c).
+ *
+ * CAUTION: The I2Ci registers are limited to 16 bit and 8 bit data accesses,
+ * 32 bit data access is not allowed and can corrupt register content.
+ *
+ * This driver currently doesn't use DMA for the transfer, although I hope to
+ * incorporate that sometime in the future.  The idea being that for transaction
+ * larger than a certain size the DMA engine is used, for anything less the
+ * normal interrupt/fifo driven option is used.
+ *
+ *
+ * WARNING: This driver uses mtx_sleep and interrupts to perform transactions,
+ * which means you can't do a transaction during startup before the interrupts
+ * have been enabled.  Hint - the freebsd function config_intrhook_establish().
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/bus.h>
+#include <sys/conf.h>
+#include <sys/kernel.h>
+#include <sys/lock.h>
+#include <sys/mbuf.h>
+#include <sys/malloc.h>
+#include <sys/module.h>
+#include <sys/mutex.h>
+#include <sys/rman.h>
+#include <machine/bus.h>
+
+#include <dev/fdt/fdt_common.h>
+#include <dev/ofw/openfirm.h>
+#include <dev/ofw/ofw_bus.h>
+#include <dev/ofw/ofw_bus_subr.h>
+
+#include <arm/ti/omap_prcm.h>
+#include <arm/ti/omap_i2c.h>
+
+#include <dev/iicbus/iiconf.h>
+#include <dev/iicbus/iicbus.h>
+
+#include "iicbus_if.h"
+
+/**
+ *	I2C device driver context, a pointer to this is stored in the device
+ *	driver structure.
+ */
+struct omap_i2c_softc
+{
+	device_t		sc_dev;
+	struct resource*	sc_irq_res;
+	struct resource*	sc_mem_res;
+	device_t		sc_iicbus;
+
+	void*			sc_irq_h;
+
+	struct mtx		sc_mtx;
+
+	volatile uint16_t	sc_stat_flags;	/* contains the status flags last IRQ */
+
+	uint16_t		sc_i2c_addr;
+	uint16_t		sc_rev;
+};
+
+#define OMAP_I2C_REV1  0x003C      /* OMAP3 */
+#define OMAP_I2C_REV2  0x000A      /* OMAP4 */
+
+/**
+ *	Locking macros used throughout the driver
+ */
+#define OMAP_I2C_LOCK(_sc)             mtx_lock(&(_sc)->sc_mtx)
+#define	OMAP_I2C_UNLOCK(_sc)           mtx_unlock(&(_sc)->sc_mtx)
+#define OMAP_I2C_LOCK_INIT(_sc) \
+	mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->sc_dev), \
+	         "omap_i2c", MTX_DEF)
+#define OMAP_I2C_LOCK_DESTROY(_sc)      mtx_destroy(&_sc->sc_mtx);
+#define OMAP_I2C_ASSERT_LOCKED(_sc)     mtx_assert(&_sc->sc_mtx, MA_OWNED);
+#define OMAP_I2C_ASSERT_UNLOCKED(_sc)   mtx_assert(&_sc->sc_mtx, MA_NOTOWNED);
+
+#ifdef DEBUG
+#define omap_i2c_dbg(_sc, fmt, args...) \
+    device_printf((_sc)->sc_dev, fmt, ##args)
+#else
+#define omap_i2c_dbg(_sc, fmt, args...)
+#endif
+
+static devclass_t omap_i2c_devclass;
+
+/* bus entry points */
+
+static int omap_i2c_probe(device_t dev);
+static int omap_i2c_attach(device_t dev);
+static int omap_i2c_detach(device_t dev);
+static void omap_i2c_intr(void *);
+
+/* helper routines */
+static int omap_i2c_activate(device_t dev);
+static void omap_i2c_deactivate(device_t dev);
+
+/**
+ *	omap_i2c_read_2 - reads a 16-bit value from one of the I2C registers
+ *	@sc: I2C device context
+ *	@off: the byte offset within the register bank to read from.
+ *
+ *
+ *	LOCKING:
+ *	No locking required
+ *
+ *	RETURNS:
+ *	16-bit value read from the register.
+ */
+static inline uint16_t
+omap_i2c_read_2(struct omap_i2c_softc *sc, bus_size_t off)
+{
+	return bus_read_2(sc->sc_mem_res, off);
+}
+
+/**
+ *	omap_i2c_write_2 - writes a 16-bit value to one of the I2C registers
+ *	@sc: I2C device context
+ *	@off: the byte offset within the register bank to read from.
+ *	@val: the value to write into the register
+ *
+ *	LOCKING:
+ *	No locking required
+ *
+ *	RETURNS:
+ *	16-bit value read from the register.
+ */
+static inline void
+omap_i2c_write_2(struct omap_i2c_softc *sc, bus_size_t off, uint16_t val)
+{
+	bus_write_2(sc->sc_mem_res, off, val);
+}
+
+/**
+ *	omap_i2c_read_reg - reads a 16-bit value from one of the I2C registers
+ *	    take into account revision-dependent register offset
+ *	@sc: I2C device context
+ *	@off: the byte offset within the register bank to read from.
+ *
+ *
+ *	LOCKING:
+ *	No locking required
+ *
+ *	RETURNS:
+ *	16-bit value read from the register.
+ */
+static inline uint16_t
+omap_i2c_read_reg(struct omap_i2c_softc *sc, bus_size_t off)
+{
+	/* XXXOMAP3: FIXME add registers mapping here */
+	return bus_read_2(sc->sc_mem_res, off);
+}
+
+/**
+ *	omap_i2c_write_reg - writes a 16-bit value to one of the I2C registers
+ *	    take into account revision-dependent register offset
+ *	@sc: I2C device context
+ *	@off: the byte offset within the register bank to read from.
+ *	@val: the value to write into the register
+ *
+ *	LOCKING:
+ *	No locking required
+ *
+ *	RETURNS:
+ *	16-bit value read from the register.
+ */
+static inline void
+omap_i2c_write_reg(struct omap_i2c_softc *sc, bus_size_t off, uint16_t val)
+{
+	/* XXXOMAP3: FIXME add registers mapping here */
+	bus_write_2(sc->sc_mem_res, off, val);
+}
+
+/**
+ *	omap_i2c_set_intr_enable - writes the interrupt enable register
+ *	@sc: I2C device context
+ *	@ie: bitmask of the interrupts to enable
+ *
+ *	This function is needed as writing the I2C_IE register on the OMAP4 devices
+ *	doesn't seem to actually enable the interrupt, rather you have to write
+ *	through the I2C_IRQENABLE_CLR and I2C_IRQENABLE_SET registers.
+ *
+ *	LOCKING:
+ *	No locking required
+ *
+ *	RETURNS:
+ *	Nothing.
+ */
+static inline void
+omap_i2c_set_intr_enable(struct omap_i2c_softc *sc, uint16_t ie)
+{
+	/* XXXOMAP3: FIXME */
+	omap_i2c_write_2(sc, I2C_REG_IRQENABLE_CLR, 0xffff);
+	if (ie)
+		omap_i2c_write_2(sc, I2C_REG_IRQENABLE_SET, ie);
+}
+
+/**
+ *	omap_i2c_reset - attach function for the driver
+ *	@dev: i2c device handle
+ *
+ *
+ *
+ *	LOCKING:
+ *	Called from timer context
+ *
+ *	RETURNS:
+ *	EH_HANDLED or EH_NOT_HANDLED
+ */
+static int
+omap_i2c_reset(device_t dev, u_char speed, u_char addr, u_char *oldaddr)
+{
+	struct omap_i2c_softc *sc = device_get_softc(dev);
+	uint16_t psc_reg, scll_reg, sclh_reg, con_reg;
+
+	OMAP_I2C_LOCK(sc);
+
+	if (oldaddr)
+		*oldaddr = sc->sc_i2c_addr;
+	sc->sc_i2c_addr = addr;
+
+	/* The header file doesn't actual tell you what speeds should be used for
+	 * the 3 possible settings, so I'm going to go with the usual:
+	 *
+	 *    IIC_SLOW    => 100kbps
+	 *    IIC_FAST    => 400kbps
+	 *    IIC_FASTEST => 3.4Mbps
+	 *
+	 * I2Ci_INTERNAL_CLK = I2Ci_FCLK / (PSC + 1)
+	 * I2Ci_INTERNAL_CLK = 96MHZ / (PSC + 1)
+	 */
+	switch (speed) {
+		case IIC_FASTEST:
+			psc_reg = 0x0004;
+			scll_reg = 0x0811;
+			sclh_reg = 0x0a13;
+			break;
+
+		case IIC_FAST:
+			psc_reg = 0x0009;
+			scll_reg = 0x0005;
+			sclh_reg = 0x0007;
+			break;
+
+		case IIC_SLOW:
+		case IIC_UNKNOWN:
+		default:
+			psc_reg = 0x0017;
+			scll_reg = 0x000D;
+			sclh_reg = 0x000F;
+			break;
+	}
+
+	/* First disable the controller while changing the clocks */
+	con_reg = omap_i2c_read_reg(sc, I2C_REG_CON);
+	omap_i2c_write_reg(sc, I2C_REG_CON, 0x0000);
+
+	/* Program the prescaler */
+	omap_i2c_write_reg(sc, I2C_REG_PSC, psc_reg);
+
+	/* Set the bitrate */
+	omap_i2c_write_reg(sc, I2C_REG_SCLL, scll_reg);
+	omap_i2c_write_reg(sc, I2C_REG_SCLH, sclh_reg);
+
+	/* Set the remote slave address */
+	omap_i2c_write_reg(sc, I2C_REG_SA, addr);
+
+	/* Enable the I2C module again */
+	con_reg  = I2C_CON_I2C_EN;
+	con_reg |= (speed == IIC_FASTEST) ? I2C_CON_OPMODE_HS : I2C_CON_OPMODE_STD;
+	omap_i2c_write_reg(sc, I2C_REG_CON, con_reg);
+
+	OMAP_I2C_UNLOCK(sc);
+
+	return 0;
+}
+
+/**
+ *	omap_i2c_intr - interrupt handler for the I2C module
+ *	@dev: i2c device handle
+ *
+ *
+ *
+ *	LOCKING:
+ *	Called from timer context
+ *
+ *	RETURNS:
+ *	EH_HANDLED or EH_NOT_HANDLED
+ */
+static void
+omap_i2c_intr(void *arg)
+{
+	struct omap_i2c_softc *sc = (struct omap_i2c_softc*) arg;
+	uint16_t status;
+
+	status = omap_i2c_read_reg(sc, I2C_REG_STAT);
+	if (status == 0)
+		return;
+
+	OMAP_I2C_LOCK(sc);
+
+	/* save the flags */
+	sc->sc_stat_flags |= status;
+
+	/* clear the status flags */
+	omap_i2c_write_reg(sc, I2C_REG_STAT, status);
+
+	/* wakeup the process the started the transaction */
+	wakeup(sc);
+
+	OMAP_I2C_UNLOCK(sc);
+
+	return;
+}
+
+/**
+ *	omap_i2c_wait - waits for the specific event to occur
+ *	@sc: i2c driver context
+ *	@flags: the event(s) to wait on, this is a bitmask of the I2C_STAT_??? flags
+ *	@statp: if not null will contain the status flags upon return
+ *	@timo: the number of ticks to wait
+ *
+ *
+ *
+ *	LOCKING:
+ *	The driver context must be locked before calling this function. Internally
+ *	the function sleeps, releasing the lock as it does so, however the lock is
+ *	always retaken before this function returns.
+ *
+ *	RETURNS:
+ *	0 if the event(s) were tripped within timeout period
+ *	EBUSY if timedout waiting for the events
+ *	ENXIO if a NACK event was received
+ */
+static int
+omap_i2c_wait(struct omap_i2c_softc *sc, uint16_t flags, uint16_t *statp, int timo)
+{
+	int waittime = timo;
+	int start_ticks = ticks;
+	int rc;
+
+	OMAP_I2C_ASSERT_LOCKED(sc);
+
+	/* check if the condition has already occured, the interrupt routine will
+	 * clear the status flags.
+	 */
+	if ((sc->sc_stat_flags & flags) == 0) {
+
+		/* condition(s) haven't occured so sleep on the IRQ */
+		while (waittime > 0) {
+
+			rc = mtx_sleep(sc, &sc->sc_mtx, 0, "I2Cwait", waittime);
+			if (rc == EWOULDBLOCK) {
+				/* timed-out, simply break out of the loop */
+				break;
+			} else {
+				/* IRQ has been tripped, but need to sanity check we have the
+				 * right events in the status flag.
+				 */
+				if ((sc->sc_stat_flags & flags) != 0)
+					break;
+
+				/* event hasn't been tripped so wait some more */
+				waittime -= (ticks - start_ticks);
+				start_ticks = ticks;
+			}
+		}
+	}
+
+	/* copy the actual status bits */
+	if (statp != NULL)
+		*statp = sc->sc_stat_flags;
+
+	/* return the status found */
+	if ((sc->sc_stat_flags & flags) != 0)
+		rc = 0;
+	else
+		rc = EBUSY;
+
+	/* clear the flags set by the interrupt handler */
+	sc->sc_stat_flags = 0;
+
+	return (rc);
+}
+
+/**
+ *	omap_i2c_wait_for_free_bus - waits for the bus to become free
+ *	@sc: i2c driver context
+ *	@timo: the time to wait for the bus to become free
+ *
+ *
+ *
+ *	LOCKING:
+ *	The driver context must be locked before calling this function. Internally
+ *	the function sleeps, releasing the lock as it does so, however the lock is
+ *	always taken before this function returns.
+ *
+ *	RETURNS:
+ *	0 if the event(s) were tripped within timeout period
+ *	EBUSY if timedout waiting for the events
+ *	ENXIO if a NACK event was received
+ */
+static int
+omap_i2c_wait_for_free_bus(struct omap_i2c_softc *sc, int timo)
+{
+	/* check if the bus is free, BB bit = 0 */
+	if ((omap_i2c_read_reg(sc, I2C_REG_STAT) & I2C_STAT_BB) == 0)
+		return 0;
+
+	/* enable bus free interrupts */
+	omap_i2c_set_intr_enable(sc, I2C_IE_BF);
+
+	/* wait for the bus free interrupt to be tripped */
+	return omap_i2c_wait(sc, I2C_STAT_BF, NULL, timo);
+}
+
+/**
+ *	omap_i2c_read_bytes - attempts to perform a read operation
+ *	@sc: i2c driver context
+ *	@buf: buffer to hold the received bytes
+ *	@len: the number of bytes to read
+ *
+ *	This function assumes the slave address is already set
+ *
+ *	LOCKING:
+ *	The context lock should be held before calling this function
+ *
+ *	RETURNS:
+ *	0 on function succeeded
+ *	EINVAL if invalid message is passed as an arg
+ */
+static int
+omap_i2c_read_bytes(struct omap_i2c_softc *sc, uint8_t *buf, uint16_t len)
+{
+	int      timo = (hz / 4);
+	int      err = 0;
+	uint16_t con_reg;
+	uint16_t events;
+	uint16_t status;
+	uint32_t amount = 0;
+	uint32_t sofar = 0;
+	uint32_t i;
+
+	/* wait for the bus to become free */
+	err = omap_i2c_wait_for_free_bus(sc, timo);
+	if (err != 0) {
+		device_printf(sc->sc_dev, "bus never freed\n");
+		return (err);
+	}
+
+	/* set the events to wait for */
+	events = I2C_IE_RDR |   /* Receive draining interrupt */
+	         I2C_IE_RRDY |  /* Receive Data Ready interrupt */
+	         I2C_IE_ARDY |  /* Register Access Ready interrupt */
+	         I2C_IE_NACK |  /* No Acknowledgment interrupt */
+	         I2C_IE_AL;
+
+	/* enable interrupts for the events we want */
+	omap_i2c_set_intr_enable(sc, events);
+
+	/* write the number of bytes to read */
+	omap_i2c_write_reg(sc, I2C_REG_CNT, len);
+
+	/* clear the write bit and initiate the read transaction. Setting the STT
+	 * (start) bit initiates the transfer.
+	 */
+	con_reg = omap_i2c_read_reg(sc, I2C_REG_CON);
+	con_reg &= ~I2C_CON_TRX;
+	con_reg |=  I2C_CON_MST | I2C_CON_STT | I2C_CON_STP;
+	omap_i2c_write_reg(sc, I2C_REG_CON, con_reg);
+
+	/* reading loop */
+	while (1) {
+
+		/* wait for an event */
+		err = omap_i2c_wait(sc, events, &status, timo);
+		if (err != 0) {
+			break;
+		}
+
+		/* check for the error conditions */
+		if (status & I2C_STAT_NACK) {
+			/* no ACK from slave */
+			omap_i2c_dbg(sc, "NACK\n");
+			err = ENXIO;
+			break;
+		}
+		if (status & I2C_STAT_AL) {
+			/* arbitration lost */
+			omap_i2c_dbg(sc, "Arbitration lost\n");
+			err = ENXIO;
+			break;
+		}
+
+		/* check if we have finished */
+		if (status & I2C_STAT_ARDY) {
+			/* register access ready - transaction complete basically */
+			omap_i2c_dbg(sc, "ARDY transaction complete\n");
+			err = 0;
+			break;
+		}
+
+		/* read some data */
+		if (status & I2C_STAT_RDR) {
+			/* Receive draining interrupt - last data received */
+			omap_i2c_dbg(sc, "Receive draining interrupt\n");
+
+			/* get the number of bytes in the FIFO */
+			amount = omap_i2c_read_reg(sc, I2C_REG_BUFSTAT);
+			amount >>= 8;
+			amount &= 0x3f;
+		}
+		else if (status & I2C_STAT_RRDY) {
+			/* Receive data ready interrupt - enough data received */
+			omap_i2c_dbg(sc, "Receive data ready interrupt\n");
+
+			/* get the number of bytes in the FIFO */
+			amount = omap_i2c_read_reg(sc, I2C_REG_BUF);
+			amount >>= 8;
+			amount &= 0x3f;
+			amount += 1;
+		}
+
+		/* sanity check we haven't overwritten the array */
+		if ((sofar + amount) > len) {
+			omap_i2c_dbg(sc, "to many bytes to read\n");
+			amount = (len - sofar);
+		}
+
+		/* read the bytes from the fifo */
+		for (i = 0; i < amount; i++) {
+			buf[sofar++] = (uint8_t)(omap_i2c_read_reg(sc, I2C_REG_DATA) & 0xff);
+		}
+
+		/* attempt to clear the receive ready bits */
+		omap_i2c_write_reg(sc, I2C_REG_STAT, I2C_STAT_RDR | I2C_STAT_RRDY);
+	}
+
+	/* reset the registers regardless if there was an error or not */
+	omap_i2c_set_intr_enable(sc, 0x0000);
+	omap_i2c_write_reg(sc, I2C_REG_CON, I2C_CON_I2C_EN | I2C_CON_MST | I2C_CON_STP);
+
+	return (err);
+}
+
+/**
+ *	omap_i2c_write_bytes - attempts to perform a read operation
+ *	@sc: i2c driver context
+ *	@buf: buffer containing the bytes to write
+ *	@len: the number of bytes to write
+ *
+ *	This function assumes the slave address is already set
+ *
+ *	LOCKING:
+ *	The context lock should be held before calling this function
+ *
+ *	RETURNS:
+ *	0 on function succeeded
+ *	EINVAL if invalid message is passed as an arg
+ */
+static int
+omap_i2c_write_bytes(struct omap_i2c_softc *sc, const uint8_t *buf, uint16_t len)
+{
+	int      timo = (hz / 4);
+	int      err = 0;
+	uint16_t con_reg;
+	uint16_t events;
+	uint16_t status;
+	uint32_t amount = 0;
+	uint32_t sofar = 0;
+	uint32_t i;
+
+	/* wait for the bus to become free */
+	err = omap_i2c_wait_for_free_bus(sc, timo);
+	if (err != 0)
+		return (err);
+
+	/* set the events to wait for */
+	events = I2C_IE_XDR |   /* Transmit draining interrupt */
+	         I2C_IE_XRDY |  /* Transmit Data Ready interrupt */
+	         I2C_IE_ARDY |  /* Register Access Ready interrupt */
+	         I2C_IE_NACK |  /* No Acknowledgment interrupt */
+	         I2C_IE_AL;
+
+	/* enable interrupts for the events we want*/
+	omap_i2c_set_intr_enable(sc, events);
+
+	/* write the number of bytes to write */
+	omap_i2c_write_reg(sc, I2C_REG_CNT, len);
+
+	/* set the write bit and initiate the write transaction. Setting the STT
+	 * (start) bit initiates the transfer.
+	 */
+	con_reg = omap_i2c_read_reg(sc, I2C_REG_CON);
+	con_reg |= I2C_CON_TRX | I2C_CON_MST | I2C_CON_STT | I2C_CON_STP;
+	omap_i2c_write_reg(sc, I2C_REG_CON, con_reg);
+
+	/* writing loop */
+	while (1) {
+
+		/* wait for an event */
+		err = omap_i2c_wait(sc, events, &status, timo);
+		if (err != 0) {
+			break;
+		}
+
+		/* check for the error conditions */
+		if (status & I2C_STAT_NACK) {
+			/* no ACK from slave */
+			omap_i2c_dbg(sc, "NACK\n");
+			err = ENXIO;
+			break;
+		}
+		if (status & I2C_STAT_AL) {
+			/* arbitration lost */
+			omap_i2c_dbg(sc, "Arbitration lost\n");
+			err = ENXIO;
+			break;
+		}
+
+		/* check if we have finished */
+		if (status & I2C_STAT_ARDY) {
+			/* register access ready - transaction complete basically */
+			omap_i2c_dbg(sc, "ARDY transaction complete\n");
+			err = 0;
+			break;
+		}
+
+		/* read some data */
+		if (status & I2C_STAT_XDR) {
+			/* Receive draining interrupt - last data received */
+			omap_i2c_dbg(sc, "Transmit draining interrupt\n");
+
+			/* get the number of bytes in the FIFO */
+			amount = omap_i2c_read_reg(sc, I2C_REG_BUFSTAT);
+			amount &= 0x3f;
+		}
+		else if (status & I2C_STAT_XRDY) {
+			/* Receive data ready interrupt - enough data received */
+			omap_i2c_dbg(sc, "Transmit data ready interrupt\n");
+
+			/* get the number of bytes in the FIFO */
+			amount = omap_i2c_read_reg(sc, I2C_REG_BUF);
+			amount &= 0x3f;
+			amount += 1;
+		}
+
+		/* sanity check we haven't overwritten the array */
+		if ((sofar + amount) > len) {
+			omap_i2c_dbg(sc, "to many bytes to write\n");
+			amount = (len - sofar);
+		}
+
+		/* write the bytes from the fifo */
+		for (i = 0; i < amount; i++) {
+			omap_i2c_write_reg(sc, I2C_REG_DATA, buf[sofar++]);
+		}
+
+		/* attempt to clear the transmit ready bits */
+		omap_i2c_write_reg(sc, I2C_REG_STAT, I2C_STAT_XDR | I2C_STAT_XRDY);
+	}
+
+	/* reset the registers regardless if there was an error or not */
+	omap_i2c_set_intr_enable(sc, 0x0000);
+	omap_i2c_write_reg(sc, I2C_REG_CON, I2C_CON_I2C_EN | I2C_CON_MST | I2C_CON_STP);
+
+	return (err);
+}
+
+/**
+ *	omap_i2c_transfer - called to perform the transfer
+ *	@dev: i2c device handle
+ *	@msgs: the messages to send/receive
+ *	@nmsgs: the number of messages in the msgs array
+ *
+ *
+ *	LOCKING:
+ *	Internally locked
+ *
+ *	RETURNS:
+ *	0 on function succeeded
+ *	EINVAL if invalid message is passed as an arg
+ */
+static int
+omap_i2c_transfer(device_t dev, struct iic_msg *msgs, uint32_t nmsgs)
+{
+	struct omap_i2c_softc *sc = device_get_softc(dev);
+	int err = 0;
+	uint32_t i;
+	uint16_t len;
+	uint8_t *buf;
+
+	OMAP_I2C_LOCK(sc);
+
+	for (i = 0; i < nmsgs; i++) {
+
+		len = msgs[i].len;
+		buf = msgs[i].buf;
+
+		/* zero byte transfers aren't allowed */
+		if (len == 0 || buf == NULL) {
+			err = EINVAL;
+			goto out;
+		}
+
+		/* set the slave address */
+		omap_i2c_write_reg(sc, I2C_REG_SA, msgs[i].slave);
+
+		/* perform the read or write */
+		if (msgs[i].flags & IIC_M_RD) {
+			err = omap_i2c_read_bytes(sc, buf, len);
+		} else {
+			err = omap_i2c_write_bytes(sc, buf, len);
+		}
+
+	}
+
+out:
+	OMAP_I2C_UNLOCK(sc);
+
+	return (err);
+}
+
+/**
+ *	omap_i2c_callback - not sure about this one
+ *	@dev: i2c device handle
+ *
+ *
+ *
+ *	LOCKING:
+ *	Called from timer context
+ *
+ *	RETURNS:
+ *	EH_HANDLED or EH_NOT_HANDLED
+ */
+static int
+omap_i2c_callback(device_t dev, int index, caddr_t data)
+{
+	int error = 0;
+
+	switch (index) {
+		case IIC_REQUEST_BUS:
+			break;
+
+		case IIC_RELEASE_BUS:
+			break;
+
+		default:
+			error = EINVAL;
+	}
+
+	return (error);
+}
+
+/**
+ *	omap_i2c_activate - initialises and activates an I2C bus
+ *	@dev: i2c device handle
+ *	@num: the number of the I2C controller to activate; 1, 2 or 3
+ *
+ *
+ *	LOCKING:
+ *	Assumed called in an atomic context.
+ *
+ *	RETURNS:
+ *	nothing
+ */
+static int
+omap_i2c_activate(device_t dev)
+{
+	struct omap_i2c_softc *sc = (struct omap_i2c_softc*) device_get_softc(dev);
+	unsigned int timeout = 0;
+	uint16_t con_reg;
+	int err;
+	clk_ident_t clk;
+
+	/*
+	 * The following sequence is taken from the OMAP3530 technical reference
+	 *
+	 * 1. Enable the functional and interface clocks (see Section 18.3.1.1.1).
+	 */
+	clk = I2C1_CLK + device_get_unit(dev);
+	err = omap_prcm_clk_enable(clk);
+	if (err)
+		return (err);
+
+	/* There seems to be a bug in the I2C reset mechanism, for some reason you
+	 * need to disable the I2C module before issuing the reset and then enable
+	 * it again after to detect the reset done.
+	 *
+	 * I found this out by looking at the Linux driver implementation, thanks
+	 * linux guys!
+	 */
+
+	/* Disable the I2C controller */
+	omap_i2c_write_reg(sc, I2C_REG_CON, 0x0000);
+
+	/* Issue a softreset to the controller */
+	/* XXXOMAP3: FIXME */
+	bus_write_2(sc->sc_mem_res, I2C_REG_SYSC, 0x0002);
+
+	/* Re-enable the module and then check for the reset done */
+	omap_i2c_write_reg(sc, I2C_REG_CON, I2C_CON_I2C_EN);
+
+	while ((omap_i2c_read_reg(sc, I2C_REG_SYSS) & 0x01) == 0x00) {
+		if (timeout++ > 100) {
+			return (EBUSY);
+		}
+		DELAY(100);
+	}
+
+	/* Disable the I2C controller once again, now that the reset has finished */
+	omap_i2c_write_reg(sc, I2C_REG_CON, 0x0000);
+
+	/* 2. Program the prescaler to obtain an approximately 12-MHz internal
+	 *    sampling clock (I2Ci_INTERNAL_CLK) by programming the corresponding
+	 *    value in the I2Ci.I2C_PSC[3:0] PSC field.
+	 *    This value depends on the frequency of the functional clock (I2Ci_FCLK).
+	 *    Because this frequency is 96MHz, the I2Ci.I2C_PSC[7:0] PSC field value
+	 *    is 0x7.
+	 */
+
+	/* Program the prescaler to obtain an approximately 12-MHz internal
+	 * sampling clock.
+	 */
+	omap_i2c_write_reg(sc, I2C_REG_PSC, 0x0017);
+
+	/* 3. Program the I2Ci.I2C_SCLL[7:0] SCLL and I2Ci.I2C_SCLH[7:0] SCLH fields
+	 *    to obtain a bit rate of 100K bps or 400K bps. These values depend on
+	 *    the internal sampling clock frequency (see Table 18-12).
+	 */
+
+	/* Set the bitrate to 100kbps */
+	omap_i2c_write_reg(sc, I2C_REG_SCLL, 0x000d);
+	omap_i2c_write_reg(sc, I2C_REG_SCLH, 0x000f);
+
+	/* 4. (Optional) Program the I2Ci.I2C_SCLL[15:8] HSSCLL and
+	 *    I2Ci.I2C_SCLH[15:8] HSSCLH fields to obtain a bit rate of 400K bps or
+	 *    3.4M bps (for the second phase of HS mode). These values depend on the
+	 *    internal sampling clock frequency (see Table 18-12).
+	 *
+	 * 5. (Optional) If a bit rate of 3.4M bps is used and the bus line
+	 *    capacitance exceeds 45 pF, program the CONTROL.CONTROL_DEVCONF1[12]
+	 *    I2C1HSMASTER bit for I2C1, the CONTROL.CONTROL_DEVCONF1[13]
+	 *    I2C2HSMASTER bit for I2C2, or the CONTROL.CONTROL_DEVCONF1[14]
+	 *    I2C3HSMASTER bit for I2C3.
+	 */
+
+	/* 6. Configure the Own Address of the I2C controller by storing it in the
+	 *    I2Ci.I2C_OA0 register. Up to four Own Addresses can be programmed in
+	 *    the I2Ci.I2C_OAi registers (with I = 0, 1, 2, 3) for each I2C
+	 *    controller.
+	 *
+	 * Note: For a 10-bit address, set the corresponding expand Own Address bit
+	 * in the I2Ci.I2C_CON register.
+	 */
+
+	/* Driver currently always in single master mode so ignore this step */
+
+	/* 7. Set the TX threshold (in transmitter mode) and the RX threshold (in
+	 *    receiver mode) by setting the I2Ci.I2C_BUF[5:0]XTRSH field to (TX
+	 *    threshold - 1) and the I2Ci.I2C_BUF[13:8]RTRSH field to (RX threshold
+	 *    - 1), where the TX and RX thresholds are greater than or equal to 1.
+	 */
+
+	/* Set the FIFO buffer threshold, note I2C1 & I2C2 have 8 byte FIFO, whereas
+	 * I2C3 has 64 bytes.  Threshold set to 5 for now.
+	 */
+	omap_i2c_write_reg(sc, I2C_REG_BUF, 0x0404);
+
+	/*
+	 * 8. Take the I2C controller out of reset by setting the I2Ci.I2C_CON[15]
+	 *    I2C_EN bit to 1.
+	 */
+	omap_i2c_write_reg(sc, I2C_REG_CON, I2C_CON_I2C_EN | I2C_CON_OPMODE_STD);
+
+	/*
+	 * To initialize the I2C controller, perform the following steps:
+	 *
+	 * 1. Configure the I2Ci.I2C_CON register:
+	 *    · For master or slave mode, set the I2Ci.I2C_CON[10] MST bit (0: slave,
+	 *      1: master).
+	 *    · For transmitter or receiver mode, set the I2Ci.I2C_CON[9] TRX bit
+	 *      (0: receiver, 1: transmitter).
+	 */
+	con_reg = omap_i2c_read_reg(sc, I2C_REG_CON);
+	con_reg |= I2C_CON_MST;
+	omap_i2c_write_reg(sc, I2C_REG_CON, con_reg);
+
+	/* 2. If using an interrupt to transmit/receive data, set to 1 the
+	 *    corresponding bit in the I2Ci.I2C_IE register (the I2Ci.I2C_IE[4]
+	 *    XRDY_IE bit for the transmit interrupt, the I2Ci.I2C_IE[3] RRDY bit
+	 *    for the receive interrupt).
+	 */
+	omap_i2c_set_intr_enable(sc, I2C_IE_XRDY | I2C_IE_RRDY);
+
+	/* 3. If using DMA to receive/transmit data, set to 1 the corresponding bit
+	 *    in the I2Ci.I2C_BUF register (the I2Ci.I2C_BUF[15] RDMA_EN bit for the
+	 *    receive DMA channel, the I2Ci.I2C_BUF[7] XDMA_EN bit for the transmit
+	 *    DMA channel).
+	 */
+
+	/* not using DMA for now, so ignore this */
+
+	return (0);
+}
+
+/**
+ *	omap_i2c_deactivate - deactivates the controller and releases resources
+ *	@dev: i2c device handle
+ *
+ *
+ *
+ *	LOCKING:
+ *	Assumed called in an atomic context.
+ *
+ *	RETURNS:
+ *	nothing
+ */
+static void
+omap_i2c_deactivate(device_t dev)
+{
+	struct omap_i2c_softc *sc = device_get_softc(dev);
+	clk_ident_t clk;
+
+	/* Disable the controller - cancel all transactions */
+	omap_i2c_write_reg(sc, I2C_REG_CON, 0x0000);
+
+	/* Release the interrupt handler */
+	if (sc->sc_irq_h) {
+		bus_teardown_intr(dev, sc->sc_irq_res, sc->sc_irq_h);
+		sc->sc_irq_h = 0;
+	}
+
+	bus_generic_detach(sc->sc_dev);
+
+	/* Unmap the I2C controller registers */
+	if (sc->sc_mem_res != 0) {
+		bus_release_resource(dev, SYS_RES_MEMORY, rman_get_rid(sc->sc_irq_res),

*** DIFF OUTPUT TRUNCATED AT 1000 LINES ***



Want to link to this message? Use this URL: <https://mail-archive.FreeBSD.org/cgi/mid.cgi?201202180054.q1I0sUQE003974>