809 lines
		
	
	
		
			18 KiB
		
	
	
	
		
			Diff
		
	
	
	
	
	
			
		
		
	
	
			809 lines
		
	
	
		
			18 KiB
		
	
	
	
		
			Diff
		
	
	
	
	
	
From ce57fc22543d0ee0ca33157264815a52fc8cf9a3 Mon Sep 17 00:00:00 2001
 | 
						|
From: Kurt Mahan <kmahan@freescale.com>
 | 
						|
Date: Thu, 15 May 2008 13:23:27 -0600
 | 
						|
Subject: [PATCH] Add I2C bus driver for MCF547x and MCF548x.
 | 
						|
 | 
						|
LTIBName: m547x-8x-i2c
 | 
						|
Signed-off-by: Kurt Mahan <kmahan@freescale.com>
 | 
						|
Signed-off-by: Shrek Wu <b16972@freescale.com>
 | 
						|
---
 | 
						|
 arch/m68k/coldfire/Makefile          |    1 +
 | 
						|
 arch/m68k/coldfire/mcf548x-devices.c |   94 ++++++
 | 
						|
 drivers/i2c/busses/Kconfig           |   12 +
 | 
						|
 drivers/i2c/busses/Makefile          |    1 +
 | 
						|
 drivers/i2c/busses/i2c-algo-mcf.h    |   23 ++
 | 
						|
 drivers/i2c/busses/i2c-mcf548x.c     |  573 ++++++++++++++++++++++++++++++++++
 | 
						|
 include/asm-m68k/m5485i2c.h          |   45 +++
 | 
						|
 7 files changed, 749 insertions(+), 0 deletions(-)
 | 
						|
 create mode 100644 arch/m68k/coldfire/mcf548x-devices.c
 | 
						|
 create mode 100644 drivers/i2c/busses/i2c-algo-mcf.h
 | 
						|
 create mode 100644 drivers/i2c/busses/i2c-mcf548x.c
 | 
						|
 create mode 100644 include/asm-m68k/m5485i2c.h
 | 
						|
 | 
						|
--- a/arch/m68k/coldfire/Makefile
 | 
						|
+++ b/arch/m68k/coldfire/Makefile
 | 
						|
@@ -11,4 +11,5 @@ endif
 | 
						|
 obj-$(CONFIG_PCI)	+= pci.o mcf5445x-pci.o iomap.o
 | 
						|
 obj-$(CONFIG_M54455)	+= mcf5445x-devices.o
 | 
						|
 obj-$(CONFIG_M547X_8X)	+= m547x_8x-devices.o
 | 
						|
+obj-$(CONFIG_M547X_8X)	+= mcf548x-devices.o
 | 
						|
 obj-$(CONFIG_MCD_DMA)	+= m547x_8x-dma.o
 | 
						|
--- /dev/null
 | 
						|
+++ b/arch/m68k/coldfire/mcf548x-devices.c
 | 
						|
@@ -0,0 +1,94 @@
 | 
						|
+/*
 | 
						|
+ * arch/m68k/coldfire/mcf5445x-devices.c
 | 
						|
+ *
 | 
						|
+ * Coldfire M5445x Platform Device Configuration
 | 
						|
+ *
 | 
						|
+ * Based on the Freescale MXC devices.c
 | 
						|
+ *
 | 
						|
+ * Copyright (c) 2007 Freescale Semiconductor, Inc.
 | 
						|
+ *	Kurt Mahan <kmahan@freescale.com>
 | 
						|
+ */
 | 
						|
+#include <linux/module.h>
 | 
						|
+#include <linux/kernel.h>
 | 
						|
+#include <linux/init.h>
 | 
						|
+#include <linux/mtd/physmap.h>
 | 
						|
+#include <linux/platform_device.h>
 | 
						|
+#include <linux/fsl_devices.h>
 | 
						|
+
 | 
						|
+#include <asm/coldfire.h>
 | 
						|
+#include <asm/mcfsim.h>
 | 
						|
+
 | 
						|
+static struct resource coldfire_i2c_resources[] = {
 | 
						|
+	[0] = {		/* I/O */
 | 
						|
+		.start		= MCF_MBAR + 0x008F00,
 | 
						|
+		.end		= MCF_MBAR + 0x008F20,
 | 
						|
+		.flags		= IORESOURCE_MEM,
 | 
						|
+	},
 | 
						|
+	[2] = {		/* IRQ */
 | 
						|
+		.start		= 40,
 | 
						|
+		.end		= 40,
 | 
						|
+		.flags		= IORESOURCE_IRQ,
 | 
						|
+	},
 | 
						|
+};
 | 
						|
+
 | 
						|
+static struct platform_device coldfire_i2c_device = {
 | 
						|
+	.name			= "MCF548X-i2c",
 | 
						|
+	.id			= -1,
 | 
						|
+	.num_resources		= ARRAY_SIZE(coldfire_i2c_resources),
 | 
						|
+	.resource		= coldfire_i2c_resources,
 | 
						|
+};
 | 
						|
+
 | 
						|
