2010-01-29 04:47:07 +08:00
|
|
|
/*
|
|
|
|
|
* (C) Copyright 2009-2010
|
|
|
|
|
* Nokia Siemens Networks, michael.lawnick.ext@nsn.com
|
|
|
|
|
*
|
2012-07-06 00:12:39 +08:00
|
|
|
* Portions Copyright (C) 2010, 2011 Cavium Networks, Inc.
|
2010-01-29 04:47:07 +08:00
|
|
|
*
|
|
|
|
|
* This is a driver for the i2c adapter in Cavium Networks' OCTEON processors.
|
|
|
|
|
*
|
|
|
|
|
* This file is licensed under the terms of the GNU General Public
|
|
|
|
|
* License version 2. This program is licensed "as is" without any
|
|
|
|
|
* warranty of any kind, whether express or implied.
|
|
|
|
|
*/
|
|
|
|
|
|
2012-07-06 00:12:39 +08:00
|
|
|
#include <linux/platform_device.h>
|
|
|
|
|
#include <linux/interrupt.h>
|
2010-01-29 04:47:07 +08:00
|
|
|
#include <linux/kernel.h>
|
|
|
|
|
#include <linux/module.h>
|
2012-07-06 00:12:39 +08:00
|
|
|
#include <linux/delay.h>
|
2010-01-29 04:47:07 +08:00
|
|
|
#include <linux/sched.h>
|
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 16:04:11 +08:00
|
|
|
#include <linux/slab.h>
|
2010-01-29 04:47:07 +08:00
|
|
|
#include <linux/i2c.h>
|
2012-07-06 00:12:39 +08:00
|
|
|
#include <linux/io.h>
|
|
|
|
|
#include <linux/of.h>
|
2010-01-29 04:47:07 +08:00
|
|
|
|
|
|
|
|
#include <asm/octeon/octeon.h>
|
|
|
|
|
|
|
|
|
|
#define DRV_NAME "i2c-octeon"
|
|
|
|
|
|
|
|
|
|
/* The previous out-of-tree version was implicitly version 1.0. */
|
|
|
|
|
#define DRV_VERSION "2.0"
|
|
|
|
|
|
|
|
|
|
/* register offsets */
|
|
|
|
|
#define SW_TWSI 0x00
|
|
|
|
|
#define TWSI_INT 0x10
|
|
|
|
|
|
|
|
|
|
/* Controller command patterns */
|
|
|
|
|
#define SW_TWSI_V 0x8000000000000000ull
|
|
|
|
|
#define SW_TWSI_EOP_TWSI_DATA 0x0C00000100000000ull
|
|
|
|
|
#define SW_TWSI_EOP_TWSI_CTL 0x0C00000200000000ull
|
|
|
|
|
#define SW_TWSI_EOP_TWSI_CLKCTL 0x0C00000300000000ull
|
|
|
|
|
#define SW_TWSI_EOP_TWSI_STAT 0x0C00000300000000ull
|
|
|
|
|
#define SW_TWSI_EOP_TWSI_RST 0x0C00000700000000ull
|
|
|
|
|
#define SW_TWSI_OP_TWSI_CLK 0x0800000000000000ull
|
|
|
|
|
#define SW_TWSI_R 0x0100000000000000ull
|
|
|
|
|
|
|
|
|
|
/* Controller command and status bits */
|
|
|
|
|
#define TWSI_CTL_CE 0x80
|
|
|
|
|
#define TWSI_CTL_ENAB 0x40
|
|
|
|
|
#define TWSI_CTL_STA 0x20
|
|
|
|
|
#define TWSI_CTL_STP 0x10
|
|
|
|
|
#define TWSI_CTL_IFLG 0x08
|
|
|
|
|
#define TWSI_CTL_AAK 0x04
|
|
|
|
|
|
|
|
|
|
/* Some status values */
|
|
|
|
|
#define STAT_START 0x08
|
|
|
|
|
#define STAT_RSTART 0x10
|
|
|
|
|
#define STAT_TXADDR_ACK 0x18
|
|
|
|
|
#define STAT_TXDATA_ACK 0x28
|
|
|
|
|
#define STAT_RXADDR_ACK 0x40
|
|
|
|
|
#define STAT_RXDATA_ACK 0x50
|
|
|
|
|
#define STAT_IDLE 0xF8
|
|
|
|
|
|
|
|
|
|
struct octeon_i2c {
|
|
|
|
|
wait_queue_head_t queue;
|
|
|
|
|
struct i2c_adapter adap;
|
|
|
|
|
int irq;
|
2012-07-06 00:12:39 +08:00
|
|
|
u32 twsi_freq;
|
2010-01-29 04:47:07 +08:00
|
|
|
int sys_freq;
|
|
|
|
|
resource_size_t twsi_phys;
|
|
|
|
|
void __iomem *twsi_base;
|
|
|
|
|
resource_size_t regsize;
|
|
|
|
|
struct device *dev;
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_write_sw - write an I2C core register.
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
* @eop_reg: Register selector.
|
|
|
|
|
* @data: Value to be written.
|
|
|
|
|
*
|
|
|
|
|
* The I2C core registers are accessed indirectly via the SW_TWSI CSR.
|
|
|
|
|
*/
|
|
|
|
|
static void octeon_i2c_write_sw(struct octeon_i2c *i2c,
|
|
|
|
|
u64 eop_reg,
|
|
|
|
|
u8 data)
|
|
|
|
|
{
|
|
|
|
|
u64 tmp;
|
|
|
|
|
|
|
|
|
|
__raw_writeq(SW_TWSI_V | eop_reg | data, i2c->twsi_base + SW_TWSI);
|
|
|
|
|
do {
|
|
|
|
|
tmp = __raw_readq(i2c->twsi_base + SW_TWSI);
|
|
|
|
|
} while ((tmp & SW_TWSI_V) != 0);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_read_sw - write an I2C core register.
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
* @eop_reg: Register selector.
|
|
|
|
|
*
|
|
|
|
|
* Returns the data.
|
|
|
|
|
*
|
|
|
|
|
* The I2C core registers are accessed indirectly via the SW_TWSI CSR.
|
|
|
|
|
*/
|
|
|
|
|
static u8 octeon_i2c_read_sw(struct octeon_i2c *i2c, u64 eop_reg)
|
|
|
|
|
{
|
|
|
|
|
u64 tmp;
|
|
|
|
|
|
|
|
|
|
__raw_writeq(SW_TWSI_V | eop_reg | SW_TWSI_R, i2c->twsi_base + SW_TWSI);
|
|
|
|
|
do {
|
|
|
|
|
tmp = __raw_readq(i2c->twsi_base + SW_TWSI);
|
|
|
|
|
} while ((tmp & SW_TWSI_V) != 0);
|
|
|
|
|
|
|
|
|
|
return tmp & 0xFF;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_write_int - write the TWSI_INT register
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
* @data: Value to be written.
|
|
|
|
|
*/
|
|
|
|
|
static void octeon_i2c_write_int(struct octeon_i2c *i2c, u64 data)
|
|
|
|
|
{
|
|
|
|
|
__raw_writeq(data, i2c->twsi_base + TWSI_INT);
|
2012-07-06 00:12:39 +08:00
|
|
|
__raw_readq(i2c->twsi_base + TWSI_INT);
|
2010-01-29 04:47:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_int_enable - enable the TS interrupt.
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
*
|
|
|
|
|
* The interrupt will be asserted when there is non-STAT_IDLE state in
|
|
|
|
|
* the SW_TWSI_EOP_TWSI_STAT register.
|
|
|
|
|
*/
|
|
|
|
|
static void octeon_i2c_int_enable(struct octeon_i2c *i2c)
|
|
|
|
|
{
|
|
|
|
|
octeon_i2c_write_int(i2c, 0x40);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_int_disable - disable the TS interrupt.
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
*/
|
|
|
|
|
static void octeon_i2c_int_disable(struct octeon_i2c *i2c)
|
|
|
|
|
{
|
|
|
|
|
octeon_i2c_write_int(i2c, 0);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_unblock - unblock the bus.
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
*
|
|
|
|
|
* If there was a reset while a device was driving 0 to bus,
|
|
|
|
|
* bus is blocked. We toggle it free manually by some clock
|
|
|
|
|
* cycles and send a stop.
|
|
|
|
|
*/
|
|
|
|
|
static void octeon_i2c_unblock(struct octeon_i2c *i2c)
|
|
|
|
|
{
|
|
|
|
|
int i;
|
|
|
|
|
|
|
|
|
|
dev_dbg(i2c->dev, "%s\n", __func__);
|
|
|
|
|
for (i = 0; i < 9; i++) {
|
|
|
|
|
octeon_i2c_write_int(i2c, 0x0);
|
|
|
|
|
udelay(5);
|
|
|
|
|
octeon_i2c_write_int(i2c, 0x200);
|
|
|
|
|
udelay(5);
|
|
|
|
|
}
|
|
|
|
|
octeon_i2c_write_int(i2c, 0x300);
|
|
|
|
|
udelay(5);
|
|
|
|
|
octeon_i2c_write_int(i2c, 0x100);
|
|
|
|
|
udelay(5);
|
|
|
|
|
octeon_i2c_write_int(i2c, 0x0);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_isr - the interrupt service routine.
|
|
|
|
|
* @int: The irq, unused.
|
|
|
|
|
* @dev_id: Our struct octeon_i2c.
|
|
|
|
|
*/
|
|
|
|
|
static irqreturn_t octeon_i2c_isr(int irq, void *dev_id)
|
|
|
|
|
{
|
|
|
|
|
struct octeon_i2c *i2c = dev_id;
|
|
|
|
|
|
|
|
|
|
octeon_i2c_int_disable(i2c);
|
2013-04-18 05:40:17 +08:00
|
|
|
wake_up(&i2c->queue);
|
2010-01-29 04:47:07 +08:00
|
|
|
|
|
|
|
|
return IRQ_HANDLED;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static int octeon_i2c_test_iflg(struct octeon_i2c *i2c)
|
|
|
|
|
{
|
|
|
|
|
return (octeon_i2c_read_sw(i2c, SW_TWSI_EOP_TWSI_CTL) & TWSI_CTL_IFLG) != 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_wait - wait for the IFLG to be set.
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
*
|
|
|
|
|
* Returns 0 on success, otherwise a negative errno.
|
|
|
|
|
*/
|
|
|
|
|
static int octeon_i2c_wait(struct octeon_i2c *i2c)
|
|
|
|
|
{
|
|
|
|
|
int result;
|
|
|
|
|
|
|
|
|
|
octeon_i2c_int_enable(i2c);
|
|
|
|
|
|
2013-04-18 05:40:17 +08:00
|
|
|
result = wait_event_timeout(i2c->queue,
|
|
|
|
|
octeon_i2c_test_iflg(i2c),
|
|
|
|
|
i2c->adap.timeout);
|
2010-01-29 04:47:07 +08:00
|
|
|
|
|
|
|
|
octeon_i2c_int_disable(i2c);
|
|
|
|
|
|
|
|
|
|
if (result < 0) {
|
|
|
|
|
dev_dbg(i2c->dev, "%s: wait interrupted\n", __func__);
|
|
|
|
|
return result;
|
|
|
|
|
} else if (result == 0) {
|
|
|
|
|
dev_dbg(i2c->dev, "%s: timeout\n", __func__);
|
2010-09-27 18:55:16 +08:00
|
|
|
return -ETIMEDOUT;
|
2010-01-29 04:47:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_start - send START to the bus.
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
*
|
|
|
|
|
* Returns 0 on success, otherwise a negative errno.
|
|
|
|
|
*/
|
|
|
|
|
static int octeon_i2c_start(struct octeon_i2c *i2c)
|
|
|
|
|
{
|
|
|
|
|
u8 data;
|
|
|
|
|
int result;
|
|
|
|
|
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_CTL,
|
|
|
|
|
TWSI_CTL_ENAB | TWSI_CTL_STA);
|
|
|
|
|
|
|
|
|
|
result = octeon_i2c_wait(i2c);
|
|
|
|
|
if (result) {
|
|
|
|
|
if (octeon_i2c_read_sw(i2c, SW_TWSI_EOP_TWSI_STAT) == STAT_IDLE) {
|
|
|
|
|
/*
|
|
|
|
|
* Controller refused to send start flag May
|
|
|
|
|
* be a client is holding SDA low - let's try
|
|
|
|
|
* to free it.
|
|
|
|
|
*/
|
|
|
|
|
octeon_i2c_unblock(i2c);
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_CTL,
|
|
|
|
|
TWSI_CTL_ENAB | TWSI_CTL_STA);
|
|
|
|
|
|
|
|
|
|
result = octeon_i2c_wait(i2c);
|
|
|
|
|
}
|
|
|
|
|
if (result)
|
|
|
|
|
return result;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
data = octeon_i2c_read_sw(i2c, SW_TWSI_EOP_TWSI_STAT);
|
|
|
|
|
if ((data != STAT_START) && (data != STAT_RSTART)) {
|
|
|
|
|
dev_err(i2c->dev, "%s: bad status (0x%x)\n", __func__, data);
|
|
|
|
|
return -EIO;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_stop - send STOP to the bus.
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
*
|
|
|
|
|
* Returns 0 on success, otherwise a negative errno.
|
|
|
|
|
*/
|
|
|
|
|
static int octeon_i2c_stop(struct octeon_i2c *i2c)
|
|
|
|
|
{
|
|
|
|
|
u8 data;
|
|
|
|
|
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_CTL,
|
|
|
|
|
TWSI_CTL_ENAB | TWSI_CTL_STP);
|
|
|
|
|
|
|
|
|
|
data = octeon_i2c_read_sw(i2c, SW_TWSI_EOP_TWSI_STAT);
|
|
|
|
|
|
|
|
|
|
if (data != STAT_IDLE) {
|
|
|
|
|
dev_err(i2c->dev, "%s: bad status(0x%x)\n", __func__, data);
|
|
|
|
|
return -EIO;
|
|
|
|
|
}
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_write - send data to the bus.
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
* @target: Target address.
|
|
|
|
|
* @data: Pointer to the data to be sent.
|
|
|
|
|
* @length: Length of the data.
|
|
|
|
|
*
|
|
|
|
|
* The address is sent over the bus, then the data.
|
|
|
|
|
*
|
|
|
|
|
* Returns 0 on success, otherwise a negative errno.
|
|
|
|
|
*/
|
|
|
|
|
static int octeon_i2c_write(struct octeon_i2c *i2c, int target,
|
|
|
|
|
const u8 *data, int length)
|
|
|
|
|
{
|
|
|
|
|
int i, result;
|
|
|
|
|
u8 tmp;
|
|
|
|
|
|
|
|
|
|
result = octeon_i2c_start(i2c);
|
|
|
|
|
if (result)
|
|
|
|
|
return result;
|
|
|
|
|
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_DATA, target << 1);
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_CTL, TWSI_CTL_ENAB);
|
|
|
|
|
|
|
|
|
|
result = octeon_i2c_wait(i2c);
|
|
|
|
|
if (result)
|
|
|
|
|
return result;
|
|
|
|
|
|
|
|
|
|
for (i = 0; i < length; i++) {
|
|
|
|
|
tmp = octeon_i2c_read_sw(i2c, SW_TWSI_EOP_TWSI_STAT);
|
|
|
|
|
if ((tmp != STAT_TXADDR_ACK) && (tmp != STAT_TXDATA_ACK)) {
|
|
|
|
|
dev_err(i2c->dev,
|
|
|
|
|
"%s: bad status before write (0x%x)\n",
|
|
|
|
|
__func__, tmp);
|
|
|
|
|
return -EIO;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_DATA, data[i]);
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_CTL, TWSI_CTL_ENAB);
|
|
|
|
|
|
|
|
|
|
result = octeon_i2c_wait(i2c);
|
|
|
|
|
if (result)
|
|
|
|
|
return result;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_read - receive data from the bus.
|
|
|
|
|
* @i2c: The struct octeon_i2c.
|
|
|
|
|
* @target: Target address.
|
|
|
|
|
* @data: Pointer to the location to store the datae .
|
|
|
|
|
* @length: Length of the data.
|
|
|
|
|
*
|
|
|
|
|
* The address is sent over the bus, then the data is read.
|
|
|
|
|
*
|
|
|
|
|
* Returns 0 on success, otherwise a negative errno.
|
|
|
|
|
*/
|
|
|
|
|
static int octeon_i2c_read(struct octeon_i2c *i2c, int target,
|
|
|
|
|
u8 *data, int length)
|
|
|
|
|
{
|
|
|
|
|
int i, result;
|
|
|
|
|
u8 tmp;
|
|
|
|
|
|
|
|
|
|
if (length < 1)
|
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
|
|
result = octeon_i2c_start(i2c);
|
|
|
|
|
if (result)
|
|
|
|
|
return result;
|
|
|
|
|
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_DATA, (target<<1) | 1);
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_CTL, TWSI_CTL_ENAB);
|
|
|
|
|
|
|
|
|
|
result = octeon_i2c_wait(i2c);
|
|
|
|
|
if (result)
|
|
|
|
|
return result;
|
|
|
|
|
|
|
|
|
|
for (i = 0; i < length; i++) {
|
|
|
|
|
tmp = octeon_i2c_read_sw(i2c, SW_TWSI_EOP_TWSI_STAT);
|
|
|
|
|
if ((tmp != STAT_RXDATA_ACK) && (tmp != STAT_RXADDR_ACK)) {
|
|
|
|
|
dev_err(i2c->dev,
|
|
|
|
|
"%s: bad status before read (0x%x)\n",
|
|
|
|
|
__func__, tmp);
|
|
|
|
|
return -EIO;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (i+1 < length)
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_CTL,
|
|
|
|
|
TWSI_CTL_ENAB | TWSI_CTL_AAK);
|
|
|
|
|
else
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_CTL,
|
|
|
|
|
TWSI_CTL_ENAB);
|
|
|
|
|
|
|
|
|
|
result = octeon_i2c_wait(i2c);
|
|
|
|
|
if (result)
|
|
|
|
|
return result;
|
|
|
|
|
|
|
|
|
|
data[i] = octeon_i2c_read_sw(i2c, SW_TWSI_EOP_TWSI_DATA);
|
|
|
|
|
}
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_xfer - The driver's master_xfer function.
|
|
|
|
|
* @adap: Pointer to the i2c_adapter structure.
|
|
|
|
|
* @msgs: Pointer to the messages to be processed.
|
|
|
|
|
* @num: Length of the MSGS array.
|
|
|
|
|
*
|
|
|
|
|
* Returns the number of messages processed, or a negative errno on
|
|
|
|
|
* failure.
|
|
|
|
|
*/
|
|
|
|
|
static int octeon_i2c_xfer(struct i2c_adapter *adap,
|
|
|
|
|
struct i2c_msg *msgs,
|
|
|
|
|
int num)
|
|
|
|
|
{
|
|
|
|
|
struct i2c_msg *pmsg;
|
|
|
|
|
int i;
|
|
|
|
|
int ret = 0;
|
|
|
|
|
struct octeon_i2c *i2c = i2c_get_adapdata(adap);
|
|
|
|
|
|
|
|
|
|
for (i = 0; ret == 0 && i < num; i++) {
|
|
|
|
|
pmsg = &msgs[i];
|
|
|
|
|
dev_dbg(i2c->dev,
|
|
|
|
|
"Doing %s %d byte(s) to/from 0x%02x - %d of %d messages\n",
|
|
|
|
|
pmsg->flags & I2C_M_RD ? "read" : "write",
|
|
|
|
|
pmsg->len, pmsg->addr, i + 1, num);
|
|
|
|
|
if (pmsg->flags & I2C_M_RD)
|
|
|
|
|
ret = octeon_i2c_read(i2c, pmsg->addr, pmsg->buf,
|
|
|
|
|
pmsg->len);
|
|
|
|
|
else
|
|
|
|
|
ret = octeon_i2c_write(i2c, pmsg->addr, pmsg->buf,
|
|
|
|
|
pmsg->len);
|
|
|
|
|
}
|
|
|
|
|
octeon_i2c_stop(i2c);
|
|
|
|
|
|
|
|
|
|
return (ret != 0) ? ret : num;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static u32 octeon_i2c_functionality(struct i2c_adapter *adap)
|
|
|
|
|
{
|
|
|
|
|
return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static const struct i2c_algorithm octeon_i2c_algo = {
|
|
|
|
|
.master_xfer = octeon_i2c_xfer,
|
|
|
|
|
.functionality = octeon_i2c_functionality,
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
static struct i2c_adapter octeon_i2c_ops = {
|
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
|
.name = "OCTEON adapter",
|
|
|
|
|
.algo = &octeon_i2c_algo,
|
2013-04-18 22:01:05 +08:00
|
|
|
.timeout = HZ / 50,
|
2010-01-29 04:47:07 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* octeon_i2c_setclock - Calculate and set clock divisors.
|
|
|
|
|
*/
|
2012-11-28 04:59:38 +08:00
|
|
|
static int octeon_i2c_setclock(struct octeon_i2c *i2c)
|
2010-01-29 04:47:07 +08:00
|
|
|
{
|
|
|
|
|
int tclk, thp_base, inc, thp_idx, mdiv_idx, ndiv_idx, foscl, diff;
|
|
|
|
|
int thp = 0x18, mdiv = 2, ndiv = 0, delta_hz = 1000000;
|
|
|
|
|
|
|
|
|
|
for (ndiv_idx = 0; ndiv_idx < 8 && delta_hz != 0; ndiv_idx++) {
|
|
|
|
|
/*
|
|
|
|
|
* An mdiv value of less than 2 seems to not work well
|
|
|
|
|
* with ds1337 RTCs, so we constrain it to larger
|
|
|
|
|
* values.
|
|
|
|
|
*/
|
|
|
|
|
for (mdiv_idx = 15; mdiv_idx >= 2 && delta_hz != 0; mdiv_idx--) {
|
|
|
|
|
/*
|
|
|
|
|
* For given ndiv and mdiv values check the
|
|
|
|
|
* two closest thp values.
|
|
|
|
|
*/
|
|
|
|
|
tclk = i2c->twsi_freq * (mdiv_idx + 1) * 10;
|
|
|
|
|
tclk *= (1 << ndiv_idx);
|
|
|
|
|
thp_base = (i2c->sys_freq / (tclk * 2)) - 1;
|
|
|
|
|
for (inc = 0; inc <= 1; inc++) {
|
|
|
|
|
thp_idx = thp_base + inc;
|
|
|
|
|
if (thp_idx < 5 || thp_idx > 0xff)
|
|
|
|
|
continue;
|
|
|
|
|
|
|
|
|
|
foscl = i2c->sys_freq / (2 * (thp_idx + 1));
|
|
|
|
|
foscl = foscl / (1 << ndiv_idx);
|
|
|
|
|
foscl = foscl / (mdiv_idx + 1) / 10;
|
|
|
|
|
diff = abs(foscl - i2c->twsi_freq);
|
|
|
|
|
if (diff < delta_hz) {
|
|
|
|
|
delta_hz = diff;
|
|
|
|
|
thp = thp_idx;
|
|
|
|
|
mdiv = mdiv_idx;
|
|
|
|
|
ndiv = ndiv_idx;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_OP_TWSI_CLK, thp);
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_CLKCTL, (mdiv << 3) | ndiv);
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
2012-11-28 04:59:38 +08:00
|
|
|
static int octeon_i2c_initlowlevel(struct octeon_i2c *i2c)
|
2010-01-29 04:47:07 +08:00
|
|
|
{
|
|
|
|
|
u8 status;
|
|
|
|
|
int tries;
|
|
|
|
|
|
|
|
|
|
/* disable high level controller, enable bus access */
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_CTL, TWSI_CTL_ENAB);
|
|
|
|
|
|
|
|
|
|
/* reset controller */
|
|
|
|
|
octeon_i2c_write_sw(i2c, SW_TWSI_EOP_TWSI_RST, 0);
|
|
|
|
|
|
|
|
|
|
for (tries = 10; tries; tries--) {
|
|
|
|
|
udelay(1);
|
|
|
|
|
status = octeon_i2c_read_sw(i2c, SW_TWSI_EOP_TWSI_STAT);
|
|
|
|
|
if (status == STAT_IDLE)
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
dev_err(i2c->dev, "%s: TWSI_RST failed! (0x%x)\n", __func__, status);
|
|
|
|
|
return -EIO;
|
|
|
|
|
}
|
|
|
|
|
|
2012-11-28 04:59:38 +08:00
|
|
|
static int octeon_i2c_probe(struct platform_device *pdev)
|
2010-01-29 04:47:07 +08:00
|
|
|
{
|
|
|
|
|
int irq, result = 0;
|
|
|
|
|
struct octeon_i2c *i2c;
|
|
|
|
|
struct resource *res_mem;
|
|
|
|
|
|
|
|
|
|
/* All adaptors have an irq. */
|
|
|
|
|
irq = platform_get_irq(pdev, 0);
|
|
|
|
|
if (irq < 0)
|
|
|
|
|
return irq;
|
|
|
|
|
|
2012-07-06 00:12:39 +08:00
|
|
|
i2c = devm_kzalloc(&pdev->dev, sizeof(*i2c), GFP_KERNEL);
|
2010-01-29 04:47:07 +08:00
|
|
|
if (!i2c) {
|
|
|
|
|
dev_err(&pdev->dev, "kzalloc failed\n");
|
|
|
|
|
result = -ENOMEM;
|
|
|
|
|
goto out;
|
|
|
|
|
}
|
|
|
|
|
i2c->dev = &pdev->dev;
|
|
|
|
|
|
|
|
|
|
res_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
|
|
|
|
|
|
|
if (res_mem == NULL) {
|
|
|
|
|
dev_err(i2c->dev, "found no memory resource\n");
|
|
|
|
|
result = -ENXIO;
|
2012-07-06 00:12:39 +08:00
|
|
|
goto out;
|
2010-01-29 04:47:07 +08:00
|
|
|
}
|
2012-07-06 00:12:39 +08:00
|
|
|
i2c->twsi_phys = res_mem->start;
|
|
|
|
|
i2c->regsize = resource_size(res_mem);
|
2010-01-29 04:47:07 +08:00
|
|
|
|
2012-07-06 00:12:39 +08:00
|
|
|
/*
|
|
|
|
|
* "clock-rate" is a legacy binding, the official binding is
|
|
|
|
|
* "clock-frequency". Try the official one first and then
|
|
|
|
|
* fall back if it doesn't exist.
|
|
|
|
|
*/
|
|
|
|
|
if (of_property_read_u32(pdev->dev.of_node,
|
|
|
|
|
"clock-frequency", &i2c->twsi_freq) &&
|
|
|
|
|
of_property_read_u32(pdev->dev.of_node,
|
|
|
|
|
"clock-rate", &i2c->twsi_freq)) {
|
|
|
|
|
dev_err(i2c->dev,
|
|
|
|
|
"no I2C 'clock-rate' or 'clock-frequency' property\n");
|
2010-01-29 04:47:07 +08:00
|
|
|
result = -ENXIO;
|
2012-07-06 00:12:39 +08:00
|
|
|
goto out;
|
2010-01-29 04:47:07 +08:00
|
|
|
}
|
|
|
|
|
|
2012-07-06 00:12:39 +08:00
|
|
|
i2c->sys_freq = octeon_get_io_clock_rate();
|
2010-01-29 04:47:07 +08:00
|
|
|
|
2012-07-06 00:12:39 +08:00
|
|
|
if (!devm_request_mem_region(&pdev->dev, i2c->twsi_phys, i2c->regsize,
|
|
|
|
|
res_mem->name)) {
|
2010-01-29 04:47:07 +08:00
|
|
|
dev_err(i2c->dev, "request_mem_region failed\n");
|
2012-07-06 00:12:39 +08:00
|
|
|
goto out;
|
2010-01-29 04:47:07 +08:00
|
|
|
}
|
2012-07-06 00:12:39 +08:00
|
|
|
i2c->twsi_base = devm_ioremap(&pdev->dev, i2c->twsi_phys, i2c->regsize);
|
2010-01-29 04:47:07 +08:00
|
|
|
|
|
|
|
|
init_waitqueue_head(&i2c->queue);
|
|
|
|
|
|
|
|
|
|
i2c->irq = irq;
|
|
|
|
|
|
2012-07-06 00:12:39 +08:00
|
|
|
result = devm_request_irq(&pdev->dev, i2c->irq,
|
|
|
|
|
octeon_i2c_isr, 0, DRV_NAME, i2c);
|
2010-01-29 04:47:07 +08:00
|
|
|
if (result < 0) {
|
|
|
|
|
dev_err(i2c->dev, "failed to attach interrupt\n");
|
2012-07-06 00:12:39 +08:00
|
|
|
goto out;
|
2010-01-29 04:47:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
result = octeon_i2c_initlowlevel(i2c);
|
|
|
|
|
if (result) {
|
|
|
|
|
dev_err(i2c->dev, "init low level failed\n");
|
2012-07-06 00:12:39 +08:00
|
|
|
goto out;
|
2010-01-29 04:47:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
result = octeon_i2c_setclock(i2c);
|
|
|
|
|
if (result) {
|
|
|
|
|
dev_err(i2c->dev, "clock init failed\n");
|
2012-07-06 00:12:39 +08:00
|
|
|
goto out;
|
2010-01-29 04:47:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
i2c->adap = octeon_i2c_ops;
|
|
|
|
|
i2c->adap.dev.parent = &pdev->dev;
|
2012-07-06 00:12:39 +08:00
|
|
|
i2c->adap.dev.of_node = pdev->dev.of_node;
|
2010-01-29 04:47:07 +08:00
|
|
|
i2c_set_adapdata(&i2c->adap, i2c);
|
|
|
|
|
platform_set_drvdata(pdev, i2c);
|
|
|
|
|
|
2012-07-06 00:12:39 +08:00
|
|
|
result = i2c_add_adapter(&i2c->adap);
|
2010-01-29 04:47:07 +08:00
|
|
|
if (result < 0) {
|
|
|
|
|
dev_err(i2c->dev, "failed to add adapter\n");
|
2013-02-15 21:18:35 +08:00
|
|
|
goto out;
|
2010-01-29 04:47:07 +08:00
|
|
|
}
|
|
|
|
|
dev_info(i2c->dev, "version %s\n", DRV_VERSION);
|
|
|
|
|
|
2012-07-06 00:12:39 +08:00
|
|
|
return 0;
|
2010-01-29 04:47:07 +08:00
|
|
|
|
|
|
|
|
out:
|
|
|
|
|
return result;
|
|
|
|
|
};
|
|
|
|
|
|
2012-11-28 04:59:38 +08:00
|
|
|
static int octeon_i2c_remove(struct platform_device *pdev)
|
2010-01-29 04:47:07 +08:00
|
|
|
{
|
|
|
|
|
struct octeon_i2c *i2c = platform_get_drvdata(pdev);
|
|
|
|
|
|
|
|
|
|
i2c_del_adapter(&i2c->adap);
|
|
|
|
|
return 0;
|
|
|
|
|
};
|
|
|
|
|
|
2012-07-06 00:12:39 +08:00
|
|
|
static struct of_device_id octeon_i2c_match[] = {
|
|
|
|
|
{
|
|
|
|
|
.compatible = "cavium,octeon-3860-twsi",
|
|
|
|
|
},
|
|
|
|
|
{},
|
|
|
|
|
};
|
|
|
|
|
MODULE_DEVICE_TABLE(of, octeon_i2c_match);
|
|
|
|
|
|
2010-01-29 04:47:07 +08:00
|
|
|
static struct platform_driver octeon_i2c_driver = {
|
|
|
|
|
.probe = octeon_i2c_probe,
|
2012-11-28 04:59:38 +08:00
|
|
|
.remove = octeon_i2c_remove,
|
2010-01-29 04:47:07 +08:00
|
|
|
.driver = {
|
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
|
.name = DRV_NAME,
|
2012-07-06 00:12:39 +08:00
|
|
|
.of_match_table = octeon_i2c_match,
|
2010-01-29 04:47:07 +08:00
|
|
|
},
|
|
|
|
|
};
|
|
|
|
|
|
2012-01-13 03:32:04 +08:00
|
|
|
module_platform_driver(octeon_i2c_driver);
|
2010-01-29 04:47:07 +08:00
|
|
|
|
|
|
|
|
MODULE_AUTHOR("Michael Lawnick <michael.lawnick.ext@nsn.com>");
|
|
|
|
|
MODULE_DESCRIPTION("I2C-Bus adapter for Cavium OCTEON processors");
|
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
|
MODULE_VERSION(DRV_VERSION);
|