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> 34c62c3ca55e0db52b311b1258ed08bc6c7525195eMark Brown#include <linux/pm_runtime.h> 35f8ce25476d5f12ffa29b885e49c38cd95053437eRussell King#include <linux/clk.h> 3661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#include <linux/cpufreq.h> 375a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 382178218027e4da0608219fae1d02e5c88f4e560dH Hartley Sweeten#include <linux/io.h> 395a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#include <linux/of_i2c.h> 405a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#include <linux/of_gpio.h> 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/irq.h> 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 449498cb79463c9b2abb243a4b0c2ce3ac1853d5b0Ben Dooks#include <plat/regs-iic.h> 459498cb79463c9b2abb243a4b0c2ce3ac1853d5b0Ben Dooks#include <plat/iic.h> 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* i2c controller state */ 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsenum s3c24xx_i2c_state { 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STATE_IDLE, 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STATE_START, 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STATE_READ, 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STATE_WRITE, 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STATE_STOP 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 577d85ccd816535f56880f7dfdb4de056794376b2cBen Dooksenum s3c24xx_i2c_type { 587d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks TYPE_S3C2410, 597d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks TYPE_S3C2440, 607d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks}; 617d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct s3c24xx_i2c { 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spinlock_t lock; 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wait_queue_head_t wait; 65be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks unsigned int suspended:1; 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct i2c_msg *msg; 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int msg_num; 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int msg_idx; 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int msg_ptr; 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 72e00a8cdf325346c531c841ee85c803792db60157Ben Dooks unsigned int tx_setup; 73e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks unsigned int irq; 74e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enum s3c24xx_i2c_state state; 7661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks unsigned long clkrate; 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void __iomem *regs; 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct clk *clk; 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct device *dev; 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct resource *ioarea; 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct i2c_adapter adap; 8361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 844fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham struct s3c2410_platform_i2c *pdata; 855a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham int gpios[2]; 8661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#ifdef CONFIG_CPU_FREQ 8761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks struct notifier_block freq_transition; 8861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#endif 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 916a039cabba3ddd556643156ce0a7cd07da456b20Ben Dooks/* default platform data removed, dev should always carry data. */ 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_is2440() 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * return true is this is an s3c2440 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int s3c24xx_i2c_is2440(struct s3c24xx_i2c *i2c) 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct platform_device *pdev = to_platform_device(i2c->dev); 1017d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks enum s3c24xx_i2c_type type; 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1035a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#ifdef CONFIG_OF 1045a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham if (i2c->dev->of_node) 1055a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham return of_device_is_compatible(i2c->dev->of_node, 1065a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham "samsung,s3c2440-i2c"); 1075a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#endif 1085a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 1097d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks type = platform_get_device_id(pdev)->driver_data; 1107d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks return type == TYPE_S3C2440; 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_master_complete 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * complete the message and wake up the caller, using the given return code, 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * or zero to mean ok. 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_master_complete(struct s3c24xx_i2c *i2c, int ret) 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "master_complete %d\n", ret); 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_ptr = 0; 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg = NULL; 1253d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks i2c->msg_idx++; 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_num = 0; 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_idx = ret; 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&i2c->wait); 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_disable_ack(struct s3c24xx_i2c *i2c) 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 1363d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = readl(i2c->regs + S3C2410_IICCON); 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp & ~S3C2410_IICCON_ACKEN, i2c->regs + S3C2410_IICCON); 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_enable_ack(struct s3c24xx_i2c *i2c) 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 1443d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = readl(i2c->regs + S3C2410_IICCON); 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp | S3C2410_IICCON_ACKEN, i2c->regs + S3C2410_IICCON); 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* irq enable/disable functions */ 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_disable_irq(struct s3c24xx_i2c *i2c) 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 1543d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = readl(i2c->regs + S3C2410_IICCON); 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp & ~S3C2410_IICCON_IRQEN, i2c->regs + S3C2410_IICCON); 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_enable_irq(struct s3c24xx_i2c *i2c) 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 1623d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = readl(i2c->regs + S3C2410_IICCON); 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp | S3C2410_IICCON_IRQEN, i2c->regs + S3C2410_IICCON); 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_message_start 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 1703d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks * put the start of a message onto the bus 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1733d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooksstatic void s3c24xx_i2c_message_start(struct s3c24xx_i2c *i2c, 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct i2c_msg *msg) 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int addr = (msg->addr & 0x7f) << 1; 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long stat; 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long iiccon; 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stat = 0; 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stat |= S3C2410_IICSTAT_TXRXEN; 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (msg->flags & I2C_M_RD) { 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stat |= S3C2410_IICSTAT_MASTER_RX; 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr |= 1; 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stat |= S3C2410_IICSTAT_MASTER_TX; 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (msg->flags & I2C_M_REV_DIR_ADDR) 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr ^= 1; 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1923d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks /* todo - check for wether ack wanted or not */ 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_enable_ack(i2c); 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iiccon = readl(i2c->regs + S3C2410_IICCON); 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(stat, i2c->regs + S3C2410_IICSTAT); 1973d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "START: %08lx to IICSTAT, %02x to DS\n", stat, addr); 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeb(addr, i2c->regs + S3C2410_IICDS); 2003d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 201e00a8cdf325346c531c841ee85c803792db60157Ben Dooks /* delay here to ensure the data byte has gotten onto the bus 202e00a8cdf325346c531c841ee85c803792db60157Ben Dooks * before the transaction is started */ 203e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 204e00a8cdf325346c531c841ee85c803792db60157Ben Dooks ndelay(i2c->tx_setup); 205e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "iiccon, %08lx\n", iiccon); 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(iiccon, i2c->regs + S3C2410_IICCON); 2083d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 2093d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks stat |= S3C2410_IICSTAT_START; 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(stat, i2c->regs + S3C2410_IICSTAT); 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void s3c24xx_i2c_stop(struct s3c24xx_i2c *i2c, int ret) 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long iicstat = readl(i2c->regs + S3C2410_IICSTAT); 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "STOP\n"); 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* stop the transfer */ 2203d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks iicstat &= ~S3C2410_IICSTAT_START; 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(iicstat, i2c->regs + S3C2410_IICSTAT); 2223d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->state = STATE_STOP; 2243d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_master_complete(i2c, ret); 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_disable_irq(i2c); 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* helper functions to determine the current state in the set of 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * messages we are sending */ 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* is_lastmsg() 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2343d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks * returns TRUE if the current message is the last in the set 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int is_lastmsg(struct s3c24xx_i2c *i2c) 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return i2c->msg_idx >= (i2c->msg_num - 1); 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* is_msglast 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns TRUE if we this is the last byte in the current message 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int is_msglast(struct s3c24xx_i2c *i2c) 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return i2c->msg_ptr == i2c->msg->len-1; 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* is_msgend 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns TRUE if we reached the end of the current message 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int is_msgend(struct s3c24xx_i2c *i2c) 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return i2c->msg_ptr >= i2c->msg->len; 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26219820510c504d5ba572959c67a72d913afc187a6Huisung Kang/* i2c_s3c_irq_nextbyte 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * process an interrupt and work out what to do 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26719820510c504d5ba572959c67a72d913afc187a6Huisung Kangstatic int i2c_s3c_irq_nextbyte(struct s3c24xx_i2c *i2c, unsigned long iicstat) 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char byte; 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (i2c->state) { 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case STATE_IDLE: 27608882d20932224d5c4500a855a2f4b1216e5f836Harvey Harrison dev_err(i2c->dev, "%s: called in STATE_IDLE\n", __func__); 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case STATE_STOP: 28008882d20932224d5c4500a855a2f4b1216e5f836Harvey Harrison dev_err(i2c->dev, "%s: called in STATE_STOP\n", __func__); 2813d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks s3c24xx_i2c_disable_irq(i2c); 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_ack; 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case STATE_START: 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* last thing we did was send a start condition on the 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * bus, or started a new i2c message 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2883d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 28963f5c2891eae6b4dd0538ef094e5f256d6150d7bBen Dooks if (iicstat & S3C2410_IICSTAT_LASTBIT && 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds !(i2c->msg->flags & I2C_M_IGNORE_NAK)) { 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* ack was not received... */ 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "ack was not received\n"); 29463f5c2891eae6b4dd0538ef094e5f256d6150d7bBen Dooks s3c24xx_i2c_stop(i2c, -ENXIO); 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_ack; 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->msg->flags & I2C_M_RD) 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->state = STATE_READ; 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->state = STATE_WRITE; 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* terminate the transfer if there is nothing to do 30463f5c2891eae6b4dd0538ef094e5f256d6150d7bBen Dooks * as this is used by the i2c probe to find devices. */ 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (is_lastmsg(i2c) && i2c->msg->len == 0) { 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_stop(i2c, 0); 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_ack; 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->state == STATE_READ) 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto prepare_read; 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3143d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks /* fall through to the write state, as we will need to 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * send a byte as well */ 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case STATE_WRITE: 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* we are writing data to the device... check for the 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * end of the message, and if so, work out what to do 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3222709781be6141798162f1089df728fb218a590dfBen Dooks if (!(i2c->msg->flags & I2C_M_IGNORE_NAK)) { 3232709781be6141798162f1089df728fb218a590dfBen Dooks if (iicstat & S3C2410_IICSTAT_LASTBIT) { 3242709781be6141798162f1089df728fb218a590dfBen Dooks dev_dbg(i2c->dev, "WRITE: No Ack\n"); 3252709781be6141798162f1089df728fb218a590dfBen Dooks 3262709781be6141798162f1089df728fb218a590dfBen Dooks s3c24xx_i2c_stop(i2c, -ECONNREFUSED); 3272709781be6141798162f1089df728fb218a590dfBen Dooks goto out_ack; 3282709781be6141798162f1089df728fb218a590dfBen Dooks } 3292709781be6141798162f1089df728fb218a590dfBen Dooks } 3302709781be6141798162f1089df728fb218a590dfBen Dooks 3313d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks retry_write: 3322709781be6141798162f1089df728fb218a590dfBen Dooks 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!is_msgend(i2c)) { 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds byte = i2c->msg->buf[i2c->msg_ptr++]; 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeb(byte, i2c->regs + S3C2410_IICDS); 336e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 337e00a8cdf325346c531c841ee85c803792db60157Ben Dooks /* delay after writing the byte to allow the 338e00a8cdf325346c531c841ee85c803792db60157Ben Dooks * data setup time on the bus, as writing the 339e00a8cdf325346c531c841ee85c803792db60157Ben Dooks * data to the register causes the first bit 340e00a8cdf325346c531c841ee85c803792db60157Ben Dooks * to appear on SDA, and SCL will change as 341e00a8cdf325346c531c841ee85c803792db60157Ben Dooks * soon as the interrupt is acknowledged */ 342e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 343e00a8cdf325346c531c841ee85c803792db60157Ben Dooks ndelay(i2c->tx_setup); 344e00a8cdf325346c531c841ee85c803792db60157Ben Dooks 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (!is_lastmsg(i2c)) { 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* we need to go to the next i2c message */ 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "WRITE: Next Message\n"); 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_ptr = 0; 3513d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks i2c->msg_idx++; 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg++; 3533d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* check to see if we need to do another message */ 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->msg->flags & I2C_M_NOSTART) { 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->msg->flags & I2C_M_RD) { 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* cannot do this, the controller 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * forces us to send a new START 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * when we change direction */ 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_stop(i2c, -EINVAL); 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto retry_write; 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* send the new start */ 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_message_start(i2c, i2c->msg); 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->state = STATE_START; 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* send stop */ 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_stop(i2c, 0); 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case STATE_READ: 3803d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks /* we have a byte of data in the data register, do 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * something with it, and then work out wether we are 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * going to do any more read/write 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds byte = readb(i2c->regs + S3C2410_IICDS); 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg->buf[i2c->msg_ptr++] = byte; 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3883d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks prepare_read: 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (is_msglast(i2c)) { 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* last byte of buffer */ 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (is_lastmsg(i2c)) 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_disable_ack(i2c); 3943d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (is_msgend(i2c)) { 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* ok, we've read the entire buffer, see if there 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is anything else we need to do */ 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (is_lastmsg(i2c)) { 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* last message, send stop and complete */ 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "READ: Send Stop\n"); 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_stop(i2c, 0); 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* go to the next transfer */ 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "READ: Next Transfer\n"); 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_ptr = 0; 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_idx++; 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg++; 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* acknowlegde the IRQ and get back on with the work */ 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_ack: 4203d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks tmp = readl(i2c->regs + S3C2410_IICCON); 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp &= ~S3C2410_IICCON_IRQPEND; 4221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp, i2c->regs + S3C2410_IICCON); 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out: 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_irq 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * top level IRQ servicing routine 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4327d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t s3c24xx_i2c_irq(int irqno, void *dev_id) 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct s3c24xx_i2c *i2c = dev_id; 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long status; 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long tmp; 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = readl(i2c->regs + S3C2410_IICSTAT); 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (status & S3C2410_IICSTAT_ARBITR) { 4413d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks /* deal with arbitration loss */ 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_err(i2c->dev, "deal with arbitration loss\n"); 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->state == STATE_IDLE) { 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "IRQ: error i2c->state == IDLE\n"); 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4483d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks tmp = readl(i2c->regs + S3C2410_IICCON); 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp &= ~S3C2410_IICCON_IRQPEND; 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(tmp, i2c->regs + S3C2410_IICCON); 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4533d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* pretty much this leaves us with the fact that we've 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * transmitted or received whatever byte we last sent */ 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 45719820510c504d5ba572959c67a72d913afc187a6Huisung Kang i2c_s3c_irq_nextbyte(i2c, status); 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out: 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return IRQ_HANDLED; 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_set_master 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * get the i2c bus for a master transaction 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int s3c24xx_i2c_set_master(struct s3c24xx_i2c *i2c) 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long iicstat; 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int timeout = 400; 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (timeout-- > 0) { 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iicstat = readl(i2c->regs + S3C2410_IICSTAT); 4763d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(iicstat & S3C2410_IICSTAT_BUSBUSY)) 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msleep(1); 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ETIMEDOUT; 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_doxfer 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * this starts an i2c transfer 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4913d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooksstatic int s3c24xx_i2c_doxfer(struct s3c24xx_i2c *i2c, 4923d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks struct i2c_msg *msgs, int num) 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4941bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown unsigned long iicstat, timeout; 4951bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown int spins = 20; 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 498be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks if (i2c->suspended) 49961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks return -EIO; 50061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = s3c24xx_i2c_set_master(i2c); 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret != 0) { 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_err(i2c->dev, "cannot get bus (error %d)\n", ret); 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -EAGAIN; 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&i2c->lock); 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg = msgs; 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_num = num; 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_ptr = 0; 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->msg_idx = 0; 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->state = STATE_START; 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_enable_irq(i2c); 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s3c24xx_i2c_message_start(i2c, msgs); 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&i2c->lock); 5193d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timeout = wait_event_timeout(i2c->wait, i2c->msg_num == 0, HZ * 5); 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = i2c->msg_idx; 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5243d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks /* having these next two as dev_err() makes life very 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * noisy when doing an i2cdetect */ 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (timeout == 0) 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "timeout\n"); 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (ret != num) 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "incomplete xfer (%d)\n", ret); 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* ensure the stop has been through the bus */ 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5341bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown dev_dbg(i2c->dev, "waiting for bus idle\n"); 5351bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown 5361bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown /* first, try busy waiting briefly */ 5371bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown do { 53837de03ea1246c8280f6c8c6f61ea98973e9b9448Mark Brown cpu_relax(); 5391bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown iicstat = readl(i2c->regs + S3C2410_IICSTAT); 5401bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown } while ((iicstat & S3C2410_IICSTAT_START) && --spins); 5411bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown 5421bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown /* if that timed out sleep */ 5431bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown if (!spins) { 5441bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown msleep(1); 5451bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown iicstat = readl(i2c->regs + S3C2410_IICSTAT); 5461bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown } 5471bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown 5481bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown if (iicstat & S3C2410_IICSTAT_START) 5491bc2962e530527de829bf4b1eb99f24dc25d1828Mark Brown dev_warn(i2c->dev, "timeout waiting for bus idle\n"); 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out: 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_xfer 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * first port of call from the i2c bus code when an message needs 55844bbe87e9017efa050bb1b506c6822f1f3bb94d7Steven Cole * transferring across the i2c bus. 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int s3c24xx_i2c_xfer(struct i2c_adapter *adap, 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct i2c_msg *msgs, int num) 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct s3c24xx_i2c *i2c = (struct s3c24xx_i2c *)adap->algo_data; 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int retry; 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 568c62c3ca55e0db52b311b1258ed08bc6c7525195eMark Brown pm_runtime_get_sync(&adap->dev); 569d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_enable(i2c->clk); 570d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (retry = 0; retry < adap->retries; retry++) { 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = s3c24xx_i2c_doxfer(i2c, msgs, num); 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 575d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard if (ret != -EAGAIN) { 576d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_disable(i2c->clk); 577c62c3ca55e0db52b311b1258ed08bc6c7525195eMark Brown pm_runtime_put_sync(&adap->dev); 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 579d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard } 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "Retrying transmission (%d)\n", retry); 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(100); 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 586d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_disable(i2c->clk); 587c62c3ca55e0db52b311b1258ed08bc6c7525195eMark Brown pm_runtime_put_sync(&adap->dev); 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EREMOTEIO; 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* declare our i2c functionality */ 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic u32 s3c24xx_i2c_func(struct i2c_adapter *adap) 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL | I2C_FUNC_PROTOCOL_MANGLING; 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* i2c bus registration info */ 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5998f9082c5ce0e2c2f7ad0211b0c089f680d2efc11Jean Delvarestatic const struct i2c_algorithm s3c24xx_i2c_algorithm = { 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .master_xfer = s3c24xx_i2c_xfer, 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .functionality = s3c24xx_i2c_func, 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_calcdivisor 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * return the divisor settings for a given frequency 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int s3c24xx_i2c_calcdivisor(unsigned long clkin, unsigned int wanted, 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int *div1, unsigned int *divs) 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int calc_divs = clkin / wanted; 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int calc_div1; 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (calc_divs > (16*16)) 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_div1 = 512; 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_div1 = 16; 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_divs += calc_div1-1; 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_divs /= calc_div1; 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (calc_divs == 0) 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_divs = 1; 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (calc_divs > 17) 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds calc_divs = 17; 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *divs = calc_divs; 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *div1 = calc_div1; 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return clkin / (calc_divs * calc_div1); 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 63461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks/* s3c24xx_i2c_clockrate 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * work out a divisor for the user requested frequency setting, 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * either by the requested frequency, or scanning the acceptable 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * range of frequencies until something is found 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 64161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic int s3c24xx_i2c_clockrate(struct s3c24xx_i2c *i2c, unsigned int *got) 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6434fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham struct s3c2410_platform_i2c *pdata = i2c->pdata; 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long clkin = clk_get_rate(i2c->clk); 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int divs, div1; 646c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone unsigned long target_frequency; 64761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks u32 iiccon; 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int freq; 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 65061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks i2c->clkrate = clkin; 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clkin /= 1000; /* clkin now in KHz */ 6523d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 653c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone dev_dbg(i2c->dev, "pdata desired frequency %lu\n", pdata->frequency); 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 655c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone target_frequency = pdata->frequency ? pdata->frequency : 100000; 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 657c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone target_frequency /= 1000; /* Target frequency now in KHz */ 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 659c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone freq = s3c24xx_i2c_calcdivisor(clkin, target_frequency, &div1, &divs); 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 661c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone if (freq > target_frequency) { 662c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone dev_err(i2c->dev, 663c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone "Unable to achieve desired frequency %luKHz." \ 664c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone " Lowest achievable %dKHz\n", target_frequency, freq); 665c564e6ae6c5aa6e3995ff87ed4a32b4788ad5109Daniel Silverstone return -EINVAL; 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *got = freq; 66961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 67061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks iiccon = readl(i2c->regs + S3C2410_IICCON); 67161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks iiccon &= ~(S3C2410_IICCON_SCALEMASK | S3C2410_IICCON_TXDIV_512); 67261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks iiccon |= (divs-1); 67361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 67461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks if (div1 == 512) 67561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks iiccon |= S3C2410_IICCON_TXDIV_512; 67661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 67761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks writel(iiccon, i2c->regs + S3C2410_IICCON); 67861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 679a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks if (s3c24xx_i2c_is2440(i2c)) { 680a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks unsigned long sda_delay; 681a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks 682a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks if (pdata->sda_delay) { 6837031307aefb6048377385dbb0af2dd43bb0190bbMyungJoo Ham sda_delay = clkin * pdata->sda_delay; 6847031307aefb6048377385dbb0af2dd43bb0190bbMyungJoo Ham sda_delay = DIV_ROUND_UP(sda_delay, 1000000); 685a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks sda_delay = DIV_ROUND_UP(sda_delay, 5); 686a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks if (sda_delay > 3) 687a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks sda_delay = 3; 688a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks sda_delay |= S3C2410_IICLC_FILTER_ON; 689a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks } else 690a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks sda_delay = 0; 691a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks 692a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks dev_dbg(i2c->dev, "IICLC=%08lx\n", sda_delay); 693a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks writel(sda_delay, i2c->regs + S3C2440_IICLC); 694a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks } 695a192f7153bb33151f83440cd9c0442233a064bf1Ben Dooks 69661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks return 0; 69761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks} 69861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 69961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#ifdef CONFIG_CPU_FREQ 70061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 70161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#define freq_to_i2c(_n) container_of(_n, struct s3c24xx_i2c, freq_transition) 70261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 70361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic int s3c24xx_i2c_cpufreq_transition(struct notifier_block *nb, 70461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks unsigned long val, void *data) 70561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks{ 70661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks struct s3c24xx_i2c *i2c = freq_to_i2c(nb); 70761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks unsigned long flags; 70861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks unsigned int got; 70961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks int delta_f; 71061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks int ret; 71161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 71261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks delta_f = clk_get_rate(i2c->clk) - i2c->clkrate; 71361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 71461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks /* if we're post-change and the input clock has slowed down 71561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks * or at pre-change and the clock is about to speed up, then 71661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks * adjust our clock rate. <0 is slow, >0 speedup. 71761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks */ 71861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 71961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks if ((val == CPUFREQ_POSTCHANGE && delta_f < 0) || 72061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks (val == CPUFREQ_PRECHANGE && delta_f > 0)) { 72161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks spin_lock_irqsave(&i2c->lock, flags); 72261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks ret = s3c24xx_i2c_clockrate(i2c, &got); 72361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks spin_unlock_irqrestore(&i2c->lock, flags); 72461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 72561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks if (ret < 0) 72661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks dev_err(i2c->dev, "cannot find frequency\n"); 72761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks else 72861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks dev_info(i2c->dev, "setting freq %d\n", got); 72961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks } 73061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 73461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic inline int s3c24xx_i2c_register_cpufreq(struct s3c24xx_i2c *i2c) 73561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks{ 73661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks i2c->freq_transition.notifier_call = s3c24xx_i2c_cpufreq_transition; 73761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 73861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks return cpufreq_register_notifier(&i2c->freq_transition, 73961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks CPUFREQ_TRANSITION_NOTIFIER); 74061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks} 74161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 74261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic inline void s3c24xx_i2c_deregister_cpufreq(struct s3c24xx_i2c *i2c) 74361c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks{ 74461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks cpufreq_unregister_notifier(&i2c->freq_transition, 74561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks CPUFREQ_TRANSITION_NOTIFIER); 74661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks} 74761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 74861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#else 74961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic inline int s3c24xx_i2c_register_cpufreq(struct s3c24xx_i2c *i2c) 75061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks{ 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 75461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooksstatic inline void s3c24xx_i2c_deregister_cpufreq(struct s3c24xx_i2c *i2c) 75561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks{ 75661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks} 75761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks#endif 75861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 7595a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#ifdef CONFIG_OF 7605a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abrahamstatic int s3c24xx_i2c_parse_dt_gpio(struct s3c24xx_i2c *i2c) 7615a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham{ 7625a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham int idx, gpio, ret; 7635a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 7645a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham for (idx = 0; idx < 2; idx++) { 7655a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham gpio = of_get_gpio(i2c->dev->of_node, idx); 7665a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham if (!gpio_is_valid(gpio)) { 7675a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham dev_err(i2c->dev, "invalid gpio[%d]: %d\n", idx, gpio); 7685a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham goto free_gpio; 7695a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham } 7705a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 7715a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham ret = gpio_request(gpio, "i2c-bus"); 7725a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham if (ret) { 7735a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham dev_err(i2c->dev, "gpio [%d] request failed\n", gpio); 7745a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham goto free_gpio; 7755a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham } 7765a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham } 7775a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham return 0; 7785a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 7795a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abrahamfree_gpio: 7805a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham while (--idx >= 0) 7815a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham gpio_free(i2c->gpios[idx]); 7825a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham return -EINVAL; 7835a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham} 7845a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 7855a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abrahamstatic void s3c24xx_i2c_dt_gpio_free(struct s3c24xx_i2c *i2c) 7865a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham{ 7875a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham unsigned int idx; 7885a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham for (idx = 0; idx < 2; idx++) 7895a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham gpio_free(i2c->gpios[idx]); 7905a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham} 7915a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#else 7925a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abrahamstatic int s3c24xx_i2c_parse_dt_gpio(struct s3c24xx_i2c *i2c) 7935a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham{ 7948ebe661dd2ab16e2e9c272ed5c86019c7407b9a1Tushar Behera return 0; 7955a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham} 7965a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 7975a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abrahamstatic void s3c24xx_i2c_dt_gpio_free(struct s3c24xx_i2c *i2c) 7985a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham{ 7995a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham} 8005a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#endif 8015a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 8021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_init 8031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 8043d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks * initialise the controller, set the IO lines and frequency 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int s3c24xx_i2c_init(struct s3c24xx_i2c *i2c) 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long iicon = S3C2410_IICCON_IRQEN | S3C2410_IICCON_ACKEN; 8101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct s3c2410_platform_i2c *pdata; 8111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int freq; 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* get the plafrom data */ 8141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8154fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham pdata = i2c->pdata; 8161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* inititalise the gpio */ 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8198be310a6dea491b28f81672752d9d2c7fc25cdd3Ben Dooks if (pdata->cfg_gpio) 8208be310a6dea491b28f81672752d9d2c7fc25cdd3Ben Dooks pdata->cfg_gpio(to_platform_device(i2c->dev)); 8215a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham else 8225a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham if (s3c24xx_i2c_parse_dt_gpio(i2c)) 8235a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham return -EINVAL; 8241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* write slave address */ 8263d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks 8271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeb(pdata->slave_addr, i2c->regs + S3C2410_IICADD); 8281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_info(i2c->dev, "slave address 0x%02x\n", pdata->slave_addr); 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 83161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks writel(iicon, i2c->regs + S3C2410_IICCON); 83261c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 8331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* we need to work out the divisors for the clock... */ 8341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 83561c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks if (s3c24xx_i2c_clockrate(i2c, &freq) != 0) { 83661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks writel(0, i2c->regs + S3C2410_IICCON); 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_err(i2c->dev, "cannot meet bus frequency required\n"); 8381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 8391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* todo - check that the i2c lines aren't being dragged anywhere */ 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_info(i2c->dev, "bus frequency set to %d KHz\n", freq); 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_dbg(i2c->dev, "S3C2410_IICCON=0x%02lx\n", iicon); 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8495a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#ifdef CONFIG_OF 8505a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham/* s3c24xx_i2c_parse_dt 8515a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham * 8525a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham * Parse the device tree node and retreive the platform data. 8535a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham*/ 8545a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 8555a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abrahamstatic void 8565a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abrahams3c24xx_i2c_parse_dt(struct device_node *np, struct s3c24xx_i2c *i2c) 8575a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham{ 8585a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham struct s3c2410_platform_i2c *pdata = i2c->pdata; 8595a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 8605a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham if (!np) 8615a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham return; 8625a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 8635a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham pdata->bus_num = -1; /* i2c bus number is dynamically assigned */ 8645a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham of_property_read_u32(np, "samsung,i2c-sda-delay", &pdata->sda_delay); 8655a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham of_property_read_u32(np, "samsung,i2c-slave-addr", &pdata->slave_addr); 8665a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham of_property_read_u32(np, "samsung,i2c-max-bus-freq", 8675a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham (u32 *)&pdata->frequency); 8685a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham} 8695a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#else 8705a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abrahamstatic void 8715a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abrahams3c24xx_i2c_parse_dt(struct device_node *np, struct s3c24xx_i2c *i2c) 8725a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham{ 8735a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham return; 8745a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham} 8755a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#endif 8765a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 8771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_probe 8781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 8791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called by the bus driver when a suitable device is found 8801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 8811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8823ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell Kingstatic int s3c24xx_i2c_probe(struct platform_device *pdev) 8831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 884692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks struct s3c24xx_i2c *i2c; 8854fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham struct s3c2410_platform_i2c *pdata = NULL; 8861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct resource *res; 8871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 8881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8895a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham if (!pdev->dev.of_node) { 8905a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham pdata = pdev->dev.platform_data; 8915a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham if (!pdata) { 8925a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham dev_err(&pdev->dev, "no platform data\n"); 8935a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham return -EINVAL; 8945a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham } 8956a039cabba3ddd556643156ce0a7cd07da456b20Ben Dooks } 896399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks 8974ea1557ff7862f63511420395d16647b74ba6f5cMark Brown i2c = devm_kzalloc(&pdev->dev, sizeof(struct s3c24xx_i2c), GFP_KERNEL); 898692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks if (!i2c) { 899692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks dev_err(&pdev->dev, "no memory for state\n"); 900692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks return -ENOMEM; 901692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks } 902692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks 9034fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham i2c->pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); 9044fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham if (!i2c->pdata) { 9054fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham ret = -ENOMEM; 9064fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham goto err_noclk; 9074fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham } 9084fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham 9094fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham if (pdata) 9104fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham memcpy(i2c->pdata, pdata, sizeof(*pdata)); 9115a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham else 9125a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham s3c24xx_i2c_parse_dt(pdev->dev.of_node, i2c); 9134fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham 914692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks strlcpy(i2c->adap.name, "s3c2410-i2c", sizeof(i2c->adap.name)); 915692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c->adap.owner = THIS_MODULE; 916692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c->adap.algo = &s3c24xx_i2c_algorithm; 917692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c->adap.retries = 2; 918692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c->adap.class = I2C_CLASS_HWMON | I2C_CLASS_SPD; 919692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks i2c->tx_setup = 50; 920692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks 921692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks spin_lock_init(&i2c->lock); 922692acbd3a866a9f84e18a5980b3a97ca52e501b2Ben Dooks init_waitqueue_head(&i2c->wait); 923399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks 9241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* find the clock and enable it */ 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9263ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King i2c->dev = &pdev->dev; 9273ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King i2c->clk = clk_get(&pdev->dev, "i2c"); 9281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (IS_ERR(i2c->clk)) { 9293ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "cannot get clock\n"); 9301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENOENT; 9315b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_noclk; 9321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9343ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_dbg(&pdev->dev, "clock source %p\n", i2c->clk); 9351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clk_enable(i2c->clk); 9371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* map the registers */ 9391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 9411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (res == NULL) { 9423ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "cannot find IO resource\n"); 9431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENOENT; 9445b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_clk; 9451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 947933a2aec8d08cda11c4b427ea7930b0e92eb9bc8Ben Dooks i2c->ioarea = request_mem_region(res->start, resource_size(res), 9481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pdev->name); 9491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->ioarea == NULL) { 9513ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "cannot request IO\n"); 9521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENXIO; 9535b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_clk; 9541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 956933a2aec8d08cda11c4b427ea7930b0e92eb9bc8Ben Dooks i2c->regs = ioremap(res->start, resource_size(res)); 9571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i2c->regs == NULL) { 9593ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "cannot map IO\n"); 9601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENXIO; 9615b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_ioarea; 9621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9643d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks dev_dbg(&pdev->dev, "registers %p (%p, %p)\n", 9653d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks i2c->regs, i2c->ioarea, res); 9661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* setup info block for the i2c core */ 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i2c->adap.algo_data = i2c; 9703ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King i2c->adap.dev.parent = &pdev->dev; 9711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* initialise the i2c controller */ 9731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = s3c24xx_i2c_init(i2c); 9751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret != 0) 9765b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_iomap; 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* find the IRQ for this unit (note, this relies on the init call to 9793d0911bfe03b5f077cef32ca644b5756d48affc3Ben Dooks * ensure no current IRQs pending 9801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 982e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks i2c->irq = ret = platform_get_irq(pdev, 0); 983e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks if (ret <= 0) { 9843ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "cannot find IRQ\n"); 9855b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_iomap; 9861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9884311051c358ad0e66b68934e7a33cf10ba533466Yong Zhang ret = request_irq(i2c->irq, s3c24xx_i2c_irq, 0, 989e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks dev_name(&pdev->dev), i2c); 9901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret != 0) { 992e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks dev_err(&pdev->dev, "cannot claim IRQ %d\n", i2c->irq); 9935b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_iomap; 9941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 99661c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks ret = s3c24xx_i2c_register_cpufreq(i2c); 9971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret < 0) { 99861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks dev_err(&pdev->dev, "failed to register cpufreq notifier\n"); 9995b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks goto err_irq; 10001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1002399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks /* Note, previous versions of the driver used i2c_add_adapter() 1003399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks * to add the bus at any number. We now pass the bus number via 1004399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks * the platform data, so if unset it will now default to always 1005399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks * being bus 0. 1006399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks */ 1007399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks 10084fd81eb2d64295ab038a3ea9d44e0eac85a6648cThomas Abraham i2c->adap.nr = i2c->pdata->bus_num; 10095a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham i2c->adap.dev.of_node = pdev->dev.of_node; 1010399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks 1011399dee2371787825a1845de87c0cbee7b7c30ad6Ben Dooks ret = i2c_add_numbered_adapter(&i2c->adap); 10121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret < 0) { 10133ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King dev_err(&pdev->dev, "failed to add bus to i2c core\n"); 101461c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks goto err_cpufreq; 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10175a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham of_i2c_register_devices(&i2c->adap); 10183ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King platform_set_drvdata(pdev, i2c); 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1020c62c3ca55e0db52b311b1258ed08bc6c7525195eMark Brown pm_runtime_enable(&pdev->dev); 1021c62c3ca55e0db52b311b1258ed08bc6c7525195eMark Brown pm_runtime_enable(&i2c->adap.dev); 1022c62c3ca55e0db52b311b1258ed08bc6c7525195eMark Brown 102322e965c2aeb3e636831c8b28f9d7d8e25199891eJean Delvare dev_info(&pdev->dev, "%s: S3C I2C adapter\n", dev_name(&i2c->adap.dev)); 1024d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_disable(i2c->clk); 10255b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks return 0; 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 102761c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks err_cpufreq: 102861c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks s3c24xx_i2c_deregister_cpufreq(i2c); 102961c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 10305b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks err_irq: 1031e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks free_irq(i2c->irq, i2c); 10325b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 10335b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks err_iomap: 10345b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks iounmap(i2c->regs); 10355b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 10365b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks err_ioarea: 10375b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks release_resource(i2c->ioarea); 10385b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks kfree(i2c->ioarea); 10395b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 10405b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks err_clk: 10415b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks clk_disable(i2c->clk); 10425b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks clk_put(i2c->clk); 10431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10445b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks err_noclk: 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* s3c24xx_i2c_remove 10491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 10501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called when device is removed from the bus 10511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 10521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10533ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell Kingstatic int s3c24xx_i2c_remove(struct platform_device *pdev) 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10553ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King struct s3c24xx_i2c *i2c = platform_get_drvdata(pdev); 10565b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 1057c62c3ca55e0db52b311b1258ed08bc6c7525195eMark Brown pm_runtime_disable(&i2c->adap.dev); 1058c62c3ca55e0db52b311b1258ed08bc6c7525195eMark Brown pm_runtime_disable(&pdev->dev); 1059c62c3ca55e0db52b311b1258ed08bc6c7525195eMark Brown 106061c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks s3c24xx_i2c_deregister_cpufreq(i2c); 106161c7cff89224fc5651b5ba5ff2185d19304b2484Ben Dooks 10625b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks i2c_del_adapter(&i2c->adap); 1063e0d1ec97853fa09cf676dc6b51dafd35db12759eBen Dooks free_irq(i2c->irq, i2c); 10645b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 10655b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks clk_disable(i2c->clk); 10665b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks clk_put(i2c->clk); 10675b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 10685b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks iounmap(i2c->regs); 10695b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks 10705b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks release_resource(i2c->ioarea); 10715a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham s3c24xx_i2c_dt_gpio_free(i2c); 10725b68790cd5e2879067bcbc45b01eeb6081e7d731Ben Dooks kfree(i2c->ioarea); 10731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 10751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_PM 10786a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Dammstatic int s3c24xx_i2c_suspend_noirq(struct device *dev) 1079be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks{ 10806a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm struct platform_device *pdev = to_platform_device(dev); 10816a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm struct s3c24xx_i2c *i2c = platform_get_drvdata(pdev); 10826a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm 1083be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks i2c->suspended = 1; 10846a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm 1085be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks return 0; 1086be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks} 1087be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks 10886a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Dammstatic int s3c24xx_i2c_resume(struct device *dev) 10891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10906a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm struct platform_device *pdev = to_platform_device(dev); 10916a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm struct s3c24xx_i2c *i2c = platform_get_drvdata(pdev); 10929480e307cd88ef09ec9294c7d97ebec18e6d2221Russell King 1093be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks i2c->suspended = 0; 1094d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_enable(i2c->clk); 1095be44f01e8af3862767f466f89c12640a2f2b0038Ben Dooks s3c24xx_i2c_init(i2c); 1096d2360b8e845ce0e142e72697a504ee9372421dc3Arnaud Patard clk_disable(i2c->clk); 10971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 10991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1101471452104b8520337ae2fb48c4e61cd4896e025dAlexey Dobriyanstatic const struct dev_pm_ops s3c24xx_i2c_dev_pm_ops = { 11026a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm .suspend_noirq = s3c24xx_i2c_suspend_noirq, 11036a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm .resume = s3c24xx_i2c_resume, 11046a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm}; 11056a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm 11066a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm#define S3C24XX_DEV_PM_OPS (&s3c24xx_i2c_dev_pm_ops) 11071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 11086a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm#define S3C24XX_DEV_PM_OPS NULL 11091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 11101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* device driver for platform bus bits */ 11121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11137d85ccd816535f56880f7dfdb4de056794376b2cBen Dooksstatic struct platform_device_id s3c24xx_driver_ids[] = { 11147d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks { 11157d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .name = "s3c2410-i2c", 11167d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .driver_data = TYPE_S3C2410, 11177d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks }, { 11187d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .name = "s3c2440-i2c", 11197d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .driver_data = TYPE_S3C2440, 11207d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks }, { }, 11211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 11227d85ccd816535f56880f7dfdb4de056794376b2cBen DooksMODULE_DEVICE_TABLE(platform, s3c24xx_driver_ids); 11231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11245a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#ifdef CONFIG_OF 11255a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abrahamstatic const struct of_device_id s3c24xx_i2c_match[] = { 11265a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham { .compatible = "samsung,s3c2410-i2c" }, 11275a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham { .compatible = "samsung,s3c2440-i2c" }, 11285a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham {}, 11295a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham}; 11305a5f50802f5a31b9e15de8df40d5621af970a560Thomas AbrahamMODULE_DEVICE_TABLE(of, s3c24xx_i2c_match); 11315a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#else 11325a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#define s3c24xx_i2c_match NULL 11335a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham#endif 11345a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham 11357d85ccd816535f56880f7dfdb4de056794376b2cBen Dooksstatic struct platform_driver s3c24xx_i2c_driver = { 11361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .probe = s3c24xx_i2c_probe, 11371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .remove = s3c24xx_i2c_remove, 11387d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .id_table = s3c24xx_driver_ids, 11393ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King .driver = { 11403ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King .owner = THIS_MODULE, 11417d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks .name = "s3c-i2c", 11426a6c6189b1fef97de9b8b936131fe2085ac42a5aMagnus Damm .pm = S3C24XX_DEV_PM_OPS, 11435a5f50802f5a31b9e15de8df40d5621af970a560Thomas Abraham .of_match_table = s3c24xx_i2c_match, 11443ae5eaec1d2d9c0cf53745352e7d4b152810ba24Russell King }, 11451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 11461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init i2c_adap_s3c_init(void) 11481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11497d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks return platform_driver_register(&s3c24xx_i2c_driver); 11501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 115118dc83a6ea483941fb34293c6805a85bbcf0f718Mark Brownsubsys_initcall(i2c_adap_s3c_init); 11521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit i2c_adap_s3c_exit(void) 11541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11557d85ccd816535f56880f7dfdb4de056794376b2cBen Dooks platform_driver_unregister(&s3c24xx_i2c_driver); 11561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(i2c_adap_s3c_exit); 11581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("S3C24XX I2C Bus driver"); 11601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Ben Dooks, <ben@simtec.co.uk>"); 11611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 1162