+static struct resource coldfire_sec_resources[] = {
 | 
						|
+	[0] = {         /* I/O */
 | 
						|
+		.start          = MCF_MBAR + 0x00020000,
 | 
						|
+		.end            = MCF_MBAR + 0x00033000,
 | 
						|
+		.flags          = IORESOURCE_MEM,
 | 
						|
+	},
 | 
						|
+	[2] = {         /* IRQ */
 | 
						|
+		.start          = ISC_SEC,
 | 
						|
+		.end            = ISC_SEC,
 | 
						|
+		.flags          = IORESOURCE_IRQ,
 | 
						|
+	},
 | 
						|
+};
 | 
						|
+
 | 
						|
+static struct platform_device coldfire_sec_device = {
 | 
						|
+	.name                   = "fsl-sec1",
 | 
						|
+	.id                     = -1,
 | 
						|
+	.num_resources          = ARRAY_SIZE(coldfire_sec_resources),
 | 
						|
+	.resource               = coldfire_sec_resources,
 | 
						|
+};
 | 
						|
+
 | 
						|
+#if defined(CONFIG_MTD_PHYSMAP)
 | 
						|
+static struct physmap_flash_data mcf5485_flash_data = {
 | 
						|
+	.width          = 2,
 | 
						|
+};
 | 
						|
+
 | 
						|
+static struct resource mcf5485_flash_resource = {
 | 
						|
+	.start          = 0xf8000000,
 | 
						|
+	.end            = 0xf80fffff,
 | 
						|
+	.flags          = IORESOURCE_MEM,
 | 
						|
+};
 | 
						|
+
 | 
						|
+static struct platform_device mcf5485_flash_device = {
 | 
						|
+	.name           = "physmap-flash",
 | 
						|
+	.id             = 0,
 | 
						|
+	.dev            = {
 | 
						|
+		.platform_data  = &mcf5485_flash_data,
 | 
						|
+	},
 | 
						|
+	.num_resources  = 1,
 | 
						|
+	.resource       = &mcf5485_flash_resource,
 | 
						|
+};
 | 
						|
+#endif
 | 
						|
+
 | 
						|
+static int __init mcf5485_init_devices(void)
 | 
						|
+{
 | 
						|
+	printk(KERN_INFO "MCF5485x INIT_DEVICES\n");
 | 
						|
+
 | 
						|
+	platform_device_register(&coldfire_i2c_device);
 | 
						|
+	platform_device_register(&coldfire_sec_device);
 | 
						|
+/*#if defined(CONFIG_MTD_PHYSMAP)
 | 
						|
+	platform_device_register(&mcf5485_flash_device);
 | 
						|
+#endif*/
 | 
						|
+	return 0;
 | 
						|
+}
 | 
						|
+arch_initcall(mcf5485_init_devices);
 | 
						|
--- a/drivers/i2c/busses/Kconfig
 | 
						|
+++ b/drivers/i2c/busses/Kconfig
 | 
						|
@@ -4,6 +4,18 @@
 | 
						|
 
 | 
						|
 menu "I2C Hardware Bus support"
 | 
						|
 
 | 
						|
+config I2C_MCF548x
 | 
						|
+	tristate "I2C MCF547x/548x interfaces"
 | 
						|
+	depends on I2C
 | 
						|
+	help
 | 
						|
+	  This allows you to use the I2C adapters found on the Freescale
 | 
						|
+	  MCF547x/548x microcontrollers.
 | 
						|
+	  Say Y if you own an I2C adapter belonging to this class and then say
 | 
						|
+	  Y to the specific driver for you adapter below.
 | 
						|
+
 | 
						|
+	  This support is also available as a module.  If so, the module
 | 
						|
+	  will be called i2c-algo-mcf.
 | 
						|
+
 | 
						|
 config I2C_ALI1535
 | 
						|
 	tristate "ALI 1535"
 | 
						|
 	depends on PCI
 | 
						|
--- a/drivers/i2c/busses/Makefile
 | 
						|
+++ b/drivers/i2c/busses/Makefile
 | 
						|
@@ -52,6 +52,7 @@ obj-$(CONFIG_I2C_VIAPRO)	+= i2c-viapro.o
 | 
						|
 obj-$(CONFIG_I2C_VOODOO3)	+= i2c-voodoo3.o
 | 
						|
 obj-$(CONFIG_SCx200_ACB)	+= scx200_acb.o
 | 
						|
 obj-$(CONFIG_SCx200_I2C)	+= scx200_i2c.o
 | 
						|
+obj-$(CONFIG_I2C_MCF548x)       += i2c-mcf548x.o
 | 
						|
 
 | 
						|
 ifeq ($(CONFIG_I2C_DEBUG_BUS),y)
 | 
						|
 EXTRA_CFLAGS += -DDEBUG
 | 
						|
--- /dev/null
 | 
						|
+++ b/drivers/i2c/busses/i2c-algo-mcf.h
 | 
						|
@@ -0,0 +1,23 @@
 | 
						|
+#ifndef I2C_ALGO_MCF_H
 | 
						|
+#define I2C_ALGO_MCF_H 1
 | 
						|
+
 | 
						|
+/* --- Defines for pcf-adapters ---------------------------------------	*/
 | 
						|
+#include <linux/i2c.h>
 | 
						|
+
 | 
						|
