i2c-davinci.c revision a09e64fbc0094e3073dbb09c3b4bfe4ab669244b
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> 3895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 39a09e64fbc0094e3073dbb09c3b4bfe4ab669244bRussell King#include <mach/hardware.h> 4095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 41a09e64fbc0094e3073dbb09c3b4bfe4ab669244bRussell King#include <mach/i2c.h> 4295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 4395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* ----- global defines ----------------------------------------------- */ 4495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 4595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_TIMEOUT (1*HZ) 4695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define I2C_DAVINCI_INTR_ALL (DAVINCI_I2C_IMR_AAS | \ 4795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_SCD | \ 4895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_ARDY | \ 4995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_NACK | \ 5095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_AL) 5195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 5295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_OAR_REG 0x00 5395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IMR_REG 0x04 5495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_STR_REG 0x08 5595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_CLKL_REG 0x0c 5695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_CLKH_REG 0x10 5795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_CNT_REG 0x14 5895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_DRR_REG 0x18 5995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_SAR_REG 0x1c 6095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_DXR_REG 0x20 6195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_MDR_REG 0x24 6295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_REG 0x28 6395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_EMDR_REG 0x2c 6495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_PSC_REG 0x30 6595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 6695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_AAS 0x07 6795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_SCD 0x06 6895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_XRDY 0x05 6995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_RDR 0x04 7095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_ARDY 0x03 7195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_NACK 0x02 7295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IVR_AL 0x01 7395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 7495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_STR_BB (1 << 12) 7595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_STR_RSFULL (1 << 11) 7695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_STR_SCD (1 << 5) 7795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_STR_ARDY (1 << 2) 7895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_STR_NACK (1 << 1) 7995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_STR_AL (1 << 0) 8095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 8195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_MDR_NACK (1 << 15) 8295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_MDR_STT (1 << 13) 8395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_MDR_STP (1 << 11) 8495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_MDR_MST (1 << 10) 8595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_MDR_TRX (1 << 9) 8695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_MDR_XA (1 << 8) 875a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky#define DAVINCI_I2C_MDR_RM (1 << 7) 8895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_MDR_IRS (1 << 5) 8995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 9095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IMR_AAS (1 << 6) 9195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IMR_SCD (1 << 5) 9295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IMR_XRDY (1 << 4) 9395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IMR_RRDY (1 << 3) 9495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IMR_ARDY (1 << 2) 9595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IMR_NACK (1 << 1) 9695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define DAVINCI_I2C_IMR_AL (1 << 0) 9795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 9895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov#define MOD_REG_BIT(val, mask, set) do { \ 9995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (set) { \ 10095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov val |= mask; \ 10195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } else { \ 10295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov val &= ~mask; \ 10395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } \ 10495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} while (0) 10595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 10695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstruct davinci_i2c_dev { 10795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct device *dev; 10895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov void __iomem *base; 10995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct completion cmd_complete; 11095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct clk *clk; 11195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int cmd_err; 11295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u8 *buf; 11395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov size_t buf_len; 11495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int irq; 1155a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky u8 terminate; 11695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct i2c_adapter adapter; 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 13695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* 13795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * This functions configures I2C and brings I2C out of reset. 13895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * This function is called during I2C init function. This function 13995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * also gets called if I2C encounters any errors. 14095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 14195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int i2c_davinci_init(struct davinci_i2c_dev *dev) 14295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 14395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_platform_data *pdata = dev->dev->platform_data; 14495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u16 psc; 14595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 clk; 146cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky u32 d; 14795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 clkh; 14895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 clkl; 14995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 input_clock = clk_get_rate(dev->clk); 15095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u16 w; 15195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 15295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!pdata) 15395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov pdata = &davinci_i2c_platform_data_default; 15495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 15595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* put I2C into reset */ 15695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov w = davinci_i2c_read_reg(dev, DAVINCI_I2C_MDR_REG); 15795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov MOD_REG_BIT(w, DAVINCI_I2C_MDR_IRS, 0); 15895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, w); 15995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 16095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* NOTE: I2C Clock divider programming info 16195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * As per I2C specs the following formulas provide prescaler 16295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * and low/high divider values 16395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * input clk --> PSC Div -----------> ICCL/H Div --> output clock 16495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * module clk 16595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 16695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * output clk = module clk / (PSC + 1) [ (ICCL + d) + (ICCH + d) ] 16795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 16895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Thus, 16995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * (ICCL + ICCH) = clk = (input clk / ((psc +1) * output clk)) - 2d; 17095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * 17195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * where if PSC == 0, d = 7, 17295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * if PSC == 1, d = 6 17395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * if PSC > 1 , d = 5 17495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 17595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 176cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky /* get minimum of 7 MHz clock, but max of 12 MHz */ 177cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky psc = (input_clock / 7000000) - 1; 178cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky if ((input_clock / (psc + 1)) > 12000000) 179cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky psc++; /* better to run under spec than over */ 180cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky d = (psc >= 2) ? 5 : 7 - psc; 18195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 182cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky clk = ((input_clock / (psc + 1)) / (pdata->bus_freq * 1000)) - (d << 1); 183cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky clkh = clk >> 1; 18495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clkl = clk - clkh; 18595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 18695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_PSC_REG, psc); 18795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_CLKH_REG, clkh); 18895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_CLKL_REG, clkl); 18995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 190cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky dev_dbg(dev->dev, "input_clock = %d, CLK = %d\n", input_clock, clk); 19195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_dbg(dev->dev, "PSC = %d\n", 19295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_read_reg(dev, DAVINCI_I2C_PSC_REG)); 19395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_dbg(dev->dev, "CLKL = %d\n", 19495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_read_reg(dev, DAVINCI_I2C_CLKL_REG)); 19595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_dbg(dev->dev, "CLKH = %d\n", 19695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_read_reg(dev, DAVINCI_I2C_CLKH_REG)); 197cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky dev_dbg(dev->dev, "bus_freq = %dkHz, bus_delay = %d\n", 198cc99ff70c7ad36e01db545a81a8594474964f918Troy Kisky pdata->bus_freq, pdata->bus_delay); 19995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 20095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* Take the I2C module out of reset: */ 20195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov w = davinci_i2c_read_reg(dev, DAVINCI_I2C_MDR_REG); 20295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov MOD_REG_BIT(w, DAVINCI_I2C_MDR_IRS, 1); 20395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, w); 20495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 20595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* Enable interrupts */ 20695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_IMR_REG, I2C_DAVINCI_INTR_ALL); 20795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 20895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return 0; 20995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 21095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 21195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* 21295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Waiting for bus not busy 21395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 21495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int i2c_davinci_wait_bus_not_busy(struct davinci_i2c_dev *dev, 21595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov char allow_sleep) 21695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 21795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov unsigned long timeout; 21895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 21995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov timeout = jiffies + DAVINCI_I2C_TIMEOUT; 22095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov while (davinci_i2c_read_reg(dev, DAVINCI_I2C_STR_REG) 22195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov & DAVINCI_I2C_STR_BB) { 22295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (time_after(jiffies, timeout)) { 22395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_warn(dev->dev, 22495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov "timeout waiting for bus ready\n"); 22595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -ETIMEDOUT; 22695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 22795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (allow_sleep) 22895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov schedule_timeout(1); 22995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 23095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 23195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return 0; 23295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 23395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 23495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* 23595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Low level master read/write transaction. This function is called 23695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * from i2c_davinci_xfer. 23795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 23895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int 23995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovi2c_davinci_xfer_msg(struct i2c_adapter *adap, struct i2c_msg *msg, int stop) 24095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 24195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_dev *dev = i2c_get_adapdata(adap); 24295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_platform_data *pdata = dev->dev->platform_data; 24395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 flag; 24495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u16 w; 24595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int r; 24695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 24795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (msg->len == 0) 24895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -EINVAL; 24995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 25095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!pdata) 25195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov pdata = &davinci_i2c_platform_data_default; 25295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* Introduce a delay, required for some boards (e.g Davinci EVM) */ 25395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (pdata->bus_delay) 25495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov udelay(pdata->bus_delay); 25595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 25695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* set the slave address */ 25795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_SAR_REG, msg->addr); 25895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 25995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->buf = msg->buf; 26095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->buf_len = msg->len; 26195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 26295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_CNT_REG, dev->buf_len); 26395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 2642e7437879897a4185bd84478a0451e5367dee7edTroy Kisky INIT_COMPLETION(dev->cmd_complete); 26595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->cmd_err = 0; 26695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 26795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* Take I2C out of reset, configure it as master and set the 26895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * start bit */ 26995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov flag = DAVINCI_I2C_MDR_IRS | DAVINCI_I2C_MDR_MST | DAVINCI_I2C_MDR_STT; 27095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 27195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* if the slave address is ten bit address, enable XA bit */ 27295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (msg->flags & I2C_M_TEN) 27395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov flag |= DAVINCI_I2C_MDR_XA; 27495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!(msg->flags & I2C_M_RD)) 27595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov flag |= DAVINCI_I2C_MDR_TRX; 27695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (stop) 27795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov flag |= DAVINCI_I2C_MDR_STP; 27895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 27995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* Enable receive or transmit interrupts */ 28095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov w = davinci_i2c_read_reg(dev, DAVINCI_I2C_IMR_REG); 28195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (msg->flags & I2C_M_RD) 28295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov MOD_REG_BIT(w, DAVINCI_I2C_IMR_RRDY, 1); 28395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov else 28495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov MOD_REG_BIT(w, DAVINCI_I2C_IMR_XRDY, 1); 28595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_IMR_REG, w); 28695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 2875a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->terminate = 0; 28895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* write the data into mode register */ 28995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, flag); 29095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 29195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov r = wait_for_completion_interruptible_timeout(&dev->cmd_complete, 29295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_TIMEOUT); 29395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (r == 0) { 29495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(dev->dev, "controller timed out\n"); 29595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov i2c_davinci_init(dev); 2965a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->buf_len = 0; 29795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -ETIMEDOUT; 29895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 2995a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky if (dev->buf_len) { 3005a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky /* This should be 0 if all bytes were transferred 3015a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky * or dev->cmd_err denotes an error. 3025a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky * A signal may have aborted the transfer. 3035a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky */ 3045a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky if (r >= 0) { 3055a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev_err(dev->dev, "abnormal termination buf_len=%i\n", 3065a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->buf_len); 3075a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky r = -EREMOTEIO; 3085a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } 3095a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->terminate = 1; 3105a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky wmb(); 3115a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->buf_len = 0; 3125a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } 3135a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky if (r < 0) 3145a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky return r; 31595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 31695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* no error */ 31795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (likely(!dev->cmd_err)) 31895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return msg->len; 31995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 32095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* We have an error */ 32195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->cmd_err & DAVINCI_I2C_STR_AL) { 32295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov i2c_davinci_init(dev); 32395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -EIO; 32495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 32595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 32695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->cmd_err & DAVINCI_I2C_STR_NACK) { 32795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (msg->flags & I2C_M_IGNORE_NAK) 32895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return msg->len; 32995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (stop) { 33095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov w = davinci_i2c_read_reg(dev, DAVINCI_I2C_MDR_REG); 33195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov MOD_REG_BIT(w, DAVINCI_I2C_MDR_STP, 1); 33295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, w); 33395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 33495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -EREMOTEIO; 33595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 33695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -EIO; 33795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 33895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 33995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* 34095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Prepare controller for a transaction and call i2c_davinci_xfer_msg 34195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 34295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int 34395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovi2c_davinci_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[], int num) 34495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 34595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_dev *dev = i2c_get_adapdata(adap); 34695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int i; 34795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int ret; 34895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 34908882d20932224d5c4500a855a2f4b1216e5f836Harvey Harrison dev_dbg(dev->dev, "%s: msgs: %d\n", __func__, num); 35095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 35195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov ret = i2c_davinci_wait_bus_not_busy(dev, 1); 35295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (ret < 0) { 35395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_warn(dev->dev, "timeout waiting for bus ready\n"); 35495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return ret; 35595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 35695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 35795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov for (i = 0; i < num; i++) { 35895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov ret = i2c_davinci_xfer_msg(adap, &msgs[i], (i == (num - 1))); 359d868caa177d4487ce1935926498f542a8f67c1cfTroy Kisky dev_dbg(dev->dev, "%s [%d/%d] ret: %d\n", __func__, i + 1, num, 360d868caa177d4487ce1935926498f542a8f67c1cfTroy Kisky ret); 36195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (ret < 0) 36295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return ret; 36395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 36495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return num; 36595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 36695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 36795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic u32 i2c_davinci_func(struct i2c_adapter *adap) 36895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 36995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return I2C_FUNC_I2C | (I2C_FUNC_SMBUS_EMUL & ~I2C_FUNC_SMBUS_QUICK); 37095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 37195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 3725a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kiskystatic void terminate_read(struct davinci_i2c_dev *dev) 3735a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky{ 3745a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky u16 w = davinci_i2c_read_reg(dev, DAVINCI_I2C_MDR_REG); 3755a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky w |= DAVINCI_I2C_MDR_NACK; 3765a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, w); 3775a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky 3785a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky /* Throw away data */ 3795a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky davinci_i2c_read_reg(dev, DAVINCI_I2C_DRR_REG); 3805a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky if (!dev->terminate) 3815a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev_err(dev->dev, "RDR IRQ while no data requested\n"); 3825a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky} 3835a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kiskystatic void terminate_write(struct davinci_i2c_dev *dev) 3845a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky{ 3855a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky u16 w = davinci_i2c_read_reg(dev, DAVINCI_I2C_MDR_REG); 3865a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky w |= DAVINCI_I2C_MDR_RM | DAVINCI_I2C_MDR_STP; 3875a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, w); 3885a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky 3895a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky if (!dev->terminate) 3905a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev_err(dev->dev, "TDR IRQ while no data to send\n"); 3915a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky} 3925a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky 39395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* 39495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * Interrupt service routine. This gets called whenever an I2C interrupt 39595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov * occurs. 39695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov */ 39795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic irqreturn_t i2c_davinci_isr(int this_irq, void *dev_id) 39895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 39995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_dev *dev = dev_id; 40095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u32 stat; 40195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int count = 0; 40295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov u16 w; 40395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 40495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov while ((stat = davinci_i2c_read_reg(dev, DAVINCI_I2C_IVR_REG))) { 40508882d20932224d5c4500a855a2f4b1216e5f836Harvey Harrison dev_dbg(dev->dev, "%s: stat=0x%x\n", __func__, stat); 40695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (count++ == 100) { 40795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_warn(dev->dev, "Too much work in one IRQ\n"); 40895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 40995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 41095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 41195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov switch (stat) { 41295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_AL: 4135a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky /* Arbitration lost, must retry */ 41495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->cmd_err |= DAVINCI_I2C_STR_AL; 4155a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->buf_len = 0; 41695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov complete(&dev->cmd_complete); 41795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 41895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 41995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_NACK: 42095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->cmd_err |= DAVINCI_I2C_STR_NACK; 4215a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky dev->buf_len = 0; 42295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov complete(&dev->cmd_complete); 42395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 42495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 42595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_ARDY: 426b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky davinci_i2c_write_reg(dev, 427b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky DAVINCI_I2C_STR_REG, DAVINCI_I2C_STR_ARDY); 42895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov complete(&dev->cmd_complete); 42995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 43095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 43195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_RDR: 43295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->buf_len) { 43395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov *dev->buf++ = 43495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_read_reg(dev, 43595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_DRR_REG); 43695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->buf_len--; 43795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->buf_len) 43895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov continue; 43995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 44095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, 441b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky DAVINCI_I2C_STR_REG, 442b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky DAVINCI_I2C_IMR_RRDY); 4435a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } else { 4445a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky /* signal can terminate transfer */ 4455a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky terminate_read(dev); 4465a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } 44795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 44895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 44995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_XRDY: 45095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->buf_len) { 45195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_DXR_REG, 45295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov *dev->buf++); 45395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->buf_len--; 45495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (dev->buf_len) 45595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov continue; 45695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 45795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov w = davinci_i2c_read_reg(dev, 45895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_REG); 45995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov MOD_REG_BIT(w, DAVINCI_I2C_IMR_XRDY, 0); 46095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, 46195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov DAVINCI_I2C_IMR_REG, 46295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov w); 4635a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } else { 4645a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky /* signal can terminate transfer */ 4655a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky terminate_write(dev); 4665a0d5f5ffa5d294d895ef54fc220c6182db63998Troy Kisky } 46795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 46895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 46995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_SCD: 470b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky davinci_i2c_write_reg(dev, 471b73a9aece56594bdb73712c8b9a8a4ad05fdeb33Troy Kisky DAVINCI_I2C_STR_REG, DAVINCI_I2C_STR_SCD); 47295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov complete(&dev->cmd_complete); 47395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov break; 47495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 47595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov case DAVINCI_I2C_IVR_AAS: 47695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_warn(dev->dev, "Address as slave interrupt\n"); 47795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov }/* switch */ 47895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov }/* while */ 47995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 48095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return count ? IRQ_HANDLED : IRQ_NONE; 48195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 48295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 48395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic struct i2c_algorithm i2c_davinci_algo = { 48495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .master_xfer = i2c_davinci_xfer, 48595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .functionality = i2c_davinci_func, 48695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov}; 48795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 48895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int davinci_i2c_probe(struct platform_device *pdev) 48995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 49095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_dev *dev; 49195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct i2c_adapter *adap; 49295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct resource *mem, *irq, *ioarea; 49395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov int r; 49495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 49595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* NOTE: driver uses the static register mapping */ 49695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); 49795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!mem) { 49895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(&pdev->dev, "no mem resource?\n"); 49995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -ENODEV; 50095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 50195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 50295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0); 50395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!irq) { 50495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(&pdev->dev, "no irq resource?\n"); 50595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -ENODEV; 50695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 50795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 50895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov ioarea = request_mem_region(mem->start, (mem->end - mem->start) + 1, 50995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov pdev->name); 51095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!ioarea) { 51195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(&pdev->dev, "I2C region already claimed\n"); 51295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return -EBUSY; 51395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 51495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 51595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev = kzalloc(sizeof(struct davinci_i2c_dev), GFP_KERNEL); 51695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (!dev) { 51795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov r = -ENOMEM; 51895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov goto err_release_region; 51995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 52095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 5212e7437879897a4185bd84478a0451e5367dee7edTroy Kisky init_completion(&dev->cmd_complete); 52295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->dev = get_device(&pdev->dev); 52395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->irq = irq->start; 52495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov platform_set_drvdata(pdev, dev); 52595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 52695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->clk = clk_get(&pdev->dev, "I2CCLK"); 52795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (IS_ERR(dev->clk)) { 52895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov r = -ENODEV; 52995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov goto err_free_mem; 53095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 53195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clk_enable(dev->clk); 53295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 53395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->base = (void __iomem *)IO_ADDRESS(mem->start); 53495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov i2c_davinci_init(dev); 53595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 53695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov r = request_irq(dev->irq, i2c_davinci_isr, 0, pdev->name, dev); 53795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (r) { 53895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(&pdev->dev, "failure requesting irq %i\n", dev->irq); 53995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov goto err_unuse_clocks; 54095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 54195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 54295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap = &dev->adapter; 54395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov i2c_set_adapdata(adap, dev); 54495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->owner = THIS_MODULE; 54595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->class = I2C_CLASS_HWMON; 54695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov strlcpy(adap->name, "DaVinci I2C adapter", sizeof(adap->name)); 54795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->algo = &i2c_davinci_algo; 54895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->dev.parent = &pdev->dev; 54995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 55095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov /* FIXME */ 55195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->timeout = 1; 55295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 55395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov adap->nr = pdev->id; 55495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov r = i2c_add_numbered_adapter(adap); 55595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov if (r) { 55695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev_err(&pdev->dev, "failure adding adapter\n"); 55795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov goto err_free_irq; 55895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov } 55995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 56095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return 0; 56195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 56295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinoverr_free_irq: 56395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov free_irq(dev->irq, dev); 56495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinoverr_unuse_clocks: 56595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clk_disable(dev->clk); 56695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clk_put(dev->clk); 56795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->clk = NULL; 56895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinoverr_free_mem: 56995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov platform_set_drvdata(pdev, NULL); 57095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov put_device(&pdev->dev); 57195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov kfree(dev); 57295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinoverr_release_region: 57395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov release_mem_region(mem->start, (mem->end - mem->start) + 1); 57495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 57595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return r; 57695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 57795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 57895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int davinci_i2c_remove(struct platform_device *pdev) 57995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 58095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct davinci_i2c_dev *dev = platform_get_drvdata(pdev); 58195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov struct resource *mem; 58295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 58395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov platform_set_drvdata(pdev, NULL); 58495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov i2c_del_adapter(&dev->adapter); 58595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov put_device(&pdev->dev); 58695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 58795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clk_disable(dev->clk); 58895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov clk_put(dev->clk); 58995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov dev->clk = NULL; 59095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 59195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov davinci_i2c_write_reg(dev, DAVINCI_I2C_MDR_REG, 0); 59295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov free_irq(IRQ_I2C, dev); 59395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov kfree(dev); 59495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 59595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); 59695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov release_mem_region(mem->start, (mem->end - mem->start) + 1); 59795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return 0; 59895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 59995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 600add8eda7f2be781af0224241e870715cf0cfd75aKay Sievers/* work with hotplug and coldplug */ 601add8eda7f2be781af0224241e870715cf0cfd75aKay SieversMODULE_ALIAS("platform:i2c_davinci"); 602add8eda7f2be781af0224241e870715cf0cfd75aKay Sievers 60395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic struct platform_driver davinci_i2c_driver = { 60495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .probe = davinci_i2c_probe, 60595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .remove = davinci_i2c_remove, 60695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .driver = { 60795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .name = "i2c_davinci", 60895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov .owner = THIS_MODULE, 60995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov }, 61095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov}; 61195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 61295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov/* I2C may be needed to bring up other drivers */ 61395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic int __init davinci_i2c_init_driver(void) 61495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 61595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov return platform_driver_register(&davinci_i2c_driver); 61695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 61795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovsubsys_initcall(davinci_i2c_init_driver); 61895a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 61995a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovstatic void __exit davinci_i2c_exit_driver(void) 62095a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov{ 62195a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov platform_driver_unregister(&davinci_i2c_driver); 62295a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov} 62395a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinovmodule_exit(davinci_i2c_exit_driver); 62495a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir Barinov 62595a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir BarinovMODULE_AUTHOR("Texas Instruments India"); 62695a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir BarinovMODULE_DESCRIPTION("TI DaVinci I2C bus adapter"); 62795a7f10eadcd88cfd6640e44c7b8cf9ac1afafe7Vladimir BarinovMODULE_LICENSE("GPL"); 628