i2c-s3c2410.c revision 19820510c504d5ba572959c67a72d913afc187a6
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* linux/drivers/i2c/busses/i2c-s3c2410.c 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 3c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone * Copyright (C) 2004,2005,2009 Simtec Electronics 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Ben Dooks <ben@simtec.co.uk> 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * S3C2410 I2C Controller 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is free software; you can redistribute it and/or modify 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * it under the terms of the GNU General Public License as published by 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the Free Software Foundation; either version 2 of the License, or 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * (at your option) any later version. 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is distributed in the hope that it will be useful, 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but WITHOUT ANY WARRANTY; without even the implied warranty of 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * GNU General Public License for more details. 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * You should have received a copy of the GNU General Public License 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * along with this program; if not, write to the Free Software 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/i2c.h> 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/time.h> 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/interrupt.h> 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/delay.h> 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/err.h> 33d052d1beff706920e82c5d55006b08e256b5df09Russell King#include <linux/platform_device.h> 34f8ce25476d5f12ffa29b885e49c38cd95053437eRussell King#include <linux/clk.h> 3561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#include <linux/cpufreq.h> 365a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 372178218027e4da0608219fae1d02e5c88f4e560dH Hartley Sweeten#include <linux/io.h> 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/irq.h> 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 419498cb79463c9b2abb243a4b0c2ce3ac1853d5b0Ben Dooks#include <plat/regs-iic.h> 429498cb79463c9b2abb243a4b0c2ce3ac1853d5b0Ben Dooks#include <plat/iic.h> 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* i2c controller state */ 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsenum s3c24xx_i2c_state { 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STATE_IDLE, 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STATE_START, 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STATE_READ, 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STATE_WRITE, 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STATE_STOP 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 547d85ccd816535f56880f7dfdb4de056794376b2cBen Dooksenum s3c24xx_i2c_type { 557d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks TYPE_S3C2410, 567d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks TYPE_S3C2440, 577d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks}; 587d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct s3c24xx_i2c { 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spinlock_t lock; 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wait_queue_head_t wait; 62be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks unsigned int suspended:1; 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct i2c_msg *msg; 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int msg_num; 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int msg_idx; 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int msg_ptr; 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 69e00a8cdf325346c531c841ee85c803792db60157Ben Dooks unsigned int tx_setup; 70e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks unsigned int irq; 71e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enum s3c24xx_i2c_state state; 7361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks unsigned long clkrate; 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void __iomem *regs; 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct clk *clk; 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct device *dev; 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct resource *ioarea; 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct i2c_adapter adap; 8061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 8161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#ifdef CONFIG_CPU_FREQ 8261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks struct notifier_block freq_transition; 8361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#endif 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 866a039cabba3ddd556643156ce0a7cd07da456b20Ben Dooks/* default platform data removed, dev should always carry data. */ 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_is2440() 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * return true is this is an s3c2440 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int s3c24xx_i2c_is2440(struct s3c24xx_i2c *i2c) 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct platform_device *pdev = to_platform_device(i2c->dev); 967d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks enum s3c24xx_i2c_type type; 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 987d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks type = platform_get_device_id(pdev)->driver_data; 997d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks return type == TYPE_S3C2440; 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_master_complete 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * complete the message and wake up the caller, using the given return code, 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * or zero to mean ok. 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_master_complete(struct s3c24xx_i2c *i2c, int ret) 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "master_complete %d\n", ret); 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_ptr = 0; 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg = NULL; 1143d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks i2c->msg_idx++; 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_num = 0; 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_idx = ret; 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&i2c->wait); 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_disable_ack(struct s3c24xx_i2c *i2c) 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 1253d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = readl(i2c->regs + S3C2410_IICCON); 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp & ~S3C2410_IICCON_ACKEN, i2c->regs + S3C2410_IICCON); 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_enable_ack(struct s3c24xx_i2c *i2c) 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 1333d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = readl(i2c->regs + S3C2410_IICCON); 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp | S3C2410_IICCON_ACKEN, i2c->regs + S3C2410_IICCON); 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* irq enable/disable functions */ 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_disable_irq(struct s3c24xx_i2c *i2c) 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 1433d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = readl(i2c->regs + S3C2410_IICCON); 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp & ~S3C2410_IICCON_IRQEN, i2c->regs + S3C2410_IICCON); 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_enable_irq(struct s3c24xx_i2c *i2c) 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 1513d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = readl(i2c->regs + S3C2410_IICCON); 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp | S3C2410_IICCON_IRQEN, i2c->regs + S3C2410_IICCON); 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_message_start 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 1593d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks * put the start of a message onto the bus 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1623d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooksstatic void s3c24xx_i2c_message_start(struct s3c24xx_i2c *i2c, 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct i2c_msg *msg) 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int addr = (msg->addr & 0x7f) << 1; 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long stat; 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long iiccon; 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stat = 0; 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stat |= S3C2410_IICSTAT_TXRXEN; 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (msg->flags & I2C_M_RD) { 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stat |= S3C2410_IICSTAT_MASTER_RX; 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr |= 1; 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stat |= S3C2410_IICSTAT_MASTER_TX; 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (msg->flags & I2C_M_REV_DIR_ADDR) 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr ^= 1; 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1813d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks /* todo - check for wether ack wanted or not */ 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_enable_ack(i2c); 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iiccon = readl(i2c->regs + S3C2410_IICCON); 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(stat, i2c->regs + S3C2410_IICSTAT); 1863d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "START: %08lx to IICSTAT, %02x to DS\n", stat, addr); 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeb(addr, i2c->regs + S3C2410_IICDS); 1893d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 190e00a8cdf325346c531c841ee85c803792db60157Ben Dooks /* delay here to ensure the data byte has gotten onto the bus 191e00a8cdf325346c531c841ee85c803792db60157Ben Dooks * before the transaction is started */ 192e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 193e00a8cdf325346c531c841ee85c803792db60157Ben Dooks ndelay(i2c->tx_setup); 194e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "iiccon, %08lx\n", iiccon); 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(iiccon, i2c->regs + S3C2410_IICCON); 1973d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1983d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks stat |= S3C2410_IICSTAT_START; 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(stat, i2c->regs + S3C2410_IICSTAT); 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_stop(struct s3c24xx_i2c *i2c, int ret) 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long iicstat = readl(i2c->regs + S3C2410_IICSTAT); 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "STOP\n"); 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* stop the transfer */ 2093d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks iicstat &= ~S3C2410_IICSTAT_START; 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(iicstat, i2c->regs + S3C2410_IICSTAT); 2113d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->state = STATE_STOP; 2133d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_master_complete(i2c, ret); 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_disable_irq(i2c); 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* helper functions to determine the current state in the set of 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * messages we are sending */ 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* is_lastmsg() 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2233d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks * returns TRUE if the current message is the last in the set 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int is_lastmsg(struct s3c24xx_i2c *i2c) 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return i2c->msg_idx >= (i2c->msg_num - 1); 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* is_msglast 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns TRUE if we this is the last byte in the current message 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int is_msglast(struct s3c24xx_i2c *i2c) 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return i2c->msg_ptr == i2c->msg->len-1; 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* is_msgend 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns TRUE if we reached the end of the current message 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int is_msgend(struct s3c24xx_i2c *i2c) 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return i2c->msg_ptr >= i2c->msg->len; 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25119820510c504d5ba572959c67a72d913afc187a6Huisung Kang/* i2c_s3c_irq_nextbyte 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * process an interrupt and work out what to do 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25619820510c504d5ba572959c67a72d913afc187a6Huisung Kangstatic int i2c_s3c_irq_nextbyte(struct s3c24xx_i2c *i2c, unsigned long iicstat) 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char byte; 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (i2c->state) { 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case STATE_IDLE: 26508882d20932224d5c4500a855a2f4b1216e5f836Harvey Harrison dev_err(i2c->dev, "%s: called in STATE_IDLE\n", __func__); 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case STATE_STOP: 27008882d20932224d5c4500a855a2f4b1216e5f836Harvey Harrison dev_err(i2c->dev, "%s: called in STATE_STOP\n", __func__); 2713d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks s3c24xx_i2c_disable_irq(i2c); 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_ack; 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case STATE_START: 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* last thing we did was send a start condition on the 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * bus, or started a new i2c message 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2783d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 27963f5c2891eae6b4dd0538ef094e5f256d6150d7bBen Dooks if (iicstat & S3C2410_IICSTAT_LASTBIT && 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds !(i2c->msg->flags & I2C_M_IGNORE_NAK)) { 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* ack was not received... */ 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "ack was not received\n"); 28463f5c2891eae6b4dd0538ef094e5f256d6150d7bBen Dooks s3c24xx_i2c_stop(i2c, -ENXIO); 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_ack; 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->msg->flags & I2C_M_RD) 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->state = STATE_READ; 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->state = STATE_WRITE; 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* terminate the transfer if there is nothing to do 29463f5c2891eae6b4dd0538ef094e5f256d6150d7bBen Dooks * as this is used by the i2c probe to find devices. */ 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (is_lastmsg(i2c) && i2c->msg->len == 0) { 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_stop(i2c, 0); 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_ack; 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->state == STATE_READ) 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto prepare_read; 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3043d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks /* fall through to the write state, as we will need to 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * send a byte as well */ 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case STATE_WRITE: 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* we are writing data to the device... check for the 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * end of the message, and if so, work out what to do 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3122709781be6141798162f1089df728fb218a590dfBen Dooks if (!(i2c->msg->flags & I2C_M_IGNORE_NAK)) { 3132709781be6141798162f1089df728fb218a590dfBen Dooks if (iicstat & S3C2410_IICSTAT_LASTBIT) { 3142709781be6141798162f1089df728fb218a590dfBen Dooks dev_dbg(i2c->dev, "WRITE: No Ack\n"); 3152709781be6141798162f1089df728fb218a590dfBen Dooks 3162709781be6141798162f1089df728fb218a590dfBen Dooks s3c24xx_i2c_stop(i2c, -ECONNREFUSED); 3172709781be6141798162f1089df728fb218a590dfBen Dooks goto out_ack; 3182709781be6141798162f1089df728fb218a590dfBen Dooks } 3192709781be6141798162f1089df728fb218a590dfBen Dooks } 3202709781be6141798162f1089df728fb218a590dfBen Dooks 3213d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks retry_write: 3222709781be6141798162f1089df728fb218a590dfBen Dooks 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!is_msgend(i2c)) { 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds byte = i2c->msg->buf[i2c->msg_ptr++]; 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeb(byte, i2c->regs + S3C2410_IICDS); 326e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 327e00a8cdf325346c531c841ee85c803792db60157Ben Dooks /* delay after writing the byte to allow the 328e00a8cdf325346c531c841ee85c803792db60157Ben Dooks * data setup time on the bus, as writing the 329e00a8cdf325346c531c841ee85c803792db60157Ben Dooks * data to the register causes the first bit 330e00a8cdf325346c531c841ee85c803792db60157Ben Dooks * to appear on SDA, and SCL will change as 331e00a8cdf325346c531c841ee85c803792db60157Ben Dooks * soon as the interrupt is acknowledged */ 332e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 333e00a8cdf325346c531c841ee85c803792db60157Ben Dooks ndelay(i2c->tx_setup); 334e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (!is_lastmsg(i2c)) { 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* we need to go to the next i2c message */ 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "WRITE: Next Message\n"); 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_ptr = 0; 3413d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks i2c->msg_idx++; 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg++; 3433d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* check to see if we need to do another message */ 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->msg->flags & I2C_M_NOSTART) { 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->msg->flags & I2C_M_RD) { 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* cannot do this, the controller 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * forces us to send a new START 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * when we change direction */ 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_stop(i2c, -EINVAL); 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto retry_write; 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* send the new start */ 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_message_start(i2c, i2c->msg); 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->state = STATE_START; 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* send stop */ 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_stop(i2c, 0); 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case STATE_READ: 3703d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks /* we have a byte of data in the data register, do 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * something with it, and then work out wether we are 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * going to do any more read/write 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds byte = readb(i2c->regs + S3C2410_IICDS); 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg->buf[i2c->msg_ptr++] = byte; 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3783d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks prepare_read: 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (is_msglast(i2c)) { 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* last byte of buffer */ 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (is_lastmsg(i2c)) 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_disable_ack(i2c); 3843d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (is_msgend(i2c)) { 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* ok, we've read the entire buffer, see if there 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is anything else we need to do */ 3881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (is_lastmsg(i2c)) { 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* last message, send stop and complete */ 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "READ: Send Stop\n"); 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_stop(i2c, 0); 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* go to the next transfer */ 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "READ: Next Transfer\n"); 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_ptr = 0; 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_idx++; 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg++; 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* acknowlegde the IRQ and get back on with the work */ 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_ack: 4103d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks tmp = readl(i2c->regs + S3C2410_IICCON); 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp &= ~S3C2410_IICCON_IRQPEND; 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp, i2c->regs + S3C2410_IICCON); 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out: 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_irq 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * top level IRQ servicing routine 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4227d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t s3c24xx_i2c_irq(int irqno, void *dev_id) 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct s3c24xx_i2c *i2c = dev_id; 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long status; 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = readl(i2c->regs + S3C2410_IICSTAT); 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (status & S3C2410_IICSTAT_ARBITR) { 4313d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks /* deal with arbitration loss */ 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_err(i2c->dev, "deal with arbitration loss\n"); 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->state == STATE_IDLE) { 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "IRQ: error i2c->state == IDLE\n"); 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4383d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks tmp = readl(i2c->regs + S3C2410_IICCON); 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp &= ~S3C2410_IICCON_IRQPEND; 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp, i2c->regs + S3C2410_IICCON); 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4433d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* pretty much this leaves us with the fact that we've 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * transmitted or received whatever byte we last sent */ 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 44719820510c504d5ba572959c67a72d913afc187a6Huisung Kang i2c_s3c_irq_nextbyte(i2c, status); 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out: 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return IRQ_HANDLED; 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_set_master 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * get the i2c bus for a master transaction 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int s3c24xx_i2c_set_master(struct s3c24xx_i2c *i2c) 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long iicstat; 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int timeout = 400; 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (timeout-- > 0) { 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iicstat = readl(i2c->regs + S3C2410_IICSTAT); 4663d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(iicstat & S3C2410_IICSTAT_BUSBUSY)) 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msleep(1); 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ETIMEDOUT; 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_doxfer 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * this starts an i2c transfer 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4813d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooksstatic int s3c24xx_i2c_doxfer(struct s3c24xx_i2c *i2c, 4823d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks struct i2c_msg *msgs, int num) 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4841bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown unsigned long iicstat, timeout; 4851bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown int spins = 20; 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 488be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks if (i2c->suspended) 48961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks return -EIO; 49061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = s3c24xx_i2c_set_master(i2c); 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret != 0) { 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_err(i2c->dev, "cannot get bus (error %d)\n", ret); 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -EAGAIN; 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&i2c->lock); 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg = msgs; 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_num = num; 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_ptr = 0; 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_idx = 0; 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->state = STATE_START; 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_enable_irq(i2c); 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_message_start(i2c, msgs); 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&i2c->lock); 5093d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timeout = wait_event_timeout(i2c->wait, i2c->msg_num == 0, HZ * 5); 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = i2c->msg_idx; 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5143d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks /* having these next two as dev_err() makes life very 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * noisy when doing an i2cdetect */ 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (timeout == 0) 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "timeout\n"); 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (ret != num) 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "incomplete xfer (%d)\n", ret); 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* ensure the stop has been through the bus */ 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5241bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown dev_dbg(i2c->dev, "waiting for bus idle\n"); 5251bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown 5261bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown /* first, try busy waiting briefly */ 5271bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown do { 5281bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown iicstat = readl(i2c->regs + S3C2410_IICSTAT); 5291bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown } while ((iicstat & S3C2410_IICSTAT_START) && --spins); 5301bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown 5311bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown /* if that timed out sleep */ 5321bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown if (!spins) { 5331bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown msleep(1); 5341bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown iicstat = readl(i2c->regs + S3C2410_IICSTAT); 5351bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown } 5361bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown 5371bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown if (iicstat & S3C2410_IICSTAT_START) 5381bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown dev_warn(i2c->dev, "timeout waiting for bus idle\n"); 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out: 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_xfer 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * first port of call from the i2c bus code when an message needs 54744bbe87e9017efa050bb1b506c6822f1f3bb94d7Steven Cole * transferring across the i2c bus. 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int s3c24xx_i2c_xfer(struct i2c_adapter *adap, 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct i2c_msg *msgs, int num) 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct s3c24xx_i2c *i2c = (struct s3c24xx_i2c *)adap->algo_data; 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int retry; 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 557d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_enable(i2c->clk); 558d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (retry = 0; retry < adap->retries; retry++) { 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = s3c24xx_i2c_doxfer(i2c, msgs, num); 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 563d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard if (ret != -EAGAIN) { 564d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_disable(i2c->clk); 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 566d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard } 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "Retrying transmission (%d)\n", retry); 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(100); 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 573d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_disable(i2c->clk); 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EREMOTEIO; 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* declare our i2c functionality */ 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic u32 s3c24xx_i2c_func(struct i2c_adapter *adap) 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL | I2C_FUNC_PROTOCOL_MANGLING; 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* i2c bus registration info */ 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5858f9082c5ce0e2c2f7ad0211b0c089f680d2efc11Jean Delvarestatic const struct i2c_algorithm s3c24xx_i2c_algorithm = { 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .master_xfer = s3c24xx_i2c_xfer, 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .functionality = s3c24xx_i2c_func, 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_calcdivisor 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * return the divisor settings for a given frequency 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int s3c24xx_i2c_calcdivisor(unsigned long clkin, unsigned int wanted, 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int *div1, unsigned int *divs) 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int calc_divs = clkin / wanted; 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int calc_div1; 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (calc_divs > (16*16)) 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_div1 = 512; 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_div1 = 16; 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_divs += calc_div1-1; 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_divs /= calc_div1; 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (calc_divs == 0) 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_divs = 1; 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (calc_divs > 17) 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_divs = 17; 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *divs = calc_divs; 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *div1 = calc_div1; 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return clkin / (calc_divs * calc_div1); 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 62061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks/* s3c24xx_i2c_clockrate 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * work out a divisor for the user requested frequency setting, 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * either by the requested frequency, or scanning the acceptable 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * range of frequencies until something is found 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 62761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic int s3c24xx_i2c_clockrate(struct s3c24xx_i2c *i2c, unsigned int *got) 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6296a039cabba3ddd556643156ce0a7cd07da456b20Ben Dooks struct s3c2410_platform_i2c *pdata = i2c->dev->platform_data; 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long clkin = clk_get_rate(i2c->clk); 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int divs, div1; 632c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone unsigned long target_frequency; 63361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks u32 iiccon; 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int freq; 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 63661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks i2c->clkrate = clkin; 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clkin /= 1000; /* clkin now in KHz */ 6383d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 639c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone dev_dbg(i2c->dev, "pdata desired frequency %lu\n", pdata->frequency); 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 641c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone target_frequency = pdata->frequency ? pdata->frequency : 100000; 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 643c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone target_frequency /= 1000; /* Target frequency now in KHz */ 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 645c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone freq = s3c24xx_i2c_calcdivisor(clkin, target_frequency, &div1, &divs); 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 647c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone if (freq > target_frequency) { 648c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone dev_err(i2c->dev, 649c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone "Unable to achieve desired frequency %luKHz." \ 650c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone " Lowest achievable %dKHz\n", target_frequency, freq); 651c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone return -EINVAL; 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *got = freq; 65561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 65661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks iiccon = readl(i2c->regs + S3C2410_IICCON); 65761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks iiccon &= ~(S3C2410_IICCON_SCALEMASK | S3C2410_IICCON_TXDIV_512); 65861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks iiccon |= (divs-1); 65961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 66061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks if (div1 == 512) 66161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks iiccon |= S3C2410_IICCON_TXDIV_512; 66261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 66361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks writel(iiccon, i2c->regs + S3C2410_IICCON); 66461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 665a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks if (s3c24xx_i2c_is2440(i2c)) { 666a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks unsigned long sda_delay; 667a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks 668a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks if (pdata->sda_delay) { 6697031307aefb6048377385dbb0af2dd43bb0190bbMyungJoo Ham sda_delay = clkin * pdata->sda_delay; 6707031307aefb6048377385dbb0af2dd43bb0190bbMyungJoo Ham sda_delay = DIV_ROUND_UP(sda_delay, 1000000); 671a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks sda_delay = DIV_ROUND_UP(sda_delay, 5); 672a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks if (sda_delay > 3) 673a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks sda_delay = 3; 674a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks sda_delay |= S3C2410_IICLC_FILTER_ON; 675a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks } else 676a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks sda_delay = 0; 677a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks 678a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks dev_dbg(i2c->dev, "IICLC=%08lx\n", sda_delay); 679a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks writel(sda_delay, i2c->regs + S3C2440_IICLC); 680a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks } 681a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks 68261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks return 0; 68361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks} 68461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 68561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#ifdef CONFIG_CPU_FREQ 68661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 68761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#define freq_to_i2c(_n) container_of(_n, struct s3c24xx_i2c, freq_transition) 68861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 68961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic int s3c24xx_i2c_cpufreq_transition(struct notifier_block *nb, 69061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks unsigned long val, void *data) 69161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks{ 69261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks struct s3c24xx_i2c *i2c = freq_to_i2c(nb); 69361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks unsigned long flags; 69461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks unsigned int got; 69561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks int delta_f; 69661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks int ret; 69761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 69861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks delta_f = clk_get_rate(i2c->clk) - i2c->clkrate; 69961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 70061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks /* if we're post-change and the input clock has slowed down 70161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks * or at pre-change and the clock is about to speed up, then 70261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks * adjust our clock rate. <0 is slow, >0 speedup. 70361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks */ 70461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 70561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks if ((val == CPUFREQ_POSTCHANGE && delta_f < 0) || 70661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks (val == CPUFREQ_PRECHANGE && delta_f > 0)) { 70761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks spin_lock_irqsave(&i2c->lock, flags); 70861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks ret = s3c24xx_i2c_clockrate(i2c, &got); 70961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks spin_unlock_irqrestore(&i2c->lock, flags); 71061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 71161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks if (ret < 0) 71261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks dev_err(i2c->dev, "cannot find frequency\n"); 71361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks else 71461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks dev_info(i2c->dev, "setting freq %d\n", got); 71561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks } 71661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 72061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic inline int s3c24xx_i2c_register_cpufreq(struct s3c24xx_i2c *i2c) 72161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks{ 72261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks i2c->freq_transition.notifier_call = s3c24xx_i2c_cpufreq_transition; 72361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 72461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks return cpufreq_register_notifier(&i2c->freq_transition, 72561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks CPUFREQ_TRANSITION_NOTIFIER); 72661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks} 72761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 72861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic inline void s3c24xx_i2c_deregister_cpufreq(struct s3c24xx_i2c *i2c) 72961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks{ 73061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks cpufreq_unregister_notifier(&i2c->freq_transition, 73161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks CPUFREQ_TRANSITION_NOTIFIER); 73261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks} 73361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 73461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#else 73561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic inline int s3c24xx_i2c_register_cpufreq(struct s3c24xx_i2c *i2c) 73661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks{ 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 74061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic inline void s3c24xx_i2c_deregister_cpufreq(struct s3c24xx_i2c *i2c) 74161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks{ 74261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks} 74361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#endif 74461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_init 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 7473d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks * initialise the controller, set the IO lines and frequency 7481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int s3c24xx_i2c_init(struct s3c24xx_i2c *i2c) 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long iicon = S3C2410_IICCON_IRQEN | S3C2410_IICCON_ACKEN; 7531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct s3c2410_platform_i2c *pdata; 7541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int freq; 7551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* get the plafrom data */ 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7586a039cabba3ddd556643156ce0a7cd07da456b20Ben Dooks pdata = i2c->dev->platform_data; 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* inititalise the gpio */ 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7628be310a6dea491b28f81672752d9d2c7fc25cdd3Ben Dooks if (pdata->cfg_gpio) 7638be310a6dea491b28f81672752d9d2c7fc25cdd3Ben Dooks pdata->cfg_gpio(to_platform_device(i2c->dev)); 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* write slave address */ 7663d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeb(pdata->slave_addr, i2c->regs + S3C2410_IICADD); 7681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_info(i2c->dev, "slave address 0x%02x\n", pdata->slave_addr); 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 77161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks writel(iicon, i2c->regs + S3C2410_IICCON); 77261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* we need to work out the divisors for the clock... */ 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 77561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks if (s3c24xx_i2c_clockrate(i2c, &freq) != 0) { 77661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks writel(0, i2c->regs + S3C2410_IICCON); 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_err(i2c->dev, "cannot meet bus frequency required\n"); 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* todo - check that the i2c lines aren't being dragged anywhere */ 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_info(i2c->dev, "bus frequency set to %d KHz\n", freq); 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "S3C2410_IICCON=0x%02lx\n", iicon); 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_probe 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called by the bus driver when a suitable device is found 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7943ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell Kingstatic int s3c24xx_i2c_probe(struct platform_device *pdev) 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 796692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks struct s3c24xx_i2c *i2c; 797399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks struct s3c2410_platform_i2c *pdata; 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct resource *res; 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8016a039cabba3ddd556643156ce0a7cd07da456b20Ben Dooks pdata = pdev->dev.platform_data; 8026a039cabba3ddd556643156ce0a7cd07da456b20Ben Dooks if (!pdata) { 8036a039cabba3ddd556643156ce0a7cd07da456b20Ben Dooks dev_err(&pdev->dev, "no platform data\n"); 8046a039cabba3ddd556643156ce0a7cd07da456b20Ben Dooks return -EINVAL; 8056a039cabba3ddd556643156ce0a7cd07da456b20Ben Dooks } 806399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks 807692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c = kzalloc(sizeof(struct s3c24xx_i2c), GFP_KERNEL); 808692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks if (!i2c) { 809692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks dev_err(&pdev->dev, "no memory for state\n"); 810692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks return -ENOMEM; 811692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks } 812692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks 813692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks strlcpy(i2c->adap.name, "s3c2410-i2c", sizeof(i2c->adap.name)); 814692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c->adap.owner = THIS_MODULE; 815692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c->adap.algo = &s3c24xx_i2c_algorithm; 816692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c->adap.retries = 2; 817692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c->adap.class = I2C_CLASS_HWMON | I2C_CLASS_SPD; 818692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c->tx_setup = 50; 819692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks 820692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks spin_lock_init(&i2c->lock); 821692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks init_waitqueue_head(&i2c->wait); 822399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks 8231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* find the clock and enable it */ 8241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8253ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King i2c->dev = &pdev->dev; 8263ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King i2c->clk = clk_get(&pdev->dev, "i2c"); 8271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (IS_ERR(i2c->clk)) { 8283ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "cannot get clock\n"); 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENOENT; 8305b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_noclk; 8311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8333ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_dbg(&pdev->dev, "clock source %p\n", i2c->clk); 8341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clk_enable(i2c->clk); 8361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* map the registers */ 8381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 8401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (res == NULL) { 8413ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "cannot find IO resource\n"); 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENOENT; 8435b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_clk; 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 846933a2aec8d08cda11c4b427ea7930b0e92eb9bc8Ben Dooks i2c->ioarea = request_mem_region(res->start, resource_size(res), 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pdev->name); 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->ioarea == NULL) { 8503ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "cannot request IO\n"); 8511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENXIO; 8525b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_clk; 8531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 855933a2aec8d08cda11c4b427ea7930b0e92eb9bc8Ben Dooks i2c->regs = ioremap(res->start, resource_size(res)); 8561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->regs == NULL) { 8583ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "cannot map IO\n"); 8591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENXIO; 8605b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_ioarea; 8611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8633d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks dev_dbg(&pdev->dev, "registers %p (%p, %p)\n", 8643d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks i2c->regs, i2c->ioarea, res); 8651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* setup info block for the i2c core */ 8671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->adap.algo_data = i2c; 8693ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King i2c->adap.dev.parent = &pdev->dev; 8701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* initialise the i2c controller */ 8721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = s3c24xx_i2c_init(i2c); 8741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret != 0) 8755b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_iomap; 8761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* find the IRQ for this unit (note, this relies on the init call to 8783d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks * ensure no current IRQs pending 8791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 881e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks i2c->irq = ret = platform_get_irq(pdev, 0); 882e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks if (ret <= 0) { 8833ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "cannot find IRQ\n"); 8845b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_iomap; 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 887e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks ret = request_irq(i2c->irq, s3c24xx_i2c_irq, IRQF_DISABLED, 888e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks dev_name(&pdev->dev), i2c); 8891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret != 0) { 891e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks dev_err(&pdev->dev, "cannot claim IRQ %d\n", i2c->irq); 8925b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_iomap; 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 89561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks ret = s3c24xx_i2c_register_cpufreq(i2c); 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret < 0) { 89761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks dev_err(&pdev->dev, "failed to register cpufreq notifier\n"); 8985b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_irq; 8991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 901399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks /* Note, previous versions of the driver used i2c_add_adapter() 902399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks * to add the bus at any number. We now pass the bus number via 903399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks * the platform data, so if unset it will now default to always 904399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks * being bus 0. 905399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks */ 906399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks 907399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks i2c->adap.nr = pdata->bus_num; 908399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks 909399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks ret = i2c_add_numbered_adapter(&i2c->adap); 9101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret < 0) { 9113ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "failed to add bus to i2c core\n"); 91261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks goto err_cpufreq; 9131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9153ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King platform_set_drvdata(pdev, i2c); 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 91722e965c2aeb3e636831c8b28f9d7d8e25199891eJean Delvare dev_info(&pdev->dev, "%s: S3C I2C adapter\n", dev_name(&i2c->adap.dev)); 918d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_disable(i2c->clk); 9195b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks return 0; 9201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 92161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks err_cpufreq: 92261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks s3c24xx_i2c_deregister_cpufreq(i2c); 92361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 9245b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks err_irq: 925e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks free_irq(i2c->irq, i2c); 9265b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 9275b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks err_iomap: 9285b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks iounmap(i2c->regs); 9295b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 9305b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks err_ioarea: 9315b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks release_resource(i2c->ioarea); 9325b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks kfree(i2c->ioarea); 9335b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 9345b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks err_clk: 9355b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks clk_disable(i2c->clk); 9365b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks clk_put(i2c->clk); 9371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9385b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks err_noclk: 939692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks kfree(i2c); 9401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 9411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_remove 9441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 9451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called when device is removed from the bus 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 9471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9483ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell Kingstatic int s3c24xx_i2c_remove(struct platform_device *pdev) 9491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9503ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King struct s3c24xx_i2c *i2c = platform_get_drvdata(pdev); 9515b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 95261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks s3c24xx_i2c_deregister_cpufreq(i2c); 95361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 9545b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks i2c_del_adapter(&i2c->adap); 955e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks free_irq(i2c->irq, i2c); 9565b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 9575b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks clk_disable(i2c->clk); 9585b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks clk_put(i2c->clk); 9595b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 9605b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks iounmap(i2c->regs); 9615b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 9625b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks release_resource(i2c->ioarea); 9635b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks kfree(i2c->ioarea); 964692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks kfree(i2c); 9651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_PM 9706a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Dammstatic int s3c24xx_i2c_suspend_noirq(struct device *dev) 971be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks{ 9726a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm struct platform_device *pdev = to_platform_device(dev); 9736a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm struct s3c24xx_i2c *i2c = platform_get_drvdata(pdev); 9746a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm 975be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks i2c->suspended = 1; 9766a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm 977be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks return 0; 978be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks} 979be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks 9806a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Dammstatic int s3c24xx_i2c_resume(struct device *dev) 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9826a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm struct platform_device *pdev = to_platform_device(dev); 9836a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm struct s3c24xx_i2c *i2c = platform_get_drvdata(pdev); 9849480e307cd88ef09ec9294c7d97ebec18e6d2221Russell King 985be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks i2c->suspended = 0; 986d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_enable(i2c->clk); 987be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks s3c24xx_i2c_init(i2c); 988d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_disable(i2c->clk); 9891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 993471452104b8520337ae2fb48c4e61cd4896e025dAlexey Dobriyanstatic const struct dev_pm_ops s3c24xx_i2c_dev_pm_ops = { 9946a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm .suspend_noirq = s3c24xx_i2c_suspend_noirq, 9956a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm .resume = s3c24xx_i2c_resume, 9966a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm}; 9976a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm 9986a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm#define S3C24XX_DEV_PM_OPS (&s3c24xx_i2c_dev_pm_ops) 9991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 10006a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm#define S3C24XX_DEV_PM_OPS NULL 10011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 10021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* device driver for platform bus bits */ 10041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10057d85ccd816535f56880f7dfdb4de056794376b2cBen Dooksstatic struct platform_device_id s3c24xx_driver_ids[] = { 10067d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks { 10077d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .name = "s3c2410-i2c", 10087d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .driver_data = TYPE_S3C2410, 10097d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks }, { 10107d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .name = "s3c2440-i2c", 10117d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .driver_data = TYPE_S3C2440, 10127d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks }, { }, 10131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 10147d85ccd816535f56880f7dfdb4de056794376b2cBen DooksMODULE_DEVICE_TABLE(platform, s3c24xx_driver_ids); 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10167d85ccd816535f56880f7dfdb4de056794376b2cBen Dooksstatic struct platform_driver s3c24xx_i2c_driver = { 10171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .probe = s3c24xx_i2c_probe, 10181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .remove = s3c24xx_i2c_remove, 10197d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .id_table = s3c24xx_driver_ids, 10203ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King .driver = { 10213ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King .owner = THIS_MODULE, 10227d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .name = "s3c-i2c", 10236a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm .pm = S3C24XX_DEV_PM_OPS, 10243ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King }, 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init i2c_adap_s3c_init(void) 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10297d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks return platform_driver_register(&s3c24xx_i2c_driver); 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 103118dc83a6ea483941fb34293c6805a85bbcf0f718Mark Brownsubsys_initcall(i2c_adap_s3c_init); 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit i2c_adap_s3c_exit(void) 10341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10357d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks platform_driver_unregister(&s3c24xx_i2c_driver); 10361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(i2c_adap_s3c_exit); 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("S3C24XX I2C Bus driver"); 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Ben Dooks, <ben@simtec.co.uk>"); 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 1042