+struct i2c_algo_mcf_data {
 | 
						|
+	void *data;		/* private data for lolevel routines	*/
 | 
						|
+	void (*setmcf) (void *data, int ctl, int val);
 | 
						|
+	int (*getmcf) (void *data, int ctl);
 | 
						|
+	int (*getown) (void *data);
 | 
						|
+	int (*getclock) (void *data);
 | 
						|
+	void (*waitforpin) (void);
 | 
						|
+	/* local settings */
 | 
						|
+	int udelay;
 | 
						|
+	int mdelay;
 | 
						|
+	int timeout;
 | 
						|
+};
 | 
						|
+
 | 
						|
+int i2c_mcf_add_bus(struct i2c_adapter *);
 | 
						|
+int i2c_mcf_del_bus(struct i2c_adapter *);
 | 
						|
+
 | 
						|
+#endif /* I2C_ALGO_MCF_H */
 | 
						|
--- /dev/null
 | 
						|
+++ b/drivers/i2c/busses/i2c-mcf548x.c
 | 
						|
@@ -0,0 +1,573 @@
 | 
						|
+/*
 | 
						|
+ * 	Performance and stability improvements: (C) Copyright 2008,
 | 
						|
+ *	Adrian Cox <adrian@humboldt.co.uk>
 | 
						|
+ *	ColdFire 547x/548x I2C master support
 | 
						|
+ * 	Shrek Wu (b16972@freescale.com )moved the code driver/i2c/alg/mcf.c
 | 
						|
+ *      into driver/i2c/busses.And changed the driver to a platform driver.
 | 
						|
+ */
 | 
						|
+#include <linux/i2c.h>
 | 
						|
+#include "i2c-algo-mcf.h"
 | 
						|
+
 | 
						|
+#include <linux/init.h>
 | 
						|
+#include <linux/kernel.h>
 | 
						|
+#include <linux/module.h>
 | 
						|
+#include <linux/delay.h>
 | 
						|
+#include <linux/platform_device.h>
 | 
						|
+#include <linux/sched.h>
 | 
						|
+#include <linux/interrupt.h>
 | 
						|
+#include <asm/io.h>
 | 
						|
+
 | 
						|
+#include <asm/coldfire.h>
 | 
						|
+#include <asm/m5485sim.h>
 | 
						|
+#include <asm/m5485i2c.h>
 | 
						|
+
 | 
						|
+#define get_clock(adap) (clock)
 | 
						|
+#define get_own(adap) 	(own)
 | 
						|
+
 | 
						|
+static int clock = 0x3b;  /*50000 / 1024 ~ 49 KHz*/
 | 
						|
+module_param(clock, int, 0);
 | 
						|
+MODULE_PARM_DESC(clock,
 | 
						|
+	"Set I2C clock in kHz: 400=fast mode (default == 49khz)");
 | 
						|
+
 | 
						|
+static int own = 0x78;
 | 
						|
+module_param(own, int, 0);
 | 
						|
+MODULE_PARM_DESC(clock, "Set I2C Master controller address(0x78)");
 | 
						|
+
 | 
						|
+static struct i2c_algo_mcf_data i2c_mcf_board_data = {
 | 
						|
+	.timeout =	10000,
 | 
						|
+};
 | 
						|
+
 | 
						|
+static struct i2c_adapter i2c_mcf_board_adapter = {
 | 
						|
+	.owner = THIS_MODULE,
 | 
						|
+	.name = "MCF5485 adapter",
 | 
						|
+	.id = I2C_HW_MPC107,
 | 
						|
+	.algo_data = &i2c_mcf_board_data,
 | 
						|
+	.class = I2C_CLASS_HWMON,
 | 
						|
+	.timeout = 1,
 | 
						|
+	.retries = 1
 | 
						|
+};
 | 
						|
+/*
 | 
						|
+ *  static void i2c_start()
 | 
						|
+ *
 | 
						|
+ *  Generates START signal
 | 
						|
+ */
 | 
						|
+static void
 | 
						|
+i2c_start(
 | 
						|
+	struct i2c_algo_mcf_data *adap
 | 
						|
+) {
 | 
						|
+	MCF_I2CR |= MCF_I2CR_MSTA;
 | 
						|
+}
 | 
						|
+
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void i2c_stop()
 | 
						|
+ *
 | 
						|
+ *  Generates STOP signal
 | 
						|
+ */
 | 
						|
+static void
 | 
						|
+i2c_stop(
 | 
						|
+	struct i2c_algo_mcf_data *adap
 | 
						|
+) {
 | 
						|
+	MCF_I2CR &= ~MCF_I2CR_MSTA;
 | 
						|
+}
 | 
						|
+
 | 
						|
+static int
 | 
						|
+i2c_getack(
 | 
						|
+	struct i2c_algo_mcf_data *adap
 | 
						|
+) {
 | 
						|
+	return !(MCF_I2SR & MCF_I2SR_RXAK);
 | 
						|
+}
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void i2c_repstart()
 | 
						|
+ *
 | 
						|
+ *  Generates repeated start signal (without STOP while mastering the bus)
 | 
						|
+ */
 | 
						|
+static void
 | 
						|
