195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* 295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * TI DAVINCI I2C adapter driver. 395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Copyright (C) 2006 Texas Instruments. 595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Copyright (C) 2007 MontaVista Software Inc. 695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Updated by Vinod & Sudhakar Feb 2005 895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * ---------------------------------------------------------------------------- 1095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 1195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * This program is free software; you can redistribute it and/or modify 1295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * it under the terms of the GNU General Public License as published by 1395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * the Free Software Foundation; either version 2 of the License, or 1495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * (at your option) any later version. 1595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 1695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * This program is distributed in the hope that it will be useful, 1795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * but WITHOUT ANY WARRANTY; without even the implied warranty of 1895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * GNU General Public License for more details. 2095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 2195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * You should have received a copy of the GNU General Public License 2295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * along with this program; if not, write to the Free Software 2395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 2495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * ---------------------------------------------------------------------------- 2595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 2695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 2795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/kernel.h> 2895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/module.h> 2995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/delay.h> 3095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/i2c.h> 3195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/clk.h> 3295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/errno.h> 3395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/sched.h> 3495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/err.h> 3595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/interrupt.h> 3695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/platform_device.h> 3795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#include <linux/io.h> 385a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 3982c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S#include <linux/cpufreq.h> 408574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John#include <linux/gpio.h> 4195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 42a09e64fbc0094e3073dbb09c3b4bfe4ab669244bRussell King#include <mach/hardware.h> 43a09e64fbc0094e3073dbb09c3b4bfe4ab669244bRussell King#include <mach/i2c.h> 4495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 4595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* ----- global defines ----------------------------------------------- */ 4695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 4795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_TIMEOUT (1*HZ) 488574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John#define DAVINCI_I2C_MAX_TRIES 2 4995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define I2C_DAVINCI_INTR_ALL (DAVINCI_I2C_IMR_AAS | \ 5095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_SCD | \ 5195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_ARDY | \ 5295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_NACK | \ 5395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_AL) 5495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 5595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_OAR_REG 0x00 5695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IMR_REG 0x04 5795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_STR_REG 0x08 5895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_CLKL_REG 0x0c 5995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_CLKH_REG 0x10 6095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_CNT_REG 0x14 6195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_DRR_REG 0x18 6295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_SAR_REG 0x1c 6395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_DXR_REG 0x20 6495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_MDR_REG 0x24 6595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_REG 0x28 6695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_EMDR_REG 0x2c 6795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_PSC_REG 0x30 6895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 6995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_AAS 0x07 7095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_SCD 0x06 7195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_XRDY 0x05 7295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_RDR 0x04 7395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_ARDY 0x03 7495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_NACK 0x02 7595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_AL 0x01 7695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 77c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_STR_BB BIT(12) 78c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_STR_RSFULL BIT(11) 79c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_STR_SCD BIT(5) 80c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_STR_ARDY BIT(2) 81c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_STR_NACK BIT(1) 82c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_STR_AL BIT(0) 83c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S 84c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_MDR_NACK BIT(15) 85c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_MDR_STT BIT(13) 86c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_MDR_STP BIT(11) 87c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_MDR_MST BIT(10) 88c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_MDR_TRX BIT(9) 89c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_MDR_XA BIT(8) 90c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_MDR_RM BIT(7) 91c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_MDR_IRS BIT(5) 92c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S 93c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_IMR_AAS BIT(6) 94c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_IMR_SCD BIT(5) 95c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_IMR_XRDY BIT(4) 96c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_IMR_RRDY BIT(3) 97c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_IMR_ARDY BIT(2) 98c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_IMR_NACK BIT(1) 99c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S#define DAVINCI_I2C_IMR_AL BIT(0) 10095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 10195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstruct davinci_i2c_dev { 10295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct device *dev; 10395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov void __iomem *base; 10495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct completion cmd_complete; 10595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct clk *clk; 10695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int cmd_err; 10795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u8 *buf; 10895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov size_t buf_len; 10995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int irq; 110c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme int stop; 1115a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky u8 terminate; 11295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct i2c_adapter adapter; 11382c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S#ifdef CONFIG_CPU_FREQ 11482c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S struct completion xfr_complete; 11582c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S struct notifier_block freq_transition; 11682c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S#endif 11795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov}; 11895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 11995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* default platform data to use if not supplied in the platform_device */ 12095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic struct davinci_i2c_platform_data davinci_i2c_platform_data_default = { 12195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .bus_freq = 100, 12295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .bus_delay = 0, 12395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov}; 12495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 12595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic inline void davinci_i2c_write_reg(struct davinci_i2c_dev *i2c_dev, 12695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int reg, u16 val) 12795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 12895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov __raw_writew(val, i2c_dev->base + reg); 12995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 13095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 13195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic inline u16 davinci_i2c_read_reg(struct davinci_i2c_dev *i2c_dev, int reg) 13295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 13395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return __raw_readw(i2c_dev->base + reg); 13495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 13595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 1368574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John/* Generate a pulse on the i2c clock pin. */ 1378574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby Johnstatic void generic_i2c_clock_pulse(unsigned int scl_pin) 1388574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John{ 1398574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John u16 i; 1408574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John 1418574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John if (scl_pin) { 1428574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John /* Send high and low on the SCL line */ 1438574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John for (i = 0; i < 9; i++) { 1448574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John gpio_set_value(scl_pin, 0); 1458574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John udelay(20); 1468574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John gpio_set_value(scl_pin, 1); 1478574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John udelay(20); 1488574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John } 1498574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John } 1508574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John} 1518574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John 1528574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John/* This routine does i2c bus recovery as specified in the 1538574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John * i2c protocol Rev. 03 section 3.16 titled "Bus clear" 1548574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John */ 1558574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby Johnstatic void i2c_recover_bus(struct davinci_i2c_dev *dev) 1568574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John{ 1578574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John u32 flag = 0; 1588574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John struct davinci_i2c_platform_data *pdata = dev->dev->platform_data; 1598574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John 1608574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John dev_err(dev->dev, "initiating i2c bus recovery\n"); 1618574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John /* Send NACK to the slave */ 1628574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John flag = davinci_i2c_read_reg(dev, DAVINCI_I2C_MDR_REG); 1638574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John flag |= DAVINCI_I2C_MDR_NACK; 1648574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John /* write the data into mode register */ 1658574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, flag); 1668574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John if (pdata) 1678574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John generic_i2c_clock_pulse(pdata->scl_pin); 1688574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John /* Send STOP */ 1698574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John flag = davinci_i2c_read_reg(dev, DAVINCI_I2C_MDR_REG); 1708574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John flag |= DAVINCI_I2C_MDR_STP; 1718574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, flag); 1728574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John} 1738574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John 1745ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U Sstatic inline void davinci_i2c_reset_ctrl(struct davinci_i2c_dev *i2c_dev, 1755ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S int val) 1765ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S{ 1775ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S u16 w; 1785ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S 1795ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S w = davinci_i2c_read_reg(i2c_dev, DAVINCI_I2C_MDR_REG); 1805ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S if (!val) /* put I2C into reset */ 1815ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S w &= ~DAVINCI_I2C_MDR_IRS; 1825ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S else /* take I2C out of reset */ 1835ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S w |= DAVINCI_I2C_MDR_IRS; 1845ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S 1855ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S davinci_i2c_write_reg(i2c_dev, DAVINCI_I2C_MDR_REG, w); 1865ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S} 1875ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S 1885ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U Sstatic void i2c_davinci_calc_clk_dividers(struct davinci_i2c_dev *dev) 18995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 19095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_platform_data *pdata = dev->dev->platform_data; 19195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u16 psc; 19295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 clk; 193cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky u32 d; 19495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 clkh; 19595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 clkl; 19695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 input_clock = clk_get_rate(dev->clk); 19795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 19895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* NOTE: I2C Clock divider programming info 19995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * As per I2C specs the following formulas provide prescaler 20095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * and low/high divider values 20195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * input clk --> PSC Div -----------> ICCL/H Div --> output clock 20295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * module clk 20395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 20495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * output clk = module clk / (PSC + 1) [ (ICCL + d) + (ICCH + d) ] 20595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 20695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Thus, 20795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * (ICCL + ICCH) = clk = (input clk / ((psc +1) * output clk)) - 2d; 20895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 20995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * where if PSC == 0, d = 7, 21095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * if PSC == 1, d = 6 21195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * if PSC > 1 , d = 5 21295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 21395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 214cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky /* get minimum of 7 MHz clock, but max of 12 MHz */ 215cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky psc = (input_clock / 7000000) - 1; 216cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky if ((input_clock / (psc + 1)) > 12000000) 217cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky psc++; /* better to run under spec than over */ 218cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky d = (psc >= 2) ? 5 : 7 - psc; 21995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 220cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky clk = ((input_clock / (psc + 1)) / (pdata->bus_freq * 1000)) - (d << 1); 221cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky clkh = clk >> 1; 22295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clkl = clk - clkh; 22395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 22495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_PSC_REG, psc); 22595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_CLKH_REG, clkh); 22695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_CLKL_REG, clkl); 22795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 2285ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S dev_dbg(dev->dev, "input_clock = %d, CLK = %d\n", input_clock, clk); 2295ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S} 2305ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S 2315ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S/* 2325ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S * This function configures I2C and brings I2C out of reset. 2335ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S * This function is called during I2C init function. This function 2345ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S * also gets called if I2C encounters any errors. 2355ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S */ 2365ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U Sstatic int i2c_davinci_init(struct davinci_i2c_dev *dev) 2375ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S{ 2385ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S struct davinci_i2c_platform_data *pdata = dev->dev->platform_data; 2395ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S 2405ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S if (!pdata) 2415ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S pdata = &davinci_i2c_platform_data_default; 2425ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S 2435ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S /* put I2C into reset */ 2445ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S davinci_i2c_reset_ctrl(dev, 0); 2455ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S 2465ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S /* compute clock dividers */ 2475ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S i2c_davinci_calc_clk_dividers(dev); 2485ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S 2497605fa3b0aedbb6c77471517ba16753f276156d9David Brownell /* Respond at reserved "SMBus Host" slave address" (and zero); 2507605fa3b0aedbb6c77471517ba16753f276156d9David Brownell * we seem to have no option to not respond... 2517605fa3b0aedbb6c77471517ba16753f276156d9David Brownell */ 2527605fa3b0aedbb6c77471517ba16753f276156d9David Brownell davinci_i2c_write_reg(dev, DAVINCI_I2C_OAR_REG, 0x08); 2537605fa3b0aedbb6c77471517ba16753f276156d9David Brownell 25495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_dbg(dev->dev, "PSC = %d\n", 25595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_read_reg(dev, DAVINCI_I2C_PSC_REG)); 25695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_dbg(dev->dev, "CLKL = %d\n", 25795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_read_reg(dev, DAVINCI_I2C_CLKL_REG)); 25895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_dbg(dev->dev, "CLKH = %d\n", 25995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_read_reg(dev, DAVINCI_I2C_CLKH_REG)); 260cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky dev_dbg(dev->dev, "bus_freq = %dkHz, bus_delay = %d\n", 261cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky pdata->bus_freq, pdata->bus_delay); 26295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 26395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* Take the I2C module out of reset: */ 2645ae5b1136e0c434b076ab1f9cb39deebf6187f55Chaithrika U S davinci_i2c_reset_ctrl(dev, 1); 26595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 26695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* Enable interrupts */ 26795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_IMR_REG, I2C_DAVINCI_INTR_ALL); 26895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 26995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return 0; 27095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 27195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 27295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* 27395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Waiting for bus not busy 27495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 27595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int i2c_davinci_wait_bus_not_busy(struct davinci_i2c_dev *dev, 27695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov char allow_sleep) 27795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 27895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov unsigned long timeout; 2798574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John static u16 to_cnt; 28095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 28198a679cad56c0ba4677821836179abbe0aff8769Jean Delvare timeout = jiffies + dev->adapter.timeout; 28295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov while (davinci_i2c_read_reg(dev, DAVINCI_I2C_STR_REG) 28395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov & DAVINCI_I2C_STR_BB) { 2848574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John if (to_cnt <= DAVINCI_I2C_MAX_TRIES) { 2858574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John if (time_after(jiffies, timeout)) { 2868574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John dev_warn(dev->dev, 2878574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John "timeout waiting for bus ready\n"); 2888574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John to_cnt++; 2898574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John return -ETIMEDOUT; 2908574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John } else { 2918574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John to_cnt = 0; 2928574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John i2c_recover_bus(dev); 2938574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John i2c_davinci_init(dev); 2948574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John } 29595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 29695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (allow_sleep) 29795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov schedule_timeout(1); 29895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 29995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 30095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return 0; 30195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 30295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 30395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* 30495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Low level master read/write transaction. This function is called 30595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * from i2c_davinci_xfer. 30695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 30795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int 30895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovi2c_davinci_xfer_msg(struct i2c_adapter *adap, struct i2c_msg *msg, int stop) 30995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 31095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_dev *dev = i2c_get_adapdata(adap); 31195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_platform_data *pdata = dev->dev->platform_data; 31295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 flag; 31395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u16 w; 31495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int r; 31595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 31695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!pdata) 31795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov pdata = &davinci_i2c_platform_data_default; 31895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* Introduce a delay, required for some boards (e.g Davinci EVM) */ 31995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (pdata->bus_delay) 32095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov udelay(pdata->bus_delay); 32195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 32295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* set the slave address */ 32395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_SAR_REG, msg->addr); 32495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 32595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->buf = msg->buf; 32695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->buf_len = msg->len; 327c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme dev->stop = stop; 32895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 32995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_CNT_REG, dev->buf_len); 33095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 3312e7437879897a4185bd84478a0451e5367dee7edTroy Kisky INIT_COMPLETION(dev->cmd_complete); 33295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->cmd_err = 0; 33395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 334c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey /* Take I2C out of reset and configure it as master */ 335c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey flag = DAVINCI_I2C_MDR_IRS | DAVINCI_I2C_MDR_MST; 33695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 33795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* if the slave address is ten bit address, enable XA bit */ 33895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (msg->flags & I2C_M_TEN) 33995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov flag |= DAVINCI_I2C_MDR_XA; 34095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!(msg->flags & I2C_M_RD)) 34195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov flag |= DAVINCI_I2C_MDR_TRX; 342c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey if (msg->len == 0) 343c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme flag |= DAVINCI_I2C_MDR_RM; 34495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 34595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* Enable receive or transmit interrupts */ 34695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov w = davinci_i2c_read_reg(dev, DAVINCI_I2C_IMR_REG); 34795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (msg->flags & I2C_M_RD) 348c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S w |= DAVINCI_I2C_IMR_RRDY; 34995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov else 350c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S w |= DAVINCI_I2C_IMR_XRDY; 35195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_IMR_REG, w); 35295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 3535a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->terminate = 0; 354c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme 355c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme /* 356c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey * Write mode register first as needed for correct behaviour 357c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey * on OMAP-L138, but don't set STT yet to avoid a race with XRDY 35825985edcedea6396277003854657b5f3cb31a628Lucas De Marchi * occurring before we have loaded DXR 359c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey */ 360c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, flag); 361c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey 362c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey /* 363c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme * First byte should be set here, not after interrupt, 364c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme * because transmit-data-ready interrupt can come before 365c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme * NACK-interrupt during sending of previous message and 366c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme * ICDXR may have wrong data 367c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey * It also saves us one interrupt, slightly faster 368c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme */ 369c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme if ((!(msg->flags & I2C_M_RD)) && dev->buf_len) { 370c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme davinci_i2c_write_reg(dev, DAVINCI_I2C_DXR_REG, *dev->buf++); 371c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme dev->buf_len--; 372c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme } 373c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme 374c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey /* Set STT to begin transmit now DXR is loaded */ 375c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey flag |= DAVINCI_I2C_MDR_STT; 376c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey if (stop && msg->len != 0) 377c5b4afec8e669bbe265daea24037fccfc42c4fe3Jon Povey flag |= DAVINCI_I2C_MDR_STP; 3784bba0fd8d1c6d405df666e2573e1a1f917098be0Jon Povey davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, flag); 3794bba0fd8d1c6d405df666e2573e1a1f917098be0Jon Povey 38095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov r = wait_for_completion_interruptible_timeout(&dev->cmd_complete, 38198a679cad56c0ba4677821836179abbe0aff8769Jean Delvare dev->adapter.timeout); 38295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (r == 0) { 38395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(dev->dev, "controller timed out\n"); 3848574faf9a5ae71fdd84c6413779a9b076138eb9ePhilby John i2c_recover_bus(dev); 38595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov i2c_davinci_init(dev); 3865a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->buf_len = 0; 38795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -ETIMEDOUT; 38895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 3895a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky if (dev->buf_len) { 3905a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky /* This should be 0 if all bytes were transferred 3915a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky * or dev->cmd_err denotes an error. 3925a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky * A signal may have aborted the transfer. 3935a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky */ 3945a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky if (r >= 0) { 3955a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev_err(dev->dev, "abnormal termination buf_len=%i\n", 3965a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->buf_len); 3975a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky r = -EREMOTEIO; 3985a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } 3995a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->terminate = 1; 4005a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky wmb(); 4015a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->buf_len = 0; 4025a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } 4035a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky if (r < 0) 4045a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky return r; 40595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 40695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* no error */ 40795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (likely(!dev->cmd_err)) 40895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return msg->len; 40995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 41095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* We have an error */ 41195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->cmd_err & DAVINCI_I2C_STR_AL) { 41295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov i2c_davinci_init(dev); 41395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -EIO; 41495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 41595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 41695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->cmd_err & DAVINCI_I2C_STR_NACK) { 41795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (msg->flags & I2C_M_IGNORE_NAK) 41895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return msg->len; 41995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (stop) { 42095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov w = davinci_i2c_read_reg(dev, DAVINCI_I2C_MDR_REG); 421c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S w |= DAVINCI_I2C_MDR_STP; 42295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, w); 42395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 42495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -EREMOTEIO; 42595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 42695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -EIO; 42795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 42895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 42995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* 43095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Prepare controller for a transaction and call i2c_davinci_xfer_msg 43195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 43295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int 43395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovi2c_davinci_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[], int num) 43495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 43595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_dev *dev = i2c_get_adapdata(adap); 43695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int i; 43795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int ret; 43895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 43908882d20932224d5c4500a855a2f4b1216e5f836Harvey Harrison dev_dbg(dev->dev, "%s: msgs: %d\n", __func__, num); 44095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 44195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov ret = i2c_davinci_wait_bus_not_busy(dev, 1); 44295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (ret < 0) { 44395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_warn(dev->dev, "timeout waiting for bus ready\n"); 44495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return ret; 44595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 44695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 44795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov for (i = 0; i < num; i++) { 44895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov ret = i2c_davinci_xfer_msg(adap, &msgs[i], (i == (num - 1))); 449d868caa177d4487ce1935926498f542a8f67c1cfTroy Kisky dev_dbg(dev->dev, "%s [%d/%d] ret: %d\n", __func__, i + 1, num, 450d868caa177d4487ce1935926498f542a8f67c1cfTroy Kisky ret); 45195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (ret < 0) 45295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return ret; 45395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 45482c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 45582c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S#ifdef CONFIG_CPU_FREQ 45682c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S complete(&dev->xfr_complete); 45782c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S#endif 45882c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 45995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return num; 46095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 46195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 46295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic u32 i2c_davinci_func(struct i2c_adapter *adap) 46395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 464c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; 46595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 46695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 4675a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kiskystatic void terminate_read(struct davinci_i2c_dev *dev) 4685a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky{ 4695a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky u16 w = davinci_i2c_read_reg(dev, DAVINCI_I2C_MDR_REG); 4705a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky w |= DAVINCI_I2C_MDR_NACK; 4715a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, w); 4725a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky 4735a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky /* Throw away data */ 4745a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky davinci_i2c_read_reg(dev, DAVINCI_I2C_DRR_REG); 4755a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky if (!dev->terminate) 4765a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev_err(dev->dev, "RDR IRQ while no data requested\n"); 4775a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky} 4785a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kiskystatic void terminate_write(struct davinci_i2c_dev *dev) 4795a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky{ 4805a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky u16 w = davinci_i2c_read_reg(dev, DAVINCI_I2C_MDR_REG); 4815a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky w |= DAVINCI_I2C_MDR_RM | DAVINCI_I2C_MDR_STP; 4825a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, w); 4835a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky 4845a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky if (!dev->terminate) 4857605fa3b0aedbb6c77471517ba16753f276156d9David Brownell dev_dbg(dev->dev, "TDR IRQ while no data to send\n"); 4865a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky} 4875a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky 48895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* 48995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Interrupt service routine. This gets called whenever an I2C interrupt 49095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * occurs. 49195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 49295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic irqreturn_t i2c_davinci_isr(int this_irq, void *dev_id) 49395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 49495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_dev *dev = dev_id; 49595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 stat; 49695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int count = 0; 49795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u16 w; 49895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 49995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov while ((stat = davinci_i2c_read_reg(dev, DAVINCI_I2C_IVR_REG))) { 50008882d20932224d5c4500a855a2f4b1216e5f836Harvey Harrison dev_dbg(dev->dev, "%s: stat=0x%x\n", __func__, stat); 50195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (count++ == 100) { 50295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_warn(dev->dev, "Too much work in one IRQ\n"); 50395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 50495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 50595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 50695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov switch (stat) { 50795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_AL: 5085a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky /* Arbitration lost, must retry */ 50995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->cmd_err |= DAVINCI_I2C_STR_AL; 5105a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->buf_len = 0; 51195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov complete(&dev->cmd_complete); 51295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 51395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 51495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_NACK: 51595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->cmd_err |= DAVINCI_I2C_STR_NACK; 5165a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->buf_len = 0; 51795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov complete(&dev->cmd_complete); 51895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 51995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 52095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_ARDY: 521b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky davinci_i2c_write_reg(dev, 522b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky DAVINCI_I2C_STR_REG, DAVINCI_I2C_STR_ARDY); 523c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme if (((dev->buf_len == 0) && (dev->stop != 0)) || 524c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme (dev->cmd_err & DAVINCI_I2C_STR_NACK)) { 525c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme w = davinci_i2c_read_reg(dev, 526c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme DAVINCI_I2C_MDR_REG); 527c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme w |= DAVINCI_I2C_MDR_STP; 528c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme davinci_i2c_write_reg(dev, 529c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme DAVINCI_I2C_MDR_REG, w); 530c6c7c729a22bfeb8e63eafce48dbaeea20e68703Dirk Behme } 53195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov complete(&dev->cmd_complete); 53295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 53395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 53495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_RDR: 53595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->buf_len) { 53695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov *dev->buf++ = 53795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_read_reg(dev, 53895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_DRR_REG); 53995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->buf_len--; 54095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->buf_len) 54195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov continue; 54295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 54395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, 544b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky DAVINCI_I2C_STR_REG, 545b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky DAVINCI_I2C_IMR_RRDY); 5465a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } else { 5475a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky /* signal can terminate transfer */ 5485a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky terminate_read(dev); 5495a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } 55095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 55195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 55295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_XRDY: 55395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->buf_len) { 55495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_DXR_REG, 55595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov *dev->buf++); 55695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->buf_len--; 55795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->buf_len) 55895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov continue; 55995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 56095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov w = davinci_i2c_read_reg(dev, 56195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_REG); 562c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S w &= ~DAVINCI_I2C_IMR_XRDY; 56395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, 56495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_REG, 56595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov w); 5665a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } else { 5675a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky /* signal can terminate transfer */ 5685a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky terminate_write(dev); 5695a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } 57095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 57195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 57295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_SCD: 573b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky davinci_i2c_write_reg(dev, 574b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky DAVINCI_I2C_STR_REG, DAVINCI_I2C_STR_SCD); 57595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov complete(&dev->cmd_complete); 57695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 57795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 57895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_AAS: 5797605fa3b0aedbb6c77471517ba16753f276156d9David Brownell dev_dbg(dev->dev, "Address as slave interrupt\n"); 5807605fa3b0aedbb6c77471517ba16753f276156d9David Brownell break; 5817605fa3b0aedbb6c77471517ba16753f276156d9David Brownell 5827605fa3b0aedbb6c77471517ba16753f276156d9David Brownell default: 5837605fa3b0aedbb6c77471517ba16753f276156d9David Brownell dev_warn(dev->dev, "Unrecognized irq stat %d\n", stat); 5847605fa3b0aedbb6c77471517ba16753f276156d9David Brownell break; 5857605fa3b0aedbb6c77471517ba16753f276156d9David Brownell } 5867605fa3b0aedbb6c77471517ba16753f276156d9David Brownell } 58795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 58895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return count ? IRQ_HANDLED : IRQ_NONE; 58995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 59095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 59182c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S#ifdef CONFIG_CPU_FREQ 59282c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U Sstatic int i2c_davinci_cpufreq_transition(struct notifier_block *nb, 59382c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S unsigned long val, void *data) 59482c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S{ 59582c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S struct davinci_i2c_dev *dev; 59682c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 59782c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S dev = container_of(nb, struct davinci_i2c_dev, freq_transition); 59882c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S if (val == CPUFREQ_PRECHANGE) { 59982c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S wait_for_completion(&dev->xfr_complete); 60082c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S davinci_i2c_reset_ctrl(dev, 0); 60182c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S } else if (val == CPUFREQ_POSTCHANGE) { 60282c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S i2c_davinci_calc_clk_dividers(dev); 60382c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S davinci_i2c_reset_ctrl(dev, 1); 60482c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S } 60582c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 60682c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S return 0; 60782c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S} 60882c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 60982c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U Sstatic inline int i2c_davinci_cpufreq_register(struct davinci_i2c_dev *dev) 61082c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S{ 61182c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S dev->freq_transition.notifier_call = i2c_davinci_cpufreq_transition; 61282c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 61382c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S return cpufreq_register_notifier(&dev->freq_transition, 61482c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S CPUFREQ_TRANSITION_NOTIFIER); 61582c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S} 61682c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 61782c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U Sstatic inline void i2c_davinci_cpufreq_deregister(struct davinci_i2c_dev *dev) 61882c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S{ 61982c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S cpufreq_unregister_notifier(&dev->freq_transition, 62082c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S CPUFREQ_TRANSITION_NOTIFIER); 62182c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S} 62282c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S#else 62382c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U Sstatic inline int i2c_davinci_cpufreq_register(struct davinci_i2c_dev *dev) 62482c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S{ 62582c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S return 0; 62682c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S} 62782c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 62882c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U Sstatic inline void i2c_davinci_cpufreq_deregister(struct davinci_i2c_dev *dev) 62982c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S{ 63082c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S} 63182c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S#endif 63282c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 63395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic struct i2c_algorithm i2c_davinci_algo = { 63495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .master_xfer = i2c_davinci_xfer, 63595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .functionality = i2c_davinci_func, 63695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov}; 63795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 63895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int davinci_i2c_probe(struct platform_device *pdev) 63995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 64095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_dev *dev; 64195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct i2c_adapter *adap; 64295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct resource *mem, *irq, *ioarea; 64395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int r; 64495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 64595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* NOTE: driver uses the static register mapping */ 64695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); 64795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!mem) { 64895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(&pdev->dev, "no mem resource?\n"); 64995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -ENODEV; 65095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 65195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 65295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0); 65395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!irq) { 65495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(&pdev->dev, "no irq resource?\n"); 65595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -ENODEV; 65695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 65795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 658593308259bbd335eda9c5280cdd1f7883c746211Julia Lawall ioarea = request_mem_region(mem->start, resource_size(mem), 65995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov pdev->name); 66095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!ioarea) { 66195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(&pdev->dev, "I2C region already claimed\n"); 66295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -EBUSY; 66395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 66495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 66595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev = kzalloc(sizeof(struct davinci_i2c_dev), GFP_KERNEL); 66695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!dev) { 66795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov r = -ENOMEM; 66895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov goto err_release_region; 66995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 67095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 6712e7437879897a4185bd84478a0451e5367dee7edTroy Kisky init_completion(&dev->cmd_complete); 67282c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S#ifdef CONFIG_CPU_FREQ 67382c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S init_completion(&dev->xfr_complete); 67482c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S#endif 67595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->dev = get_device(&pdev->dev); 67695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->irq = irq->start; 67795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov platform_set_drvdata(pdev, dev); 67895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 679e164ddeeb82920c5b1470b6585767a000c8b0e45Kevin Hilman dev->clk = clk_get(&pdev->dev, NULL); 68095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (IS_ERR(dev->clk)) { 68195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov r = -ENODEV; 68295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov goto err_free_mem; 68395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 68495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clk_enable(dev->clk); 68595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 686c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S dev->base = ioremap(mem->start, resource_size(mem)); 687c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S if (!dev->base) { 688c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S r = -EBUSY; 689c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S goto err_mem_ioremap; 690c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S } 691c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S 69295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov i2c_davinci_init(dev); 69395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 69495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov r = request_irq(dev->irq, i2c_davinci_isr, 0, pdev->name, dev); 69595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (r) { 69695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(&pdev->dev, "failure requesting irq %i\n", dev->irq); 69795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov goto err_unuse_clocks; 69895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 69995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 70082c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S r = i2c_davinci_cpufreq_register(dev); 70182c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S if (r) { 70282c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S dev_err(&pdev->dev, "failed to register cpufreq\n"); 70382c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S goto err_free_irq; 70482c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S } 70582c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 70695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap = &dev->adapter; 70795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov i2c_set_adapdata(adap, dev); 70895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->owner = THIS_MODULE; 70995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->class = I2C_CLASS_HWMON; 71095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov strlcpy(adap->name, "DaVinci I2C adapter", sizeof(adap->name)); 71195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->algo = &i2c_davinci_algo; 71295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->dev.parent = &pdev->dev; 71398a679cad56c0ba4677821836179abbe0aff8769Jean Delvare adap->timeout = DAVINCI_I2C_TIMEOUT; 71495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 71595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->nr = pdev->id; 71695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov r = i2c_add_numbered_adapter(adap); 71795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (r) { 71895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(&pdev->dev, "failure adding adapter\n"); 71995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov goto err_free_irq; 72095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 72195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 72295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return 0; 72395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 72495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinoverr_free_irq: 72595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov free_irq(dev->irq, dev); 72695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinoverr_unuse_clocks: 727c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S iounmap(dev->base); 728c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U Serr_mem_ioremap: 72995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clk_disable(dev->clk); 73095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clk_put(dev->clk); 73195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->clk = NULL; 73295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinoverr_free_mem: 73395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov platform_set_drvdata(pdev, NULL); 73495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov put_device(&pdev->dev); 73595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov kfree(dev); 73695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinoverr_release_region: 737593308259bbd335eda9c5280cdd1f7883c746211Julia Lawall release_mem_region(mem->start, resource_size(mem)); 73895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 73995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return r; 74095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 74195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 74295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int davinci_i2c_remove(struct platform_device *pdev) 74395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 74495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_dev *dev = platform_get_drvdata(pdev); 74595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct resource *mem; 74695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 74782c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S i2c_davinci_cpufreq_deregister(dev); 74882c0de11b734c5acec13c0f6007466da81cd16d9Chaithrika U S 74995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov platform_set_drvdata(pdev, NULL); 75095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov i2c_del_adapter(&dev->adapter); 75195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov put_device(&pdev->dev); 75295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 75395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clk_disable(dev->clk); 75495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clk_put(dev->clk); 75595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->clk = NULL; 75695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 75795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, 0); 75816d815fd230b81d49d395e91b084f0731ea6e4a2Marcus Folkesson free_irq(dev->irq, dev); 759c062a2518d35a76e7db8519b2292191a47e3ab79Chaithrika U S iounmap(dev->base); 76095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov kfree(dev); 76195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 76295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); 763593308259bbd335eda9c5280cdd1f7883c746211Julia Lawall release_mem_region(mem->start, resource_size(mem)); 76495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return 0; 76595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 76695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 76768f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S#ifdef CONFIG_PM 76868f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U Sstatic int davinci_i2c_suspend(struct device *dev) 76968f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S{ 77068f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S struct platform_device *pdev = to_platform_device(dev); 77168f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S struct davinci_i2c_dev *i2c_dev = platform_get_drvdata(pdev); 77268f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S 77368f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S /* put I2C into reset */ 77468f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S davinci_i2c_reset_ctrl(i2c_dev, 0); 77568f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S clk_disable(i2c_dev->clk); 77668f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S 77768f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S return 0; 77868f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S} 77968f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S 78068f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U Sstatic int davinci_i2c_resume(struct device *dev) 78168f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S{ 78268f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S struct platform_device *pdev = to_platform_device(dev); 78368f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S struct davinci_i2c_dev *i2c_dev = platform_get_drvdata(pdev); 78468f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S 78568f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S clk_enable(i2c_dev->clk); 78668f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S /* take I2C out of reset */ 78768f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S davinci_i2c_reset_ctrl(i2c_dev, 1); 78868f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S 78968f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S return 0; 79068f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S} 79168f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S 79268f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U Sstatic const struct dev_pm_ops davinci_i2c_pm = { 79368f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S .suspend = davinci_i2c_suspend, 79468f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S .resume = davinci_i2c_resume, 79568f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S}; 79668f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S 79768f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S#define davinci_i2c_pm_ops (&davinci_i2c_pm) 79868f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S#else 79968f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S#define davinci_i2c_pm_ops NULL 80068f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S#endif 80168f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S 802add8eda7f2be781af0224241e870715cf0cfd75aKay Sievers/* work with hotplug and coldplug */ 803add8eda7f2be781af0224241e870715cf0cfd75aKay SieversMODULE_ALIAS("platform:i2c_davinci"); 804add8eda7f2be781af0224241e870715cf0cfd75aKay Sievers 80595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic struct platform_driver davinci_i2c_driver = { 80695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .probe = davinci_i2c_probe, 80795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .remove = davinci_i2c_remove, 80895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .driver = { 80995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .name = "i2c_davinci", 81095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .owner = THIS_MODULE, 81168f15de976f8f90d3bc0d10160aa20b0528760d4Chaithrika U S .pm = davinci_i2c_pm_ops, 81295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov }, 81395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov}; 81495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 81595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* I2C may be needed to bring up other drivers */ 81695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int __init davinci_i2c_init_driver(void) 81795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 81895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return platform_driver_register(&davinci_i2c_driver); 81995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 82095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovsubsys_initcall(davinci_i2c_init_driver); 82195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 82295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic void __exit davinci_i2c_exit_driver(void) 82395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 82495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov platform_driver_unregister(&davinci_i2c_driver); 82595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 82695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovmodule_exit(davinci_i2c_exit_driver); 82795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 82895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir BarinovMODULE_AUTHOR("Texas Instruments India"); 82995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir BarinovMODULE_DESCRIPTION("TI DaVinci I2C bus adapter"); 83095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir BarinovMODULE_LICENSE("GPL"); 831