branch Attitude Adjustment

git-svn-id: svn://svn.openwrt.org/openwrt/branches/attitude_adjustment@33625 3c298f89-4303-0410-b956-a3cf2f4a3e73

1 files changed, 1216 insertions, 0 deletions

diff --git a/target/linux/coldfire/patches/025-Add-I2C-driver-for-MCF5445x-MCF547x-MCF548x.patch b/target/linux/coldfire/patches/025-Add-I2C-driver-for-MCF5445x-MCF547x-MCF548x.patch
new file mode 100644
index 000000000..743af7f2a
--- /dev/null
+++ b/target/linux/coldfire/patches/025-Add-I2C-driver-for-MCF5445x-MCF547x-MCF548x.patch
@@ -0,0 +1,1216 @@
+From a7c7130d916c1f7e0d27ad9b338912496ad53089 Mon Sep 17 00:00:00 2001
+From: Alison Wang <b18965@freescale.com>
+Date: Thu, 4 Aug 2011 09:59:46 +0800
+Subject: [PATCH 25/52] Add I2C driver for MCF5445x/MCF547x/MCF548x.
+
+Add common I2C driver for MCF5445x/MCF547x/MCF548x and add I2C slave
+mode support for MCF5445x.
+
+Configure I2C  adaptor as slave mode and Support I2C adaptor as a
+"eeprom-like" slave device.
+
+Signed-off-by: Alison Wang <b18965@freescale.com>
+---
+ arch/m68k/include/asm/mcfi2c.h     |   57 +++
+ drivers/i2c/busses/Kconfig         |   24 ++
+ drivers/i2c/busses/Makefile        |    2 +
+ drivers/i2c/busses/i2c-algo-mcf.h  |   23 ++
+ drivers/i2c/busses/i2c-mcf-slave.c |  358 ++++++++++++++++++
+ drivers/i2c/busses/i2c-mcf.c       |  698 ++++++++++++++++++++++++++++++++++++
+ 6 files changed, 1162 insertions(+), 0 deletions(-)
+ create mode 100644 arch/m68k/include/asm/mcfi2c.h
+ create mode 100644 drivers/i2c/busses/i2c-algo-mcf.h
+ create mode 100644 drivers/i2c/busses/i2c-mcf-slave.c
+ create mode 100644 drivers/i2c/busses/i2c-mcf.c
+
+--- /dev/null
++++ b/arch/m68k/include/asm/mcfi2c.h
+@@ -0,0 +1,57 @@
++/*
++ * mcfi2c.h -- ColdFire mcfv4/mcfv4e i2c controller support.
++ * Copyright (C) 2009-2011 Freescale Semiconductor, Inc. All Rights Reserved.
++ */
++#ifndef MCF_I2C_H
++#define MCF_I2C_H
++
++/* Register read/write macros */
++#if defined(CONFIG_M547X_8X)
++#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 */
++#elif defined(CONFIG_M5445X) || defined(CONFIG_M5441X)
++#define MCF_I2AR     (*(volatile u8 *)(0xFC058000))	/* I2C Address */
++/* I2C Frequency Divider */
++#define MCF_I2FDR    (*(volatile u8 *)(0xFC058004))
++#define MCF_I2CR     (*(volatile u8 *)(0xFC058008))	/* I2C Control */
++#define MCF_I2SR     (*(volatile u8 *)(0xFC05800C))	/* I2C Status */
++#define MCF_I2DR     (*(volatile u8 *)(0xFC058010))	/* I2C Data I/O */
++#endif
++
++/* 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 */
++#if defined(CONFIG_M547X_8X)
++#define MCF_I2ICR_IE       (0x01)
++#define MCF_I2ICR_RE       (0x02)
++#define MCF_I2ICR_TE       (0x04)
++#define MCF_I2ICR_BNBE     (0x08)
++#endif
++
++/********************************************************************/
++#endif
+--- a/drivers/i2c/busses/Kconfig
++++ b/drivers/i2c/busses/Kconfig
+@@ -431,6 +431,30 @@ config I2C_IXP2000
+ 	  This driver is deprecated and will be dropped soon. Use i2c-gpio
+ 	  instead.
+ 
++config I2C_MCF
++	tristate "MCF ColdFire I2C Interface"
++	depends on I2C && COLDFIRE
++	help
++	  If you say yes to this option, support will be included for the
++	  I2C on most ColdFire CPUs
++
++	  This driver can also be built as a module.  If so, the module
++	  will be called i2c-mcf.
++
++config I2C_MCF_SLAVE
++	tristate "MCF ColdFire I2C Slave Interface"
++	depends on !(I2C_MCF)
++	default n
++	help
++	  mcf i2c adapter slave mode, only supported on mcf5445x platform.
++
++config I2C_SLAVE_TEST
++	bool "I2C Slave Mode Test Configuration"
++	depends on I2C_MCF_SLAVE
++	default y
++	help
++	   This configuration help to test I2C slave mode
++
+ config I2C_MPC
+ 	tristate "MPC107/824x/85xx/512x/52xx/83xx/86xx"
+ 	depends on PPC32
+--- a/drivers/i2c/busses/Makefile
++++ b/drivers/i2c/busses/Makefile
+@@ -77,5 +77,7 @@ obj-$(CONFIG_I2C_SIBYTE)	+= i2c-sibyte.o
+ obj-$(CONFIG_I2C_STUB)		+= i2c-stub.o
+ obj-$(CONFIG_SCx200_ACB)	+= scx200_acb.o
+ obj-$(CONFIG_SCx200_I2C)	+= scx200_i2c.o
++obj-$(CONFIG_I2C_MCF)           += i2c-mcf.o
++obj-$(CONFIG_I2C_MCF_SLAVE)	+= i2c-mcf-slave.o
+ 
+ ccflags-$(CONFIG_I2C_DEBUG_BUS) := -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-mcf-slave.c
+@@ -0,0 +1,358 @@
++/*
++ * i2c-mcf-slave.c - support adpater slave mode, now only support
++ * mcf5445x platform
++ *
++ * Copyright (C) 2009-2011 Freescale Semiconductor, Inc. All Rights Reserved.
++ * Lanttor Guo <lanttor.guo@freescale.com>
++ *
++ * 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.
++*/
++
++#ifdef CONFIG_I2C_SLAVE_TEST
++#define DEBUG
++#endif
++
++#include <linux/init.h>
++#include <linux/module.h>
++#include <linux/kernel.h>
++#include <linux/errno.h>
++#include <linux/i2c.h>
++#include <linux/delay.h>
++#include <linux/string.h>
++#include <linux/platform_device.h>
++#include <linux/interrupt.h>
++#include <linux/proc_fs.h>
++#include <linux/types.h>
++#include <asm/coldfire.h>
++#include <asm/mcfsim.h>
++#include <asm/irq.h>
++#include <asm/mcfi2c.h>
++#if defined(CONFIG_M5445X)
++#include <asm/mcf5445x_intc.h>
++#endif
++
++#define IRQ (64+30)
++#define SLAVE_HANDLER_NAME "mcf-i2c slave handler"
++#define	I2C_BUFFER_SIZE	50
++
++/* Structure for storing I2C transfer data */
++struct i2c_buffer {
++	int tx_index;			/* TX index */
++	int rx_index;			/* RX index */
++	u16 length;			/* Length of the buffer in bytes */
++	u8 buf[I2C_BUFFER_SIZE];	/* Data buffer */
++};
++
++struct i2c_buffer i2c_tx_buffer;
++struct i2c_buffer i2c_rx_buffer;
++
++u8 *tx_string = "abcdefghijklmnopqrstuvwxyz0123456789)!@#$%^&*([].";
++
++/*
++ * I2C slave mode interrupt handler
++ *
++ */
++static irqreturn_t i2c_slave_handler(int this_irq, void *dev_id)
++{
++	u8 dummy_read;
++	int tmp_index;
++
++#ifdef DEBUG
++	printk(KERN_INFO "i2c adapter slave mode irq handler.\n");
++#endif
++
++	/* Clear I2C interupt flag */
++	MCF_I2SR = ~MCF_I2SR_IIF;
++
++	/* Check if this device is in Master or Slave Mode. */
++	if (MCF_I2CR & MCF_I2CR_MSTA) {
++		/* Master mode, do nothing here */
++		printk(KERN_INFO "i2c master mode at %s(), do nothing!\n",
++			__func__);
++		return IRQ_NONE;
++	} else {
++		/* Slave Mode - Check if Arbitration Lost. */
++		if (MCF_I2SR & MCF_I2SR_IAL) {
++
++		#ifdef DEBUG
++			printk(KERN_INFO "Arbitration Lost.\n");
++		#endif
++
++			/* Clear IAL bit */
++			MCF_I2SR &= ~MCF_I2SR_IAL;
++
++			/* Arbitration Lost -
++			 * Check if this device is being addressed as slave.
++			 *(If not, nothing more needs to be done.)
++			 */
++			if (MCF_I2SR & MCF_I2SR_IAAS) {
++				/* Addressed as slave -
++				 * Check if master was reading from slave or
++				 * writing to slave.
++				 */
++				if (MCF_I2SR & MCF_I2SR_SRW) {
++					/* Set tx_index to 0 */
++					if (i2c_tx_buffer.length == 0) {
++						i2c_tx_buffer.length =
++							I2C_BUFFER_SIZE;
++						i2c_tx_buffer.tx_index = 0;
++					}
++
++					/* Master was reading from slave -
++					 * Set Transmit Mode.
++					 */
++					MCF_I2CR |= MCF_I2CR_MTX;
++
++					/* Write data to MBDR. */
++					tmp_index = i2c_tx_buffer.tx_index++;
++					MCF_I2DR = i2c_tx_buffer.buf[tmp_index];
++					i2c_tx_buffer.length--;
++
++				#ifdef DEBUG
++					printk(KERN_INFO "Arbitration Lost: "
++						"Addressed as slave - "
++						"TX mode.\n");
++				#endif
++				} else {
++					/* Set rx_index to 0 */
++					i2c_rx_buffer.rx_index = 0;
++
++					/* Master was writing to slave -
++					Set Receive Mode. */
++					MCF_I2CR &= ~MCF_I2CR_MTX;
++
++					/* Dummy read from MBDR, to clear
++					the ICF bit. */
++					dummy_read = MCF_I2DR;
++
++				#ifdef DEBUG
++					printk(KERN_INFO "Arbitration Lost: "
++						"Addressed as slave - "
++						"RX mode.\n");
++				#endif
++				}
++			}
++
++		} else {
++			/* Arbitration Not Lost - Check if data byte is this
++			devices's Slave Address byte. */
++			if (MCF_I2SR & MCF_I2SR_IAAS) {
++				/* Data byte is Slave Address byte -
++				Check Slave Read/Write bit. */
++				if (MCF_I2SR & MCF_I2SR_SRW) {
++					/* Set tx_index to 0 */
++					if (i2c_tx_buffer.length == 0) {
++						i2c_tx_buffer.length =
++							I2C_BUFFER_SIZE;
++						i2c_tx_buffer.tx_index = 0;
++					}
++
++					/* Master was reading from slave -
++					Set Transmit Mode. */
++					MCF_I2CR |= MCF_I2CR_MTX;
++
++					/* Write data to MBDR. */
++					tmp_index = i2c_tx_buffer.tx_index++;
++					MCF_I2DR = i2c_tx_buffer.buf[tmp_index];
++					i2c_tx_buffer.length--;
++
++				#ifdef DEBUG
++					tmp_index = i2c_tx_buffer.tx_index - 1;
++					printk(KERN_INFO "Slave TX: First byte"
++						" - 0x%02X\n",
++						i2c_tx_buffer.buf[tmp_index]);
++				#endif
++				} else {
++					/* Master has specified Slave Receive
++					Mode. Set Receive Mode. (Writing to
++					MBCR clears IAAS.) */
++
++					/* Set rx_index to 0 */
++					i2c_rx_buffer.rx_index = 0;
++
++					MCF_I2CR &= ~MCF_I2CR_MTX;
++
++					/* Dummy read from MBDR, to clear
++					the ICF bit. */
++					dummy_read = MCF_I2DR;
++
++				#ifdef DEBUG
++					printk(KERN_INFO "Slave RX: Receive "
++						"address.\n");
++				#endif
++				}
++			} else {
++				/* Data byte received is not Slave Address byte
++				Check if this device is in Transmit or
++				Receive Mode. */
++				if (MCF_I2CR & MCF_I2CR_MTX) {
++					/* Last byte received? */
++					if (MCF_I2SR & MCF_I2SR_RXAK) {
++						MCF_I2CR &= ~MCF_I2CR_MTX;
++						dummy_read = MCF_I2DR;
++
++					#ifdef DEBUG
++						printk(KERN_INFO "Slave TX: "
++							"Last byte has been "
++							"sent.\n");
++					#endif
++					} else {
++						/* Write data to MBDR. */
++						tmp_index =
++						i2c_tx_buffer.tx_index++;
++						MCF_I2DR =
++						i2c_tx_buffer.buf[tmp_index];
++						i2c_tx_buffer.length--;
++
++						if (i2c_tx_buffer.length == 0) {
++							i2c_tx_buffer.length =
++								I2C_BUFFER_SIZE;
++							i2c_tx_buffer.tx_index =
++									0;
++						}
++
++					}
++				} else {
++					/* Receive Mode - Read data from
++						MBDR and store it. */
++					tmp_index = i2c_rx_buffer.rx_index++;
++					i2c_rx_buffer.buf[tmp_index] = MCF_I2DR;
++					i2c_rx_buffer.length++;
++				}
++			}
++		}
++		return IRQ_HANDLED;
++	}
++}
++
++#ifdef CONFIG_PROC_FS
++
++/*
++ *	Info exported via "/proc/driver/i2c".
++ */
++
++static int gen_i2c_proc_output(char *buf)
++{
++	char *p;
++
++	p = buf;
++	p += sprintf(p,
++		     "I2CR: 0x%x\n"
++		     "I2SR: 0x%x\n"
++		     "I2DR: 0x%x\n",
++		     MCF_I2CR, MCF_I2SR, MCF_I2DR);
++
++	return p - buf;
++}
++
++static int gen_i2c_read_proc(char *page, char **start, off_t off,
++			     int count, int *eof, void *data)
++{
++	int len = gen_i2c_proc_output(page);
++	if (len <= off+count)
++		*eof = 1;
++	*start = page + off;
++	len -= off;
++	if (len > count)
++		len = count;
++	if (len < 0)
++		len = 0;
++	return len;
++}
++
++static int __init gen_i2c_proc_init(void)
++{
++	struct proc_dir_entry *r;
++
++	r = create_proc_read_entry("driver/i2c-adaptor-register", 0, NULL,
++				gen_i2c_read_proc, NULL);
++	if (!r)
++		return -ENOMEM;
++	return 0;
++}
++#else
++static inline int gen_i2c_proc_init(void) { return 0; }
++#endif /* CONFIG_PROC_FS */
++
++/*
++ *  Initalize I2C module
++ */
++static int __init i2c_coldfire_init(void)
++{
++	int retval;
++	u8  dummy_read;
++
++#ifdef DEBUG
++	printk(KERN_INFO "init i2c adaptor slave mode!\n");
++#endif
++
++	/* Initialize the tx buffer */
++	strcpy((char *)&i2c_tx_buffer.buf, (const char *)tx_string);
++	i2c_tx_buffer.length = I2C_BUFFER_SIZE;
++
++#if defined(CONFIG_M5445X)
++	/*
++	 * Initialize the GPIOs for I2C
++	 */
++	MCF_GPIO_PAR_FECI2C |= (0
++			| MCF_GPIO_PAR_FECI2C_PAR_SDA(3)
++			| MCF_GPIO_PAR_FECI2C_PAR_SCL(3));
++#endif
++
++	/* Set transmission frequency 0x19 = ~100kHz */
++	MCF_I2FDR = 0x19;
++
++	/* set the I2C slave address */
++	MCF_I2AR = 0x6A;
++
++	/* Enable I2C module and if IBB is set, do the special initialzation */
++	/* procedures as are documented */
++
++	if ((MCF_I2SR & MCF_I2SR_IBB) == 1) {
++		printk(KERN_INFO "%s - do special I2C init procedures\n",
++			__func__);
++		MCF_I2CR = 0x00;
++		MCF_I2CR = 0xA0;
++		dummy_read = MCF_I2DR;
++		MCF_I2SR = 0x00;
++		MCF_I2CR = 0x00;
++	}
++
++	MCF_I2CR |= (MCF_I2CR_IEN  | MCF_I2CR_IIEN);
++
++	/* default I2C mode is - slave and receive */
++	MCF_I2CR &= ~(MCF_I2CR_MSTA | MCF_I2CR_MTX);
++
++	retval = request_irq(IRQ, i2c_slave_handler, IRQF_DISABLED,
++			     SLAVE_HANDLER_NAME, NULL);
++	if (retval < 0)
++		printk(KERN_INFO "request_irq for i2c slave mode failed!\n");
++
++	retval = gen_i2c_proc_init();
++
++	if (retval < 0)
++		printk(KERN_INFO "gen /proc/i2c-adaptor-register for i2c slave mode failed!\n");
++
++	return retval;
++};
++
++/*
++ *  I2C module exit function
++ */
++
++static void __exit i2c_coldfire_exit(void)
++{
++	/* disable I2C and Interrupt */
++	MCF_I2CR &= ~(MCF_I2CR_IEN | MCF_I2CR_IIEN);
++	free_irq(IRQ, NULL);
++
++};
++
++MODULE_DESCRIPTION("MCF5445x I2C adaptor slave mode support");
++MODULE_LICENSE("GPL");
++
++module_init(i2c_coldfire_init);
++module_exit(i2c_coldfire_exit);
+--- /dev/null
++++ b/drivers/i2c/busses/i2c-mcf.c
+@@ -0,0 +1,698 @@
++/*
++ * Copyright (C) 2009-2011 Freescale Semiconductor, Inc. All Rights Reserved.
++ * Lanttor.Guo@freescale.com
++ *
++ * I2C bus driver on mcfv4/mcfv4e platform
++ *
++ * 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.
++ */
++#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 <linux/io.h>
++#include <linux/proc_fs.h>
++
++#include <asm/coldfire.h>
++#include <asm/mcfi2c.h>
++
++#if defined(CONFIG_M547X_8X)
++#include <asm/m5485sim.h>
++#elif defined(CONFIG_M5445X) || defined(CONFIG_M5441X)
++#include <asm/mcfsim.h>
++#endif
++
++#define get_clock(adap) (clock)
++#define get_own(adap)	(own)
++
++#if defined(CONFIG_M547X_8X)
++static int clock = 0x3b;
++#elif defined(CONFIG_M5445X) || defined(CONFIG_M5441X)
++static int clock = 0x19;
++#endif
++module_param(clock, int, 0);
++MODULE_PARM_DESC(clock,
++	"Set I2C clock in kHz: 400=fast mode (default == 100khz)");
++
++static int own = 0x78;
++module_param(own, int, 0);
++MODULE_PARM_DESC(clock, "Set I2C Master controller address");
++
++static struct i2c_algo_mcf_data i2c_mcf_board_data = {
++	.timeout =	10000,
++};
++
++static struct i2c_adapter i2c_mcf_board_adapter = {
++	.owner = THIS_MODULE,
++	.name = "mcf i2c adapter",
++	.algo_data = &i2c_mcf_board_data,
++	.class = I2C_CLASS_HWMON,
++	.timeout = 100,
++	.retries = 2
++};
++/*
++ *  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 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(100);
++	}
++	printk(KERN_ERR "%s: timeout", __func__);
++	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(100);
++	}
++	printk(KERN_ERR "%s: timeout", __func__);
++	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(10);
++	}
++	printk(KERN_ERR "%s: timeout", __func__);
++	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;
++	MCF_I2CR |= MCF_I2CR_MTX;
++	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 */
++#if defined(CONFIG_M547X_8X)
++	MCF_PAR_FECI2CIRQ |= MCF_PAR_SDA;
++	MCF_PAR_FECI2CIRQ |= MCF_PAR_SCL;
++#elif defined(CONFIG_M5445X)
++	MCF_GPIO_PAR_FECI2C |= (0
++		| MCF_GPIO_PAR_FECI2C_PAR_SDA(3)
++		| MCF_GPIO_PAR_FECI2C_PAR_SCL(3));
++#elif defined(CONFIG_M5441X)
++	MCF_GPIO_PAR_CANI2C =
++		(MCF_GPIO_PAR_CANI2C & MCF_GPIO_PAR_CANI2C_I2C0SCL_MASK) |
++		MCF_GPIO_PAR_CANI2C_I2C0SCL_I2C0SCL;
++	MCF_GPIO_PAR_CANI2C =
++		(MCF_GPIO_PAR_CANI2C & MCF_GPIO_PAR_CANI2C_I2C0SDA_MASK) |
++		MCF_GPIO_PAR_CANI2C_I2C0SDA_I2C0SDA;
++#endif
++
++	/*  Ensure slaves are in idle state */
++	if (MCF_I2SR & MCF_I2SR_IBB) {
++#if defined(CONFIG_M547X_8X)
++		MCF_I2ICR = 0x00;
++		MCF_I2CR  = 0x00;
++		MCF_I2CR  = 0x0A;
++		dummy = MCF_I2DR;
++		MCF_I2SR  = 0x00;
++		MCF_I2CR  = 0x00;
++		MCF_I2ICR = 0x01;
++#elif defined(CONFIG_M5445X) || defined(CONFIG_M5441X)
++		MCF_I2CR = 0x00;
++		MCF_I2CR = 0xA0;
++		dummy = MCF_I2DR;
++		MCF_I2SR = 0x00;
++		MCF_I2CR = 0x00;
++		MCF_I2CR = 0x80;
++#endif
++	}
++
++	/* setup SCL clock */
++	MCF_I2FDR = get_clock(adap);
++
++	/* set slave address */
++	MCF_I2AR = get_own(adap);
++
++	/* enable I2C module */
++#if	defined(CONFIG_M5441X)
++	MCF_I2CR = (MCF_I2CR_IEN | MCF_I2CR_IIEN);
++#else
++	MCF_I2CR = MCF_I2CR_IEN;
++#endif
++}
++
++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) {
++#if defined(CONFIG_M547X_8X)
++		MCF_I2ICR = 0x00;
++		MCF_I2CR  = 0x00;
++		MCF_I2CR  = 0x0A;
++		timeout = MCF_I2DR;
++		MCF_I2SR  = 0x00;
++		MCF_I2CR  = 0x00;
++		MCF_I2ICR = 0x01;
++#elif defined(CONFIG_M5445X) || defined(CONFIG_M5441X)
++		MCF_I2CR = 0x00;
++		MCF_I2CR = 0xA0;
++		timeout = MCF_I2DR;
++		MCF_I2SR = 0x00;
++		MCF_I2CR = 0x00;
++		MCF_I2CR = 0x80;
++#endif
++	}
++
++	/* setup SCL clock */
++	MCF_I2FDR = get_clock(adap);
++	/* set slave address */
++	MCF_I2AR = get_own(adap);
++	/* enable I2C module */
++#if	defined(CONFIG_M5441X)
++	MCF_I2CR = (MCF_I2CR_IEN | MCF_I2CR_IIEN);
++#else
++	MCF_I2CR = MCF_I2CR_IEN;
++#endif
++	MCF_I2CR |= MCF_I2CR_TXAK;
++
++	/* Check for bus busy */
++	wait_for_bb(adap);
++
++	for (i = 0; ret >= 0 && i < num; i++) {
++		if (MCF_I2SR & MCF_I2SR_IBB) {
++#if defined(CONFIG_M547X_8X)
++			MCF_I2ICR = 0x00;
++			MCF_I2CR  = 0x00;
++			MCF_I2CR  = 0x0A;
++			timeout = MCF_I2DR;
++			MCF_I2SR  = 0x00;
++			MCF_I2CR  = 0x00;
++			MCF_I2ICR = 0x01;
++#elif defined(CONFIG_M5445X) || defined(CONFIG_M5441X)
++		MCF_I2CR = 0x00;
++		MCF_I2CR = 0xA0;
++		timeout = MCF_I2DR;
++		MCF_I2SR = 0x00;
++		MCF_I2CR = 0x00;
++		MCF_I2CR = 0x80;
++#endif
++		}
++		/* setup SCL clock */
++		MCF_I2FDR = get_clock(adap);
++		/* set slave address */
++		MCF_I2AR = get_own(adap);
++		/* enable I2C module */
++#if		defined(CONFIG_M5441X)
++		MCF_I2CR = (MCF_I2CR_IEN | MCF_I2CR_IIEN);
++#else
++		MCF_I2CR = MCF_I2CR_IEN;
++#endif
++		MCF_I2CR |= MCF_I2CR_TXAK;
++
++		/* Check for bus busy */
++		wait_for_bb(adap);
++
++		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);
++			}
++		}
++	MCF_I2CR = 0;
++	}
++
++	/* 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);
++
++	i2c_add_numbered_adapter(adap);
++
++	return 0;
++}
++
++static int mcf_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",
++				__func__);
++		return -ENOMEM;
++	}
++	/****************************************************************/
++	platform_set_drvdata(pdev, i2c);
++
++	i2c->adap = &i2c_mcf_board_adapter;
++	i2c->adap->dev.parent = &pdev->dev;
++	i2c->adap->nr = pdev->id;
++	rc = i2c_mcf_add_bus(i2c->adap);
++	if (rc < 0) {
++		printk(KERN_ERR "%s - failed to add adapter\n", __func__);
++		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 mcf_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 mcf_i2c_driver = {
++	.probe	= mcf_i2c_probe,
++	.remove = mcf_i2c_remove,
++	.driver	= {
++		.owner = THIS_MODULE,
++		.name = "mcf-i2c",
++	},
++};
++
++#ifdef CONFIG_PROC_FS
++
++/*
++ *	Info exported via "/proc/driver/i2c".
++ */
++
++static int gen_i2c_proc_output(char *buf)
++{
++	char *p;
++
++	p = buf;
++	p += sprintf(p,
++		     "I2CR: 0x%x\n"
++		     "I2SR: 0x%x\n"
++		     "I2DR: 0x%x\n",
++		     MCF_I2CR, MCF_I2SR, MCF_I2DR);
++
++	return p - buf;
++}
++
++static int gen_i2c_read_proc(char *page, char **start, off_t off,
++			     int count, int *eof, void *data)
++{
++	int len = gen_i2c_proc_output(page);
++	if (len <= off+count)
++		*eof = 1;
++	*start = page + off;
++	len -= off;
++	if (len > count)
++		len = count;
++	if (len < 0)
++		len = 0;
++	return len;
++}
++
++static int __init gen_i2c_proc_init(void)
++{
++	struct proc_dir_entry *r;
++
++	r = create_proc_read_entry("driver/i2c-adaptor-register", 0, NULL,
++				gen_i2c_read_proc, NULL);
++	if (!r)
++		return -ENOMEM;
++	return 0;
++}
++#else
++static inline int gen_i2c_proc_init(void) { return 0; }
++#endif /* CONFIG_PROC_FS */
++
++static int __init coldfire_i2c_init(void)
++{
++	int retval;
++
++	retval = gen_i2c_proc_init();
++	if (retval < 0)
++		printk(KERN_INFO "generate /proc/i2c-adaptor-register "
++				"for i2c master mode failed!\n");
++
++	return platform_driver_register(&mcf_i2c_driver);
++}
++
++static void __exit coldfire_i2c_exit(void)
++{
++	platform_driver_unregister(&mcf_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 MCFV4/MCFV4E processors");
++MODULE_LICENSE("GPL");