+i2c_repstart(
 | 
						|
+	struct i2c_algo_mcf_data *adap
 | 
						|
+) {
 | 
						|
+	MCF_I2CR |= MCF_I2CR_RSTA;
 | 
						|
+	MCF_I2CR |= MCF_I2CR_MTX;
 | 
						|
+}
 | 
						|
+
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void wait_for_bb()
 | 
						|
+ *
 | 
						|
+ *  Wait for bus idle state
 | 
						|
+ */
 | 
						|
+static int
 | 
						|
+wait_for_bb(
 | 
						|
+	struct i2c_algo_mcf_data *adap
 | 
						|
+) {
 | 
						|
+	int i;
 | 
						|
+	for (i = 0; i < adap->timeout; i++) {
 | 
						|
+		if (!(MCF_I2SR & MCF_I2SR_IBB))
 | 
						|
+			return 0;
 | 
						|
+		udelay(10);
 | 
						|
+	}
 | 
						|
+	printk(KERN_ERR "%s: timeout", __FUNCTION__);
 | 
						|
+	return -ETIMEDOUT;
 | 
						|
+}
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void wait_for_not_bb()
 | 
						|
+ *
 | 
						|
+ *  Wait for bus busy state
 | 
						|
+ */
 | 
						|
+static int
 | 
						|
+wait_for_not_bb(
 | 
						|
+	struct i2c_algo_mcf_data *adap
 | 
						|
+) {
 | 
						|
+	int i;
 | 
						|
+	for (i = 0; i < adap->timeout; i++) {
 | 
						|
+		if (MCF_I2SR & MCF_I2SR_IBB)
 | 
						|
+			return 0;
 | 
						|
+		udelay(10);
 | 
						|
+	}
 | 
						|
+	printk(KERN_ERR "%s: timeout", __FUNCTION__);
 | 
						|
+	return -ETIMEDOUT;
 | 
						|
+}
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void wait_xfer_done()
 | 
						|
+ *
 | 
						|
+ *  Wait for transfer to complete
 | 
						|
+ */
 | 
						|
+static int
 | 
						|
+wait_xfer_done(
 | 
						|
+	struct i2c_algo_mcf_data *adap
 | 
						|
+) {
 | 
						|
+	int i;
 | 
						|
+
 | 
						|
+	for (i = 0; i < adap->timeout; i++) {
 | 
						|
+		if (MCF_I2SR & MCF_I2SR_IIF) {
 | 
						|
+			MCF_I2SR &= ~MCF_I2SR_IIF;
 | 
						|
+			return 0;
 | 
						|
+		}
 | 
						|
+		udelay(1);
 | 
						|
+	}
 | 
						|
+	printk(KERN_ERR "%s: timeout", __FUNCTION__);
 | 
						|
+	return -ETIMEDOUT;
 | 
						|
+}
 | 
						|
+
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void i2c_set_addr()
 | 
						|
+ *
 | 
						|
+ *  Sets slave address to communicate
 | 
						|
+ */
 | 
						|
+static int
 | 
						|
+i2c_set_addr(
 | 
						|
+	struct i2c_algo_mcf_data *adap,
 | 
						|
+	struct i2c_msg *msg,
 | 
						|
+	int retries
 | 
						|
+) {
 | 
						|
+	unsigned short flags = msg->flags;
 | 
						|
+	unsigned char addr;
 | 
						|
+
 | 
						|
+	if ((flags & I2C_M_TEN)) {
 | 
						|
+		/* 10 bit address not supported yet */
 | 
						|
+		return -EIO;
 | 
						|
+	} else {
 | 
						|
+		/* normal 7bit address */
 | 
						|
+		addr = (msg->addr << 1);
 | 
						|
+		if (flags & I2C_M_RD)
 | 
						|
+			addr |= 1;
 | 
						|
+		if (flags & I2C_M_REV_DIR_ADDR)
 | 
						|
+			addr ^= 1;
 | 
						|
+
 | 
						|
+		MCF_I2DR = addr;
 | 
						|
+	}
 | 
						|
+	return 0;
 | 
						|
+}
 | 
						|
+
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void mcf_i2c_init()
 | 
						|
+ *
 | 
						|
+ *  Perform ColdFire i2c initialization
 | 
						|
+ */
 | 
						|
+static void
 | 
						|
+mcf_i2c_init(struct i2c_algo_mcf_data *adap)
 | 
						|
+{
 | 
						|
+	u8 dummy;
 | 
						|
+	/* Setup GPIO lines */
 | 
						|
+	MCF_PAR_FECI2CIRQ |= MCF_PAR_SDA;
 | 
						|
+	MCF_PAR_FECI2CIRQ |= MCF_PAR_SCL;
 | 
						|
+
 | 
						|
+	/*  Ensure slaves are in idle state */
 | 
						|
+	if (MCF_I2SR & MCF_I2SR_IBB) {
 | 
						|
+		MCF_I2ICR = 0x00;
 | 
						|
+		MCF_I2CR  = 0x00;
 | 
						|
+		MCF_I2CR  = 0x0A;
 | 
						|
+		dummy = MCF_I2DR;
 | 
						|
+		MCF_I2SR  = 0x00;
 | 
						|
+		MCF_I2CR  = 0x00;
 | 
						|
+		MCF_I2ICR = 0x01;
 | 
						|
+	}
 | 
						|
+
 | 
						|
+	/* setup SCL clock */
 | 
						|
+	MCF_I2FDR = get_clock(adap);
 | 
						|
+
 | 
						|
+	/* set slave address */
 | 
						|
+	MCF_I2AR = get_own(adap);
 | 
						|
+
 | 
						|
+	/* enable I2C module */
 | 
						|
+	MCF_I2CR = MCF_I2CR_IEN;
 | 
						|
+}
 | 
						|
+
 | 
						|
+static int i2c_outb(
 | 
						|
+	struct i2c_adapter *i2c_adap,
 | 
						|
+	char c
 | 
						|
+) {
 | 
						|
+
 | 
						|
+	struct i2c_algo_mcf_data *adap = i2c_adap->algo_data;
 | 
						|
+	int timeout;
 | 
						|
+	/* Put data to be sent */
 | 
						|
+	MCF_I2DR = c;
 | 
						|
+	/* Wait for xfer completed*/
 | 
						|
+	timeout = wait_xfer_done(adap);
 | 
						|
+	if (timeout) {
 | 
						|
+		i2c_stop(adap);
 | 
						|
+		wait_for_bb(adap);
 | 
						|
+		printk(KERN_ERR "i2c-algo-mcf: %s i2c_write: "
 | 
						|
+			"error - timeout.\n", i2c_adap->name);
 | 
						|
+		return -EREMOTEIO; /* got a better one ?? */
 | 
						|
+	}
 | 
						|
+
 | 
						|
+	return 0;
 | 
						|
+}
 | 
						|
+
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void mcf_sendbytes()
 | 
						|
+ *
 | 
						|
+ *  Perform tx data transfer
 | 
						|
+ */
 | 
						|
+static int
 | 
						|
+mcf_sendbytes(
 | 
						|
+	struct i2c_adapter *i2c_adap,
 | 
						|
+	const char *buf,
 | 
						|
+	int count, int last
 | 
						|
+) {
 | 
						|
+	struct i2c_algo_mcf_data *adap = i2c_adap->algo_data;
 | 
						|
+	int ret, i;
 | 
						|
+
 | 
						|
+	/* Set master TX mode */
 | 
						|
+	MCF_I2CR |= MCF_I2CR_MTX;
 | 
						|
+
 | 
						|
+	for (i = 0; i < count; ++i) {
 | 
						|
+		printk(KERN_DEBUG "i2c-algo-mcf: %s i2c_write: writing %2.2X\n",
 | 
						|
+		      i2c_adap->name, buf[i]&0xff);
 | 
						|
+		ret = i2c_outb(i2c_adap, buf[i]);
 | 
						|
+		if (ret < 0)
 | 
						|
+			return ret;
 | 
						|
+	}
 | 
						|
+	if (last) {
 | 
						|
+		i2c_stop(adap);
 | 
						|
+		wait_for_bb(adap);
 | 
						|
+	} else {
 | 
						|
+		i2c_repstart(adap);
 | 
						|
+	}
 | 
						|
+
 | 
						|
+	return (i);
 | 
						|
+}
 | 
						|
+
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void mcf_readbytes()
 | 
						|
+ *
 | 
						|
+ *  Perform rx data transfer
 | 
						|
+ */
 | 
						|
+static int
 | 
						|
+mcf_readbytes(
 | 
						|
+	struct i2c_adapter *i2c_adap,
 | 
						|
+	char *buf,
 | 
						|
+	int count, int last
 | 
						|
+) {
 | 
						|
+	int i;
 | 
						|
+	struct i2c_algo_mcf_data *adap = i2c_adap->algo_data;
 | 
						|
+	u8 dummy;
 | 
						|
+
 | 
						|
+	/* Set master RX mode */
 | 
						|
+	MCF_I2CR &= ~MCF_I2CR_MTX;
 | 
						|
+	MCF_I2CR &= ~MCF_I2CR_TXAK;
 | 
						|
+	dummy = MCF_I2DR;
 | 
						|
+
 | 
						|
+	for (i = 0; i < count-1; i++) {
 | 
						|
+		if (wait_xfer_done(adap)) {
 | 
						|
+			i2c_stop(adap);
 | 
						|
+			wait_for_bb(adap);
 | 
						|
+			printk(KERN_DEBUG
 | 
						|
+			    "i2c-algo-mcf: mcf_readbytes timed out.\n");
 | 
						|
+			return (-1);
 | 
						|
+		}
 | 
						|
+
 | 
						|
+		/* store next data byte */
 | 
						|
+		buf[i] = MCF_I2DR;
 | 
						|
+	}
 | 
						|
+
 | 
						|
+	if (wait_xfer_done(adap)) {
 | 
						|
+		i2c_stop(adap);
 | 
						|
+		wait_for_bb(adap);
 | 
						|
+		printk(KERN_DEBUG "i2c-algo-mcf: mcf_readbytes timed out.\n");
 | 
						|
+		return (-1);
 | 
						|
+	}
 | 
						|
+
 | 
						|
+	/* Disable acknowlege (set I2CR.TXAK) */
 | 
						|
+	MCF_I2CR |= MCF_I2CR_TXAK;
 | 
						|
+	buf[i] = MCF_I2DR;
 | 
						|
+	if (wait_xfer_done(adap)) {
 | 
						|
+		i2c_stop(adap);
 | 
						|
+		wait_for_bb(adap);
 | 
						|
+		printk(KERN_DEBUG "i2c-algo-mcf: mcf_readbytes timed out.\n");
 | 
						|
+		return (-1);
 | 
						|
+	}
 | 
						|
+
 | 
						|
+	if (last) {
 | 
						|
+		i2c_stop(adap);
 | 
						|
+		wait_for_bb(adap);
 | 
						|
+	} else {
 | 
						|
+		i2c_repstart(adap);
 | 
						|
+	}
 | 
						|
+
 | 
						|
+	return (i+1);
 | 
						|
+}
 | 
						|
+
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void mcf_xfer()
 | 
						|
+ *
 | 
						|
+ *  Perform master data I/O transfer
 | 
						|
+ */
 | 
						|
+static int
 | 
						|
+mcf_xfer(
 | 
						|
+	struct i2c_adapter *i2c_adap,
 | 
						|
+	struct i2c_msg *msgs,
 | 
						|
+	int num
 | 
						|
+) {
 | 
						|
+	struct i2c_algo_mcf_data *adap = i2c_adap->algo_data;
 | 
						|
+	struct i2c_msg *pmsg;
 | 
						|
+	int i;
 | 
						|
+	int ret = 0, timeout;
 | 
						|
+
 | 
						|
+	/* Skip own address */
 | 
						|
+	if (get_own(adap) == (msgs[0].addr << 1))
 | 
						|
+		return -EIO;
 | 
						|
+
 | 
						|
+	/*  Ensure slaves are in idle state */
 | 
						|
+	if (MCF_I2SR & MCF_I2SR_IBB) {
 | 
						|
+		MCF_I2ICR = 0x00;
 | 
						|
+		MCF_I2CR  = 0x00;
 | 
						|
+		MCF_I2CR  = 0x0A;
 | 
						|
+		timeout = MCF_I2DR;
 | 
						|
+		MCF_I2SR  = 0x00;
 | 
						|
+		MCF_I2CR  = 0x00;
 | 
						|
+		MCF_I2ICR = 0x01;
 | 
						|
+	}
 | 
						|
+	/* setup SCL clock */
 | 
						|
+	MCF_I2FDR = get_clock(adap);
 | 
						|
+	/* set slave address */
 | 
						|
+	MCF_I2AR = get_own(adap);
 | 
						|
+	/* enable I2C module */
 | 
						|
+	MCF_I2CR = MCF_I2CR_IEN;
 | 
						|
+
 | 
						|
+	MCF_I2CR |= MCF_I2CR_TXAK;
 | 
						|
+
 | 
						|
+	/* Check for bus busy */
 | 
						|
+	wait_for_bb(adap);
 | 
						|
+
 | 
						|
+	for (i = 0; ret >= 0 && i < num; i++) {
 | 
						|
+		pmsg = &msgs[i];
 | 
						|
+
 | 
						|
+		printk(KERN_DEBUG "i2c-algo-mcf: Doing %s %d bytes "
 | 
						|
+			"to 0x%02x - %d of %d messages\n",
 | 
						|
+			pmsg->flags & I2C_M_RD ? "read" : "write",
 | 
						|
+			pmsg->len, pmsg->addr, i + 1, num);
 | 
						|
+
 | 
						|
+		/* Send START */
 | 
						|
+		if (i == 0)
 | 
						|
+			i2c_start(adap);
 | 
						|
+
 | 
						|
+		/* Wait for Bus Busy */
 | 
						|
+		wait_for_not_bb(adap);
 | 
						|
+
 | 
						|
+		MCF_I2CR |= MCF_I2CR_MTX;
 | 
						|
+
 | 
						|
+		ret = i2c_set_addr(adap, pmsg, i2c_adap->retries);
 | 
						|
+		if (ret < 0)
 | 
						|
+			return ret;
 | 
						|
+
 | 
						|
+		/* Wait for address transfer completion */
 | 
						|
+		wait_xfer_done(adap);
 | 
						|
+
 | 
						|
+		/* Check for ACK */
 | 
						|
+		if (!i2c_getack(adap)) {
 | 
						|
+			i2c_stop(adap);
 | 
						|
+			wait_for_bb(adap);
 | 
						|
+			printk(KERN_DEBUG "i2c-algo-mcf: No ack after "
 | 
						|
+				    "send address in mcf_xfer\n");
 | 
						|
+			return (-EREMOTEIO);
 | 
						|
+		}
 | 
						|
+
 | 
						|
+		printk(KERN_DEBUG "i2c-algo-mcf: Msg %d, "
 | 
						|
+				  "addr = 0x%x, flags = 0x%x, len = %d\n",
 | 
						|
+				i, msgs[i].addr, msgs[i].flags, msgs[i].len);
 | 
						|
+		/* Read */
 | 
						|
+		if (pmsg->flags & I2C_M_RD) {
 | 
						|
+			/* read bytes into buffer*/
 | 
						|
+			ret = mcf_readbytes(i2c_adap, pmsg->buf, pmsg->len,
 | 
						|
+						(i + 1 == num));
 | 
						|
+
 | 
						|
+			if (ret != pmsg->len) {
 | 
						|
+				printk(KERN_DEBUG "i2c-algo-mcf: fail: "
 | 
						|
+					    "only read %d bytes.\n", ret);
 | 
						|
+			} else {
 | 
						|
+				printk(KERN_DEBUG "i2c-algo-mcf: "
 | 
						|
+						  "read %d bytes.\n", ret);
 | 
						|
+			}
 | 
						|
+		} else {
 | 
						|
+			/* write bytes into buffer*/
 | 
						|
+			ret = mcf_sendbytes(i2c_adap, pmsg->buf, pmsg->len,
 | 
						|
+						(i + 1 == num));
 | 
						|
+			if (ret != pmsg->len) {
 | 
						|
+				printk(KERN_DEBUG "i2c-algo-mcf: fail: "
 | 
						|
+					    "only wrote %d bytes.\n", ret);
 | 
						|
+			} else {
 | 
						|
+				printk(KERN_DEBUG "i2c-algo-mcf: wrote"
 | 
						|
+					"%d bytes.\n", ret);
 | 
						|
+			}
 | 
						|
+		}
 | 
						|
+	}
 | 
						|
+
 | 
						|
+	/* Disable I2C module */
 | 
						|
+	MCF_I2CR = 0;
 | 
						|
+	return (i);
 | 
						|
+}
 | 
						|
+
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  static void mcf_func()
 | 
						|
+ *
 | 
						|
+ *  Return algorithm funtionality
 | 
						|
+ */
 | 
						|
+static u32
 | 
						|
+mcf_func(
 | 
						|
+	struct i2c_adapter *i2c_adap
 | 
						|
+) {
 | 
						|
+	return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_I2C;
 | 
						|
+}
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  ColdFire bus algorithm callbacks
 | 
						|
+ */
 | 
						|
+static struct i2c_algorithm mcf_algo = {
 | 
						|
+	.master_xfer    = mcf_xfer,
 | 
						|
+	.functionality  = mcf_func,
 | 
						|
+};
 | 
						|
+
 | 
						|
+/***********************************************************/
 | 
						|
+struct coldfire_i2c {
 | 
						|
+	void __iomem *base;
 | 
						|
+	struct resource *irqarea;
 | 
						|
+	struct resource *ioarea;
 | 
						|
+	u32 irq;
 | 
						|
+	struct i2c_adapter *adap;
 | 
						|
+	u32 flags;
 | 
						|
+};
 | 
						|
+
 | 
						|
+/*
 | 
						|
+ *  registering functions to load algorithms at runtime
 | 
						|
+ */
 | 
						|
+int i2c_mcf_add_bus(struct i2c_adapter *adap)
 | 
						|
+{
 | 
						|
+	struct i2c_algo_mcf_data *mcf_adap = adap->algo_data;
 | 
						|
+
 | 
						|
+	/*adap->id |= mcf_algo.id;*/
 | 
						|
+	adap->algo = &mcf_algo;
 | 
						|
+	adap->timeout = 100;
 | 
						|
+
 | 
						|
+	mcf_i2c_init(mcf_adap);
 | 
						|
+
 | 
						|
+#ifdef MODULE
 | 
						|
+	MOD_INC_USE_COUNT;
 | 
						|
+#endif
 | 
						|
+
 | 
						|
+	i2c_add_adapter(adap);
 | 
						|
+
 | 
						|
+	return 0;
 | 
						|
+}
 | 
						|
+
 | 
						|
+static int mcf548x_i2c_probe(struct platform_device *pdev)
 | 
						|
+{
 | 
						|
+	struct coldfire_i2c *i2c;
 | 
						|
+	int rc = 0;
 | 
						|
+
 | 
						|
+	/************************************************************/
 | 
						|
+	i2c = kzalloc(sizeof(*i2c), GFP_KERNEL);
 | 
						|
+	if (!i2c) {
 | 
						|
+		printk(KERN_ERR "%s kzalloc coldfire_i2c faile\n",
 | 
						|
+				__FUNCTION__);
 | 
						|
+		return -ENOMEM;
 | 
						|
+	}
 | 
						|
+	/****************************************************************/
 | 
						|
+	platform_set_drvdata(pdev, i2c);
 | 
						|
+
 | 
						|
+	i2c->adap = &i2c_mcf_board_adapter;
 | 
						|
+	i2c->adap->dev.parent = &pdev->dev;
 | 
						|
+	rc = i2c_mcf_add_bus(i2c->adap);
 | 
						|
+	if (rc < 0) {
 | 
						|
+		printk(KERN_ERR "%s - failed to add adapter\n", __FUNCTION__);
 | 
						|
+		rc = -ENODEV;
 | 
						|
+		goto fail_add;
 | 
						|
+	}
 | 
						|
+
 | 
						|
+	printk(KERN_INFO "i2c-algo-mcf.o: I2C ColdFire algorithm"
 | 
						|
+			" module is loaded.\n");
 | 
						|
+	return rc;
 | 
						|
+
 | 
						|
+fail_add:
 | 
						|
+	kfree(i2c);
 | 
						|
+	return rc;
 | 
						|
+};
 | 
						|
+
 | 
						|
+static int mcf548x_i2c_remove(struct platform_device *pdev)
 | 
						|
+{
 | 
						|
+	struct coldfire_i2c *i2c = platform_get_drvdata(pdev);
 | 
						|
+
 | 
						|
+	i2c_del_adapter(i2c->adap);
 | 
						|
+	platform_set_drvdata(pdev, NULL);
 | 
						|
+	iounmap(i2c->base);
 | 
						|
+	kfree(i2c);
 | 
						|
+	return 0;
 | 
						|
+};
 | 
						|
+
 | 
						|
+/* Structure for a device driver */
 | 
						|
+static struct platform_driver mcf548x_i2c_driver = {
 | 
						|
+	.probe 	= mcf548x_i2c_probe,
 | 
						|
+	.remove = mcf548x_i2c_remove,
 | 
						|
+	.driver	= {
 | 
						|
+		.owner = THIS_MODULE,
 | 
						|
+		.name = "MCF548X-i2c",
 | 
						|
+	},
 | 
						|
+};
 | 
						|
+
 | 
						|
+static int __init coldfire_i2c_init(void)
 | 
						|
+{
 | 
						|
+	return platform_driver_register(&mcf548x_i2c_driver);
 | 
						|
+}
 | 
						|
+
 | 
						|
+static void __exit coldfire_i2c_exit(void)
 | 
						|
+{
 | 
						|
+	platform_driver_unregister(&mcf548x_i2c_driver);
 | 
						|
+}
 | 
						|
+
 | 
						|
+module_init(coldfire_i2c_init);
 | 
						|
+module_exit(coldfire_i2c_exit);
 | 
						|
+
 | 
						|
+MODULE_AUTHOR("Adrian Cox <adrian@humboldt.co.uk>");
 | 
						|
+MODULE_DESCRIPTION
 | 
						|
+    ("I2C-Bus adapter for MCF547x and MCF548x processors");
 | 
						|
+MODULE_LICENSE("GPL");
 | 
						|
--- /dev/null
 | 
						|
+++ b/include/asm-m68k/m5485i2c.h
 | 
						|
@@ -0,0 +1,45 @@
 | 
						|
+/*
 | 
						|
+ *	m5485i2c.h -- ColdFire 547x/548x i2c controller support.
 | 
						|
+ */
 | 
						|
+#ifndef M548X_I2C_H
 | 
						|
+#define M548X_I2C_H
 | 
						|
+
 | 
						|
+/* Register read/write macros */
 | 
						|
+#define MCF_I2AR     MCF_REG08(0x008F00)	/* I2C Address 		 */
 | 
						|
+#define MCF_I2FDR    MCF_REG08(0x008F04)	/* I2C Frequency Divider */
 | 
						|
+#define MCF_I2CR     MCF_REG08(0x008F08)	/* I2C Control		 */
 | 
						|
+#define MCF_I2SR     MCF_REG08(0x008F0C)	/* I2C Status		 */
 | 
						|
+#define MCF_I2DR     MCF_REG08(0x008F10)	/* I2C Data I/O		 */
 | 
						|
+#define MCF_I2ICR    MCF_REG08(0x008F20)	/* I2C Interrupt Control */
 | 
						|
+
 | 
						|
+/* Bit definitions and macros for MCF_I2C_I2AR */
 | 
						|
+#define MCF_I2AR_ADR(x)    (((x)&0x7F)<<1)
 | 
						|
+
 | 
						|
+/* Bit definitions and macros for MCF_I2C_I2FDR */
 | 
						|
+#define MCF_I2FDR_IC(x)    (((x)&0x3F)<<0)
 | 
						|
+
 | 
						|
+/* Bit definitions and macros for MCF_I2C_I2CR */
 | 
						|
+#define MCF_I2CR_RSTA      (0x04)
 | 
						|
+#define MCF_I2CR_TXAK      (0x08)
 | 
						|
+#define MCF_I2CR_MTX       (0x10)
 | 
						|
+#define MCF_I2CR_MSTA      (0x20)
 | 
						|
+#define MCF_I2CR_IIEN      (0x40)
 | 
						|
+#define MCF_I2CR_IEN       (0x80)
 | 
						|
+
 | 
						|
+/* Bit definitions and macros for MCF_I2C_I2SR */
 | 
						|
+#define MCF_I2SR_RXAK      (0x01)
 | 
						|
+#define MCF_I2SR_IIF       (0x02)
 | 
						|
+#define MCF_I2SR_SRW       (0x04)
 | 
						|
+#define MCF_I2SR_IAL       (0x10)
 | 
						|
+#define MCF_I2SR_IBB       (0x20)
 | 
						|
+#define MCF_I2SR_IAAS      (0x40)
 | 
						|
+#define MCF_I2SR_ICF       (0x80)
 | 
						|
+
 | 
						|
+/* Bit definitions and macros for MCF_I2C_I2ICR */
 | 
						|
+#define MCF_I2ICR_IE       (0x01)
 | 
						|
+#define MCF_I2ICR_RE       (0x02)
 | 
						|
+#define MCF_I2ICR_TE       (0x04)
 | 
						|
+#define MCF_I2ICR_BNBE     (0x08)
 | 
						|
+
 | 
						|
+/********************************************************************/
 | 
						|
+#endif
 |