2019-05-27 06:55:01 +00:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-or-later
|
2005-09-26 06:04:21 +00:00
|
|
|
/*
|
2006-01-07 00:30:44 +00:00
|
|
|
* arch/powerpc/platforms/powermac/low_i2c.c
|
2005-09-26 06:04:21 +00:00
|
|
|
*
|
2006-01-07 00:30:44 +00:00
|
|
|
* Copyright (C) 2003-2005 Ben. Herrenschmidt (benh@kernel.crashing.org)
|
2005-09-26 06:04:21 +00:00
|
|
|
*
|
2006-01-07 00:30:44 +00:00
|
|
|
* The linux i2c layer isn't completely suitable for our needs for various
|
|
|
|
* reasons ranging from too late initialisation to semantics not perfectly
|
|
|
|
* matching some requirements of the apple platform functions etc...
|
|
|
|
*
|
|
|
|
* This file thus provides a simple low level unified i2c interface for
|
|
|
|
* powermac that covers the various types of i2c busses used in Apple machines.
|
|
|
|
* For now, keywest, PMU and SMU, though we could add Cuda, or other bit
|
2016-06-01 06:34:37 +00:00
|
|
|
* banging busses found on older chipsets in earlier machines if we ever need
|
2006-01-07 00:30:44 +00:00
|
|
|
* one of them.
|
|
|
|
*
|
|
|
|
* The drivers in this file are synchronous/blocking. In addition, the
|
|
|
|
* keywest one is fairly slow due to the use of msleep instead of interrupts
|
|
|
|
* as the interrupt is currently used by i2c-keywest. In the long run, we
|
|
|
|
* might want to get rid of those high-level interfaces to linux i2c layer
|
|
|
|
* either completely (converting all drivers) or replacing them all with a
|
|
|
|
* single stub driver on top of this one. Once done, the interrupt will be
|
|
|
|
* available for our use.
|
2005-09-26 06:04:21 +00:00
|
|
|
*/
|
|
|
|
|
|
|
|
#undef DEBUG
|
2006-01-07 00:30:44 +00:00
|
|
|
#undef DEBUG_LOW
|
2005-09-26 06:04:21 +00:00
|
|
|
|
|
|
|
#include <linux/types.h>
|
|
|
|
#include <linux/sched.h>
|
|
|
|
#include <linux/init.h>
|
2011-07-22 22:24:23 +00:00
|
|
|
#include <linux/export.h>
|
2005-09-26 06:04:21 +00:00
|
|
|
#include <linux/adb.h>
|
|
|
|
#include <linux/pmu.h>
|
2006-01-07 00:30:44 +00:00
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/completion.h>
|
2006-01-07 00:35:26 +00:00
|
|
|
#include <linux/platform_device.h>
|
|
|
|
#include <linux/interrupt.h>
|
|
|
|
#include <linux/timer.h>
|
2007-07-03 23:01:54 +00:00
|
|
|
#include <linux/mutex.h>
|
2009-12-06 16:06:19 +00:00
|
|
|
#include <linux/i2c.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 08:04:11 +00:00
|
|
|
#include <linux/slab.h>
|
2022-03-08 19:20:25 +00:00
|
|
|
#include <linux/of_irq.h>
|
2005-09-26 06:04:21 +00:00
|
|
|
#include <asm/keylargo.h>
|
|
|
|
#include <asm/uninorth.h>
|
|
|
|
#include <asm/io.h>
|
|
|
|
#include <asm/machdep.h>
|
2006-01-07 00:30:44 +00:00
|
|
|
#include <asm/smu.h>
|
2006-01-07 00:41:02 +00:00
|
|
|
#include <asm/pmac_pfunc.h>
|
2005-09-26 06:04:21 +00:00
|
|
|
#include <asm/pmac_low_i2c.h>
|
|
|
|
|
|
|
|
#ifdef DEBUG
|
|
|
|
#define DBG(x...) do {\
|
2005-11-23 06:57:25 +00:00
|
|
|
printk(KERN_DEBUG "low_i2c:" x); \
|
2005-09-26 06:04:21 +00:00
|
|
|
} while(0)
|
|
|
|
#else
|
|
|
|
#define DBG(x...)
|
|
|
|
#endif
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
#ifdef DEBUG_LOW
|
|
|
|
#define DBG_LOW(x...) do {\
|
|
|
|
printk(KERN_DEBUG "low_i2c:" x); \
|
|
|
|
} while(0)
|
|
|
|
#else
|
|
|
|
#define DBG_LOW(x...)
|
|
|
|
#endif
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
|
|
|
|
static int pmac_i2c_force_poll = 1;
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
/*
|
|
|
|
* A bus structure. Each bus in the system has such a structure associated.
|
2005-09-26 06:04:21 +00:00
|
|
|
*/
|
2006-01-07 00:30:44 +00:00
|
|
|
struct pmac_i2c_bus
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
struct list_head link;
|
|
|
|
struct device_node *controller;
|
|
|
|
struct device_node *busnode;
|
|
|
|
int type;
|
|
|
|
int flags;
|
2009-12-06 16:06:19 +00:00
|
|
|
struct i2c_adapter adapter;
|
2006-01-07 00:30:44 +00:00
|
|
|
void *hostdata;
|
|
|
|
int channel; /* some hosts have multiple */
|
|
|
|
int mode; /* current mode */
|
2007-07-03 23:01:54 +00:00
|
|
|
struct mutex mutex;
|
2006-01-07 00:30:44 +00:00
|
|
|
int opened;
|
|
|
|
int polled; /* open mode */
|
2006-01-07 00:35:26 +00:00
|
|
|
struct platform_device *platform_dev;
|
2016-09-21 11:34:58 +00:00
|
|
|
struct lock_class_key lock_key;
|
2006-01-07 00:30:44 +00:00
|
|
|
|
|
|
|
/* ops */
|
|
|
|
int (*open)(struct pmac_i2c_bus *bus);
|
|
|
|
void (*close)(struct pmac_i2c_bus *bus);
|
|
|
|
int (*xfer)(struct pmac_i2c_bus *bus, u8 addrdir, int subsize,
|
|
|
|
u32 subaddr, u8 *data, int len);
|
|
|
|
};
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
static LIST_HEAD(pmac_i2c_busses);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
|
|
|
/*
|
2006-01-07 00:30:44 +00:00
|
|
|
* Keywest implementation
|
2005-09-26 06:04:21 +00:00
|
|
|
*/
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
struct pmac_i2c_host_kw
|
|
|
|
{
|
2007-07-03 23:01:54 +00:00
|
|
|
struct mutex mutex; /* Access mutex for use by
|
2006-01-07 00:30:44 +00:00
|
|
|
* i2c-keywest */
|
|
|
|
void __iomem *base; /* register base address */
|
|
|
|
int bsteps; /* register stepping */
|
|
|
|
int speed; /* speed */
|
2006-01-07 00:35:26 +00:00
|
|
|
int irq;
|
|
|
|
u8 *data;
|
|
|
|
unsigned len;
|
|
|
|
int state;
|
|
|
|
int rw;
|
|
|
|
int polled;
|
|
|
|
int result;
|
|
|
|
struct completion complete;
|
|
|
|
spinlock_t lock;
|
|
|
|
struct timer_list timeout_timer;
|
2006-01-07 00:30:44 +00:00
|
|
|
};
|
|
|
|
|
2005-09-26 06:04:21 +00:00
|
|
|
/* Register indices */
|
|
|
|
typedef enum {
|
|
|
|
reg_mode = 0,
|
|
|
|
reg_control,
|
|
|
|
reg_status,
|
|
|
|
reg_isr,
|
|
|
|
reg_ier,
|
|
|
|
reg_addr,
|
|
|
|
reg_subaddr,
|
|
|
|
reg_data
|
|
|
|
} reg_t;
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
/* The Tumbler audio equalizer can be really slow sometimes */
|
|
|
|
#define KW_POLL_TIMEOUT (2*HZ)
|
2005-09-26 06:04:21 +00:00
|
|
|
|
|
|
|
/* Mode register */
|
|
|
|
#define KW_I2C_MODE_100KHZ 0x00
|
|
|
|
#define KW_I2C_MODE_50KHZ 0x01
|
|
|
|
#define KW_I2C_MODE_25KHZ 0x02
|
|
|
|
#define KW_I2C_MODE_DUMB 0x00
|
|
|
|
#define KW_I2C_MODE_STANDARD 0x04
|
|
|
|
#define KW_I2C_MODE_STANDARDSUB 0x08
|
|
|
|
#define KW_I2C_MODE_COMBINED 0x0C
|
|
|
|
#define KW_I2C_MODE_MODE_MASK 0x0C
|
|
|
|
#define KW_I2C_MODE_CHAN_MASK 0xF0
|
|
|
|
|
|
|
|
/* Control register */
|
|
|
|
#define KW_I2C_CTL_AAK 0x01
|
|
|
|
#define KW_I2C_CTL_XADDR 0x02
|
|
|
|
#define KW_I2C_CTL_STOP 0x04
|
|
|
|
#define KW_I2C_CTL_START 0x08
|
|
|
|
|
|
|
|
/* Status register */
|
|
|
|
#define KW_I2C_STAT_BUSY 0x01
|
|
|
|
#define KW_I2C_STAT_LAST_AAK 0x02
|
|
|
|
#define KW_I2C_STAT_LAST_RW 0x04
|
|
|
|
#define KW_I2C_STAT_SDA 0x08
|
|
|
|
#define KW_I2C_STAT_SCL 0x10
|
|
|
|
|
|
|
|
/* IER & ISR registers */
|
|
|
|
#define KW_I2C_IRQ_DATA 0x01
|
|
|
|
#define KW_I2C_IRQ_ADDR 0x02
|
|
|
|
#define KW_I2C_IRQ_STOP 0x04
|
|
|
|
#define KW_I2C_IRQ_START 0x08
|
|
|
|
#define KW_I2C_IRQ_MASK 0x0F
|
|
|
|
|
|
|
|
/* State machine states */
|
|
|
|
enum {
|
|
|
|
state_idle,
|
|
|
|
state_addr,
|
|
|
|
state_read,
|
|
|
|
state_write,
|
|
|
|
state_stop,
|
|
|
|
state_dead
|
|
|
|
};
|
|
|
|
|
|
|
|
#define WRONG_STATE(name) do {\
|
2006-01-07 00:35:26 +00:00
|
|
|
printk(KERN_DEBUG "KW: wrong state. Got %s, state: %s " \
|
|
|
|
"(isr: %02x)\n", \
|
|
|
|
name, __kw_state_names[host->state], isr); \
|
2005-09-26 06:04:21 +00:00
|
|
|
} while(0)
|
|
|
|
|
|
|
|
static const char *__kw_state_names[] = {
|
|
|
|
"state_idle",
|
|
|
|
"state_addr",
|
|
|
|
"state_read",
|
|
|
|
"state_write",
|
|
|
|
"state_stop",
|
|
|
|
"state_dead"
|
|
|
|
};
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
static inline u8 __kw_read_reg(struct pmac_i2c_host_kw *host, reg_t reg)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
|
|
|
return readb(host->base + (((unsigned int)reg) << host->bsteps));
|
|
|
|
}
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
static inline void __kw_write_reg(struct pmac_i2c_host_kw *host,
|
|
|
|
reg_t reg, u8 val)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
|
|
|
writeb(val, host->base + (((unsigned)reg) << host->bsteps));
|
2006-01-07 00:35:26 +00:00
|
|
|
(void)__kw_read_reg(host, reg_subaddr);
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
#define kw_write_reg(reg, val) __kw_write_reg(host, reg, val)
|
|
|
|
#define kw_read_reg(reg) __kw_read_reg(host, reg)
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
static u8 kw_i2c_wait_interrupt(struct pmac_i2c_host_kw *host)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
|
|
|
int i, j;
|
|
|
|
u8 isr;
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
for (i = 0; i < 1000; i++) {
|
2005-09-26 06:04:21 +00:00
|
|
|
isr = kw_read_reg(reg_isr) & KW_I2C_IRQ_MASK;
|
|
|
|
if (isr != 0)
|
|
|
|
return isr;
|
|
|
|
|
|
|
|
/* This code is used with the timebase frozen, we cannot rely
|
2006-01-07 00:30:44 +00:00
|
|
|
* on udelay nor schedule when in polled mode !
|
|
|
|
* For now, just use a bogus loop....
|
2005-09-26 06:04:21 +00:00
|
|
|
*/
|
2006-01-07 00:35:26 +00:00
|
|
|
if (host->polled) {
|
|
|
|
for (j = 1; j < 100000; j++)
|
2006-01-07 00:30:44 +00:00
|
|
|
mb();
|
|
|
|
} else
|
|
|
|
msleep(1);
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
return isr;
|
|
|
|
}
|
|
|
|
|
2006-04-18 04:11:53 +00:00
|
|
|
static void kw_i2c_do_stop(struct pmac_i2c_host_kw *host, int result)
|
|
|
|
{
|
|
|
|
kw_write_reg(reg_control, KW_I2C_CTL_STOP);
|
|
|
|
host->state = state_stop;
|
|
|
|
host->result = result;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
static void kw_i2c_handle_interrupt(struct pmac_i2c_host_kw *host, u8 isr)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
|
|
|
u8 ack;
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
DBG_LOW("kw_handle_interrupt(%s, isr: %x)\n",
|
2006-01-07 00:35:26 +00:00
|
|
|
__kw_state_names[host->state], isr);
|
|
|
|
|
|
|
|
if (host->state == state_idle) {
|
|
|
|
printk(KERN_WARNING "low_i2c: Keywest got an out of state"
|
|
|
|
" interrupt, ignoring\n");
|
|
|
|
kw_write_reg(reg_isr, isr);
|
|
|
|
return;
|
|
|
|
}
|
2005-09-26 06:04:21 +00:00
|
|
|
|
|
|
|
if (isr == 0) {
|
2006-04-18 04:11:53 +00:00
|
|
|
printk(KERN_WARNING "low_i2c: Timeout in i2c transfer"
|
|
|
|
" on keywest !\n");
|
2006-01-07 00:35:26 +00:00
|
|
|
if (host->state != state_stop) {
|
2006-04-18 04:11:53 +00:00
|
|
|
kw_i2c_do_stop(host, -EIO);
|
|
|
|
return;
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
2006-04-18 04:11:53 +00:00
|
|
|
ack = kw_read_reg(reg_status);
|
|
|
|
if (ack & KW_I2C_STAT_BUSY)
|
|
|
|
kw_write_reg(reg_status, 0);
|
|
|
|
host->state = state_idle;
|
|
|
|
kw_write_reg(reg_ier, 0x00);
|
|
|
|
if (!host->polled)
|
|
|
|
complete(&host->complete);
|
2006-01-07 00:35:26 +00:00
|
|
|
return;
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
if (isr & KW_I2C_IRQ_ADDR) {
|
|
|
|
ack = kw_read_reg(reg_status);
|
2006-01-07 00:35:26 +00:00
|
|
|
if (host->state != state_addr) {
|
2005-09-26 06:04:21 +00:00
|
|
|
WRONG_STATE("KW_I2C_IRQ_ADDR");
|
2006-04-18 04:11:53 +00:00
|
|
|
kw_i2c_do_stop(host, -EIO);
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
2006-01-07 00:30:44 +00:00
|
|
|
if ((ack & KW_I2C_STAT_LAST_AAK) == 0) {
|
2006-04-18 04:11:53 +00:00
|
|
|
host->result = -ENXIO;
|
2006-01-07 00:35:26 +00:00
|
|
|
host->state = state_stop;
|
2006-04-18 04:11:53 +00:00
|
|
|
DBG_LOW("KW: NAK on address\n");
|
2005-09-26 06:04:21 +00:00
|
|
|
} else {
|
2006-04-18 04:11:53 +00:00
|
|
|
if (host->len == 0)
|
|
|
|
kw_i2c_do_stop(host, 0);
|
|
|
|
else if (host->rw) {
|
2006-01-07 00:35:26 +00:00
|
|
|
host->state = state_read;
|
|
|
|
if (host->len > 1)
|
2006-01-07 00:30:44 +00:00
|
|
|
kw_write_reg(reg_control,
|
|
|
|
KW_I2C_CTL_AAK);
|
2005-09-26 06:04:21 +00:00
|
|
|
} else {
|
2006-01-07 00:35:26 +00:00
|
|
|
host->state = state_write;
|
|
|
|
kw_write_reg(reg_data, *(host->data++));
|
|
|
|
host->len--;
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
kw_write_reg(reg_isr, KW_I2C_IRQ_ADDR);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (isr & KW_I2C_IRQ_DATA) {
|
2006-01-07 00:35:26 +00:00
|
|
|
if (host->state == state_read) {
|
|
|
|
*(host->data++) = kw_read_reg(reg_data);
|
|
|
|
host->len--;
|
2005-09-26 06:04:21 +00:00
|
|
|
kw_write_reg(reg_isr, KW_I2C_IRQ_DATA);
|
2006-01-07 00:35:26 +00:00
|
|
|
if (host->len == 0)
|
|
|
|
host->state = state_stop;
|
|
|
|
else if (host->len == 1)
|
2005-09-26 06:04:21 +00:00
|
|
|
kw_write_reg(reg_control, 0);
|
2006-01-07 00:35:26 +00:00
|
|
|
} else if (host->state == state_write) {
|
2005-09-26 06:04:21 +00:00
|
|
|
ack = kw_read_reg(reg_status);
|
|
|
|
if ((ack & KW_I2C_STAT_LAST_AAK) == 0) {
|
2006-01-07 00:30:44 +00:00
|
|
|
DBG_LOW("KW: nack on data write\n");
|
2006-04-18 04:11:53 +00:00
|
|
|
host->result = -EFBIG;
|
|
|
|
host->state = state_stop;
|
2006-01-07 00:35:26 +00:00
|
|
|
} else if (host->len) {
|
|
|
|
kw_write_reg(reg_data, *(host->data++));
|
|
|
|
host->len--;
|
2006-04-18 04:11:53 +00:00
|
|
|
} else
|
|
|
|
kw_i2c_do_stop(host, 0);
|
2005-09-26 06:04:21 +00:00
|
|
|
} else {
|
|
|
|
WRONG_STATE("KW_I2C_IRQ_DATA");
|
2006-04-18 04:11:53 +00:00
|
|
|
if (host->state != state_stop)
|
|
|
|
kw_i2c_do_stop(host, -EIO);
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
2006-04-18 04:11:53 +00:00
|
|
|
kw_write_reg(reg_isr, KW_I2C_IRQ_DATA);
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
if (isr & KW_I2C_IRQ_STOP) {
|
|
|
|
kw_write_reg(reg_isr, KW_I2C_IRQ_STOP);
|
2006-01-07 00:35:26 +00:00
|
|
|
if (host->state != state_stop) {
|
2005-09-26 06:04:21 +00:00
|
|
|
WRONG_STATE("KW_I2C_IRQ_STOP");
|
2006-01-07 00:35:26 +00:00
|
|
|
host->result = -EIO;
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
2006-01-07 00:35:26 +00:00
|
|
|
host->state = state_idle;
|
|
|
|
if (!host->polled)
|
|
|
|
complete(&host->complete);
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
2006-04-18 04:11:53 +00:00
|
|
|
/* Below should only happen in manual mode which we don't use ... */
|
2005-09-26 06:04:21 +00:00
|
|
|
if (isr & KW_I2C_IRQ_START)
|
|
|
|
kw_write_reg(reg_isr, KW_I2C_IRQ_START);
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Interrupt handler */
|
IRQ: Maintain regs pointer globally rather than passing to IRQ handlers
Maintain a per-CPU global "struct pt_regs *" variable which can be used instead
of passing regs around manually through all ~1800 interrupt handlers in the
Linux kernel.
The regs pointer is used in few places, but it potentially costs both stack
space and code to pass it around. On the FRV arch, removing the regs parameter
from all the genirq function results in a 20% speed up of the IRQ exit path
(ie: from leaving timer_interrupt() to leaving do_IRQ()).
Where appropriate, an arch may override the generic storage facility and do
something different with the variable. On FRV, for instance, the address is
maintained in GR28 at all times inside the kernel as part of general exception
handling.
Having looked over the code, it appears that the parameter may be handed down
through up to twenty or so layers of functions. Consider a USB character
device attached to a USB hub, attached to a USB controller that posts its
interrupts through a cascaded auxiliary interrupt controller. A character
device driver may want to pass regs to the sysrq handler through the input
layer which adds another few layers of parameter passing.
I've build this code with allyesconfig for x86_64 and i386. I've runtested the
main part of the code on FRV and i386, though I can't test most of the drivers.
I've also done partial conversion for powerpc and MIPS - these at least compile
with minimal configurations.
This will affect all archs. Mostly the changes should be relatively easy.
Take do_IRQ(), store the regs pointer at the beginning, saving the old one:
struct pt_regs *old_regs = set_irq_regs(regs);
And put the old one back at the end:
set_irq_regs(old_regs);
Don't pass regs through to generic_handle_irq() or __do_IRQ().
In timer_interrupt(), this sort of change will be necessary:
- update_process_times(user_mode(regs));
- profile_tick(CPU_PROFILING, regs);
+ update_process_times(user_mode(get_irq_regs()));
+ profile_tick(CPU_PROFILING);
I'd like to move update_process_times()'s use of get_irq_regs() into itself,
except that i386, alone of the archs, uses something other than user_mode().
Some notes on the interrupt handling in the drivers:
(*) input_dev() is now gone entirely. The regs pointer is no longer stored in
the input_dev struct.
(*) finish_unlinks() in drivers/usb/host/ohci-q.c needs checking. It does
something different depending on whether it's been supplied with a regs
pointer or not.
(*) Various IRQ handler function pointers have been moved to type
irq_handler_t.
Signed-Off-By: David Howells <dhowells@redhat.com>
(cherry picked from 1b16e7ac850969f38b375e511e3fa2f474a33867 commit)
2006-10-05 13:55:46 +00:00
|
|
|
static irqreturn_t kw_i2c_irq(int irq, void *dev_id)
|
2006-01-07 00:35:26 +00:00
|
|
|
{
|
|
|
|
struct pmac_i2c_host_kw *host = dev_id;
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&host->lock, flags);
|
|
|
|
del_timer(&host->timeout_timer);
|
|
|
|
kw_i2c_handle_interrupt(host, kw_read_reg(reg_isr));
|
|
|
|
if (host->state != state_idle) {
|
|
|
|
host->timeout_timer.expires = jiffies + KW_POLL_TIMEOUT;
|
|
|
|
add_timer(&host->timeout_timer);
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(&host->lock, flags);
|
|
|
|
return IRQ_HANDLED;
|
|
|
|
}
|
|
|
|
|
treewide: setup_timer() -> timer_setup()
This converts all remaining cases of the old setup_timer() API into using
timer_setup(), where the callback argument is the structure already
holding the struct timer_list. These should have no behavioral changes,
since they just change which pointer is passed into the callback with
the same available pointers after conversion. It handles the following
examples, in addition to some other variations.
Casting from unsigned long:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
setup_timer(&ptr->my_timer, my_callback, ptr);
and forced object casts:
void my_callback(struct something *ptr)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, (unsigned long)ptr);
become:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
Direct function assignments:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
ptr->my_timer.function = my_callback;
have a temporary cast added, along with converting the args:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
ptr->my_timer.function = (TIMER_FUNC_TYPE)my_callback;
And finally, callbacks without a data assignment:
void my_callback(unsigned long data)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, 0);
have their argument renamed to verify they're unused during conversion:
void my_callback(struct timer_list *unused)
{
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
The conversion is done with the following Coccinelle script:
spatch --very-quiet --all-includes --include-headers \
-I ./arch/x86/include -I ./arch/x86/include/generated \
-I ./include -I ./arch/x86/include/uapi \
-I ./arch/x86/include/generated/uapi -I ./include/uapi \
-I ./include/generated/uapi --include ./include/linux/kconfig.h \
--dir . \
--cocci-file ~/src/data/timer_setup.cocci
@fix_address_of@
expression e;
@@
setup_timer(
-&(e)
+&e
, ...)
// Update any raw setup_timer() usages that have a NULL callback, but
// would otherwise match change_timer_function_usage, since the latter
// will update all function assignments done in the face of a NULL
// function initialization in setup_timer().
@change_timer_function_usage_NULL@
expression _E;
identifier _timer;
type _cast_data;
@@
(
-setup_timer(&_E->_timer, NULL, _E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E->_timer, NULL, (_cast_data)_E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, &_E);
+timer_setup(&_E._timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, (_cast_data)&_E);
+timer_setup(&_E._timer, NULL, 0);
)
@change_timer_function_usage@
expression _E;
identifier _timer;
struct timer_list _stl;
identifier _callback;
type _cast_func, _cast_data;
@@
(
-setup_timer(&_E->_timer, _callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
_E->_timer@_stl.function = _callback;
|
_E->_timer@_stl.function = &_callback;
|
_E->_timer@_stl.function = (_cast_func)_callback;
|
_E->_timer@_stl.function = (_cast_func)&_callback;
|
_E._timer@_stl.function = _callback;
|
_E._timer@_stl.function = &_callback;
|
_E._timer@_stl.function = (_cast_func)_callback;
|
_E._timer@_stl.function = (_cast_func)&_callback;
)
// callback(unsigned long arg)
@change_callback_handle_cast
depends on change_timer_function_usage@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
identifier _handle;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
(
... when != _origarg
_handletype *_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
)
}
// callback(unsigned long arg) without existing variable
@change_callback_handle_cast_no_arg
depends on change_timer_function_usage &&
!change_callback_handle_cast@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
+ _handletype *_origarg = from_timer(_origarg, t, _timer);
+
... when != _origarg
- (_handletype *)_origarg
+ _origarg
... when != _origarg
}
// Avoid already converted callbacks.
@match_callback_converted
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier t;
@@
void _callback(struct timer_list *t)
{ ... }
// callback(struct something *handle)
@change_callback_handle_arg
depends on change_timer_function_usage &&
!match_callback_converted &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
@@
void _callback(
-_handletype *_handle
+struct timer_list *t
)
{
+ _handletype *_handle = from_timer(_handle, t, _timer);
...
}
// If change_callback_handle_arg ran on an empty function, remove
// the added handler.
@unchange_callback_handle_arg
depends on change_timer_function_usage &&
change_callback_handle_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
identifier t;
@@
void _callback(struct timer_list *t)
{
- _handletype *_handle = from_timer(_handle, t, _timer);
}
// We only want to refactor the setup_timer() data argument if we've found
// the matching callback. This undoes changes in change_timer_function_usage.
@unchange_timer_function_usage
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg &&
!change_callback_handle_arg@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type change_timer_function_usage._cast_data;
@@
(
-timer_setup(&_E->_timer, _callback, 0);
+setup_timer(&_E->_timer, _callback, (_cast_data)_E);
|
-timer_setup(&_E._timer, _callback, 0);
+setup_timer(&_E._timer, _callback, (_cast_data)&_E);
)
// If we fixed a callback from a .function assignment, fix the
// assignment cast now.
@change_timer_function_assignment
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_func;
typedef TIMER_FUNC_TYPE;
@@
(
_E->_timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-&_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
)
// Sometimes timer functions are called directly. Replace matched args.
@change_timer_function_calls
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression _E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_data;
@@
_callback(
(
-(_cast_data)_E
+&_E->_timer
|
-(_cast_data)&_E
+&_E._timer
|
-_E
+&_E->_timer
)
)
// If a timer has been configured without a data argument, it can be
// converted without regard to the callback argument, since it is unused.
@match_timer_function_unused_data@
expression _E;
identifier _timer;
identifier _callback;
@@
(
-setup_timer(&_E->_timer, _callback, 0);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0L);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0UL);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0L);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0UL);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0L);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0UL);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0L);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0UL);
+timer_setup(_timer, _callback, 0);
)
@change_callback_unused_data
depends on match_timer_function_unused_data@
identifier match_timer_function_unused_data._callback;
type _origtype;
identifier _origarg;
@@
void _callback(
-_origtype _origarg
+struct timer_list *unused
)
{
... when != _origarg
}
Signed-off-by: Kees Cook <keescook@chromium.org>
2017-10-16 21:43:17 +00:00
|
|
|
static void kw_i2c_timeout(struct timer_list *t)
|
2006-01-07 00:35:26 +00:00
|
|
|
{
|
treewide: setup_timer() -> timer_setup()
This converts all remaining cases of the old setup_timer() API into using
timer_setup(), where the callback argument is the structure already
holding the struct timer_list. These should have no behavioral changes,
since they just change which pointer is passed into the callback with
the same available pointers after conversion. It handles the following
examples, in addition to some other variations.
Casting from unsigned long:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
setup_timer(&ptr->my_timer, my_callback, ptr);
and forced object casts:
void my_callback(struct something *ptr)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, (unsigned long)ptr);
become:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
Direct function assignments:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
ptr->my_timer.function = my_callback;
have a temporary cast added, along with converting the args:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
ptr->my_timer.function = (TIMER_FUNC_TYPE)my_callback;
And finally, callbacks without a data assignment:
void my_callback(unsigned long data)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, 0);
have their argument renamed to verify they're unused during conversion:
void my_callback(struct timer_list *unused)
{
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
The conversion is done with the following Coccinelle script:
spatch --very-quiet --all-includes --include-headers \
-I ./arch/x86/include -I ./arch/x86/include/generated \
-I ./include -I ./arch/x86/include/uapi \
-I ./arch/x86/include/generated/uapi -I ./include/uapi \
-I ./include/generated/uapi --include ./include/linux/kconfig.h \
--dir . \
--cocci-file ~/src/data/timer_setup.cocci
@fix_address_of@
expression e;
@@
setup_timer(
-&(e)
+&e
, ...)
// Update any raw setup_timer() usages that have a NULL callback, but
// would otherwise match change_timer_function_usage, since the latter
// will update all function assignments done in the face of a NULL
// function initialization in setup_timer().
@change_timer_function_usage_NULL@
expression _E;
identifier _timer;
type _cast_data;
@@
(
-setup_timer(&_E->_timer, NULL, _E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E->_timer, NULL, (_cast_data)_E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, &_E);
+timer_setup(&_E._timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, (_cast_data)&_E);
+timer_setup(&_E._timer, NULL, 0);
)
@change_timer_function_usage@
expression _E;
identifier _timer;
struct timer_list _stl;
identifier _callback;
type _cast_func, _cast_data;
@@
(
-setup_timer(&_E->_timer, _callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
_E->_timer@_stl.function = _callback;
|
_E->_timer@_stl.function = &_callback;
|
_E->_timer@_stl.function = (_cast_func)_callback;
|
_E->_timer@_stl.function = (_cast_func)&_callback;
|
_E._timer@_stl.function = _callback;
|
_E._timer@_stl.function = &_callback;
|
_E._timer@_stl.function = (_cast_func)_callback;
|
_E._timer@_stl.function = (_cast_func)&_callback;
)
// callback(unsigned long arg)
@change_callback_handle_cast
depends on change_timer_function_usage@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
identifier _handle;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
(
... when != _origarg
_handletype *_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
)
}
// callback(unsigned long arg) without existing variable
@change_callback_handle_cast_no_arg
depends on change_timer_function_usage &&
!change_callback_handle_cast@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
+ _handletype *_origarg = from_timer(_origarg, t, _timer);
+
... when != _origarg
- (_handletype *)_origarg
+ _origarg
... when != _origarg
}
// Avoid already converted callbacks.
@match_callback_converted
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier t;
@@
void _callback(struct timer_list *t)
{ ... }
// callback(struct something *handle)
@change_callback_handle_arg
depends on change_timer_function_usage &&
!match_callback_converted &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
@@
void _callback(
-_handletype *_handle
+struct timer_list *t
)
{
+ _handletype *_handle = from_timer(_handle, t, _timer);
...
}
// If change_callback_handle_arg ran on an empty function, remove
// the added handler.
@unchange_callback_handle_arg
depends on change_timer_function_usage &&
change_callback_handle_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
identifier t;
@@
void _callback(struct timer_list *t)
{
- _handletype *_handle = from_timer(_handle, t, _timer);
}
// We only want to refactor the setup_timer() data argument if we've found
// the matching callback. This undoes changes in change_timer_function_usage.
@unchange_timer_function_usage
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg &&
!change_callback_handle_arg@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type change_timer_function_usage._cast_data;
@@
(
-timer_setup(&_E->_timer, _callback, 0);
+setup_timer(&_E->_timer, _callback, (_cast_data)_E);
|
-timer_setup(&_E._timer, _callback, 0);
+setup_timer(&_E._timer, _callback, (_cast_data)&_E);
)
// If we fixed a callback from a .function assignment, fix the
// assignment cast now.
@change_timer_function_assignment
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_func;
typedef TIMER_FUNC_TYPE;
@@
(
_E->_timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-&_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
)
// Sometimes timer functions are called directly. Replace matched args.
@change_timer_function_calls
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression _E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_data;
@@
_callback(
(
-(_cast_data)_E
+&_E->_timer
|
-(_cast_data)&_E
+&_E._timer
|
-_E
+&_E->_timer
)
)
// If a timer has been configured without a data argument, it can be
// converted without regard to the callback argument, since it is unused.
@match_timer_function_unused_data@
expression _E;
identifier _timer;
identifier _callback;
@@
(
-setup_timer(&_E->_timer, _callback, 0);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0L);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0UL);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0L);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0UL);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0L);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0UL);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0L);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0UL);
+timer_setup(_timer, _callback, 0);
)
@change_callback_unused_data
depends on match_timer_function_unused_data@
identifier match_timer_function_unused_data._callback;
type _origtype;
identifier _origarg;
@@
void _callback(
-_origtype _origarg
+struct timer_list *unused
)
{
... when != _origarg
}
Signed-off-by: Kees Cook <keescook@chromium.org>
2017-10-16 21:43:17 +00:00
|
|
|
struct pmac_i2c_host_kw *host = from_timer(host, t, timeout_timer);
|
2006-01-07 00:35:26 +00:00
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&host->lock, flags);
|
2012-04-18 22:16:48 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* If the timer is pending, that means we raced with the
|
|
|
|
* irq, in which case we just return
|
|
|
|
*/
|
|
|
|
if (timer_pending(&host->timeout_timer))
|
|
|
|
goto skip;
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
kw_i2c_handle_interrupt(host, kw_read_reg(reg_isr));
|
|
|
|
if (host->state != state_idle) {
|
|
|
|
host->timeout_timer.expires = jiffies + KW_POLL_TIMEOUT;
|
|
|
|
add_timer(&host->timeout_timer);
|
|
|
|
}
|
2012-04-18 22:16:48 +00:00
|
|
|
skip:
|
2006-01-07 00:35:26 +00:00
|
|
|
spin_unlock_irqrestore(&host->lock, flags);
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
static int kw_i2c_open(struct pmac_i2c_bus *bus)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
struct pmac_i2c_host_kw *host = bus->hostdata;
|
2007-07-03 23:01:54 +00:00
|
|
|
mutex_lock(&host->mutex);
|
2006-01-07 00:30:44 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void kw_i2c_close(struct pmac_i2c_bus *bus)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_host_kw *host = bus->hostdata;
|
2007-07-03 23:01:54 +00:00
|
|
|
mutex_unlock(&host->mutex);
|
2006-01-07 00:30:44 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int kw_i2c_xfer(struct pmac_i2c_bus *bus, u8 addrdir, int subsize,
|
|
|
|
u32 subaddr, u8 *data, int len)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_host_kw *host = bus->hostdata;
|
2005-09-26 06:04:21 +00:00
|
|
|
u8 mode_reg = host->speed;
|
2016-09-06 11:53:24 +00:00
|
|
|
int use_irq = host->irq && !bus->polled;
|
2005-09-26 06:04:21 +00:00
|
|
|
|
|
|
|
/* Setup mode & subaddress if any */
|
2006-01-07 00:30:44 +00:00
|
|
|
switch(bus->mode) {
|
|
|
|
case pmac_i2c_mode_dumb:
|
2005-09-26 06:04:21 +00:00
|
|
|
return -EINVAL;
|
2006-01-07 00:30:44 +00:00
|
|
|
case pmac_i2c_mode_std:
|
2005-09-26 06:04:21 +00:00
|
|
|
mode_reg |= KW_I2C_MODE_STANDARD;
|
2006-01-07 00:30:44 +00:00
|
|
|
if (subsize != 0)
|
|
|
|
return -EINVAL;
|
2005-09-26 06:04:21 +00:00
|
|
|
break;
|
2006-01-07 00:30:44 +00:00
|
|
|
case pmac_i2c_mode_stdsub:
|
2005-09-26 06:04:21 +00:00
|
|
|
mode_reg |= KW_I2C_MODE_STANDARDSUB;
|
2006-01-07 00:30:44 +00:00
|
|
|
if (subsize != 1)
|
|
|
|
return -EINVAL;
|
2005-09-26 06:04:21 +00:00
|
|
|
break;
|
2006-01-07 00:30:44 +00:00
|
|
|
case pmac_i2c_mode_combined:
|
2005-09-26 06:04:21 +00:00
|
|
|
mode_reg |= KW_I2C_MODE_COMBINED;
|
2006-01-07 00:30:44 +00:00
|
|
|
if (subsize != 1)
|
|
|
|
return -EINVAL;
|
2005-09-26 06:04:21 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Setup channel & clear pending irqs */
|
|
|
|
kw_write_reg(reg_isr, kw_read_reg(reg_isr));
|
2006-01-07 00:30:44 +00:00
|
|
|
kw_write_reg(reg_mode, mode_reg | (bus->channel << 4));
|
2005-09-26 06:04:21 +00:00
|
|
|
kw_write_reg(reg_status, 0);
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
/* Set up address and r/w bit, strip possible stale bus number from
|
|
|
|
* address top bits
|
|
|
|
*/
|
|
|
|
kw_write_reg(reg_addr, addrdir & 0xff);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
|
|
|
/* Set up the sub address */
|
|
|
|
if ((mode_reg & KW_I2C_MODE_MODE_MASK) == KW_I2C_MODE_STANDARDSUB
|
|
|
|
|| (mode_reg & KW_I2C_MODE_MODE_MASK) == KW_I2C_MODE_COMBINED)
|
|
|
|
kw_write_reg(reg_subaddr, subaddr);
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
/* Prepare for async operations */
|
|
|
|
host->data = data;
|
|
|
|
host->len = len;
|
|
|
|
host->state = state_addr;
|
|
|
|
host->result = 0;
|
|
|
|
host->rw = (addrdir & 1);
|
|
|
|
host->polled = bus->polled;
|
|
|
|
|
|
|
|
/* Enable interrupt if not using polled mode and interrupt is
|
|
|
|
* available
|
|
|
|
*/
|
|
|
|
if (use_irq) {
|
|
|
|
/* Clear completion */
|
2013-11-14 22:32:02 +00:00
|
|
|
reinit_completion(&host->complete);
|
2006-01-07 00:35:26 +00:00
|
|
|
/* Ack stale interrupts */
|
|
|
|
kw_write_reg(reg_isr, kw_read_reg(reg_isr));
|
|
|
|
/* Arm timeout */
|
|
|
|
host->timeout_timer.expires = jiffies + KW_POLL_TIMEOUT;
|
|
|
|
add_timer(&host->timeout_timer);
|
|
|
|
/* Enable emission */
|
|
|
|
kw_write_reg(reg_ier, KW_I2C_IRQ_MASK);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Start sending address */
|
2005-09-26 06:04:21 +00:00
|
|
|
kw_write_reg(reg_control, KW_I2C_CTL_XADDR);
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
/* Wait for completion */
|
|
|
|
if (use_irq)
|
|
|
|
wait_for_completion(&host->complete);
|
|
|
|
else {
|
|
|
|
while(host->state != state_idle) {
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
u8 isr = kw_i2c_wait_interrupt(host);
|
|
|
|
spin_lock_irqsave(&host->lock, flags);
|
|
|
|
kw_i2c_handle_interrupt(host, isr);
|
|
|
|
spin_unlock_irqrestore(&host->lock, flags);
|
|
|
|
}
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
/* Disable emission */
|
|
|
|
kw_write_reg(reg_ier, 0);
|
|
|
|
|
|
|
|
return host->result;
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
static struct pmac_i2c_host_kw *__init kw_i2c_host_init(struct device_node *np)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
struct pmac_i2c_host_kw *host;
|
2006-07-12 05:40:29 +00:00
|
|
|
const u32 *psteps, *prate, *addrp;
|
|
|
|
u32 steps;
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2017-01-19 16:15:30 +00:00
|
|
|
host = kzalloc(sizeof(*host), GFP_KERNEL);
|
2005-09-26 06:04:21 +00:00
|
|
|
if (host == NULL) {
|
2017-08-21 15:16:47 +00:00
|
|
|
printk(KERN_ERR "low_i2c: Can't allocate host for %pOF\n",
|
|
|
|
np);
|
2006-01-07 00:30:44 +00:00
|
|
|
return NULL;
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
2005-11-23 06:57:25 +00:00
|
|
|
/* Apple is kind enough to provide a valid AAPL,address property
|
|
|
|
* on all i2c keywest nodes so far ... we would have to fallback
|
|
|
|
* to macio parsing if that wasn't the case
|
|
|
|
*/
|
2007-04-03 12:26:41 +00:00
|
|
|
addrp = of_get_property(np, "AAPL,address", NULL);
|
2005-11-23 06:57:25 +00:00
|
|
|
if (addrp == NULL) {
|
2017-08-21 15:16:47 +00:00
|
|
|
printk(KERN_ERR "low_i2c: Can't find address for %pOF\n",
|
|
|
|
np);
|
2006-01-07 00:30:44 +00:00
|
|
|
kfree(host);
|
|
|
|
return NULL;
|
2005-11-23 06:57:25 +00:00
|
|
|
}
|
2007-07-03 23:01:54 +00:00
|
|
|
mutex_init(&host->mutex);
|
2006-01-07 00:35:26 +00:00
|
|
|
init_completion(&host->complete);
|
|
|
|
spin_lock_init(&host->lock);
|
treewide: setup_timer() -> timer_setup()
This converts all remaining cases of the old setup_timer() API into using
timer_setup(), where the callback argument is the structure already
holding the struct timer_list. These should have no behavioral changes,
since they just change which pointer is passed into the callback with
the same available pointers after conversion. It handles the following
examples, in addition to some other variations.
Casting from unsigned long:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
setup_timer(&ptr->my_timer, my_callback, ptr);
and forced object casts:
void my_callback(struct something *ptr)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, (unsigned long)ptr);
become:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
Direct function assignments:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
ptr->my_timer.function = my_callback;
have a temporary cast added, along with converting the args:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
ptr->my_timer.function = (TIMER_FUNC_TYPE)my_callback;
And finally, callbacks without a data assignment:
void my_callback(unsigned long data)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, 0);
have their argument renamed to verify they're unused during conversion:
void my_callback(struct timer_list *unused)
{
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
The conversion is done with the following Coccinelle script:
spatch --very-quiet --all-includes --include-headers \
-I ./arch/x86/include -I ./arch/x86/include/generated \
-I ./include -I ./arch/x86/include/uapi \
-I ./arch/x86/include/generated/uapi -I ./include/uapi \
-I ./include/generated/uapi --include ./include/linux/kconfig.h \
--dir . \
--cocci-file ~/src/data/timer_setup.cocci
@fix_address_of@
expression e;
@@
setup_timer(
-&(e)
+&e
, ...)
// Update any raw setup_timer() usages that have a NULL callback, but
// would otherwise match change_timer_function_usage, since the latter
// will update all function assignments done in the face of a NULL
// function initialization in setup_timer().
@change_timer_function_usage_NULL@
expression _E;
identifier _timer;
type _cast_data;
@@
(
-setup_timer(&_E->_timer, NULL, _E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E->_timer, NULL, (_cast_data)_E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, &_E);
+timer_setup(&_E._timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, (_cast_data)&_E);
+timer_setup(&_E._timer, NULL, 0);
)
@change_timer_function_usage@
expression _E;
identifier _timer;
struct timer_list _stl;
identifier _callback;
type _cast_func, _cast_data;
@@
(
-setup_timer(&_E->_timer, _callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
_E->_timer@_stl.function = _callback;
|
_E->_timer@_stl.function = &_callback;
|
_E->_timer@_stl.function = (_cast_func)_callback;
|
_E->_timer@_stl.function = (_cast_func)&_callback;
|
_E._timer@_stl.function = _callback;
|
_E._timer@_stl.function = &_callback;
|
_E._timer@_stl.function = (_cast_func)_callback;
|
_E._timer@_stl.function = (_cast_func)&_callback;
)
// callback(unsigned long arg)
@change_callback_handle_cast
depends on change_timer_function_usage@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
identifier _handle;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
(
... when != _origarg
_handletype *_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
)
}
// callback(unsigned long arg) without existing variable
@change_callback_handle_cast_no_arg
depends on change_timer_function_usage &&
!change_callback_handle_cast@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
+ _handletype *_origarg = from_timer(_origarg, t, _timer);
+
... when != _origarg
- (_handletype *)_origarg
+ _origarg
... when != _origarg
}
// Avoid already converted callbacks.
@match_callback_converted
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier t;
@@
void _callback(struct timer_list *t)
{ ... }
// callback(struct something *handle)
@change_callback_handle_arg
depends on change_timer_function_usage &&
!match_callback_converted &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
@@
void _callback(
-_handletype *_handle
+struct timer_list *t
)
{
+ _handletype *_handle = from_timer(_handle, t, _timer);
...
}
// If change_callback_handle_arg ran on an empty function, remove
// the added handler.
@unchange_callback_handle_arg
depends on change_timer_function_usage &&
change_callback_handle_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
identifier t;
@@
void _callback(struct timer_list *t)
{
- _handletype *_handle = from_timer(_handle, t, _timer);
}
// We only want to refactor the setup_timer() data argument if we've found
// the matching callback. This undoes changes in change_timer_function_usage.
@unchange_timer_function_usage
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg &&
!change_callback_handle_arg@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type change_timer_function_usage._cast_data;
@@
(
-timer_setup(&_E->_timer, _callback, 0);
+setup_timer(&_E->_timer, _callback, (_cast_data)_E);
|
-timer_setup(&_E._timer, _callback, 0);
+setup_timer(&_E._timer, _callback, (_cast_data)&_E);
)
// If we fixed a callback from a .function assignment, fix the
// assignment cast now.
@change_timer_function_assignment
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_func;
typedef TIMER_FUNC_TYPE;
@@
(
_E->_timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-&_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
)
// Sometimes timer functions are called directly. Replace matched args.
@change_timer_function_calls
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression _E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_data;
@@
_callback(
(
-(_cast_data)_E
+&_E->_timer
|
-(_cast_data)&_E
+&_E._timer
|
-_E
+&_E->_timer
)
)
// If a timer has been configured without a data argument, it can be
// converted without regard to the callback argument, since it is unused.
@match_timer_function_unused_data@
expression _E;
identifier _timer;
identifier _callback;
@@
(
-setup_timer(&_E->_timer, _callback, 0);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0L);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0UL);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0L);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0UL);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0L);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0UL);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0L);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0UL);
+timer_setup(_timer, _callback, 0);
)
@change_callback_unused_data
depends on match_timer_function_unused_data@
identifier match_timer_function_unused_data._callback;
type _origtype;
identifier _origarg;
@@
void _callback(
-_origtype _origarg
+struct timer_list *unused
)
{
... when != _origarg
}
Signed-off-by: Kees Cook <keescook@chromium.org>
2017-10-16 21:43:17 +00:00
|
|
|
timer_setup(&host->timeout_timer, kw_i2c_timeout, 0);
|
2006-01-07 00:35:26 +00:00
|
|
|
|
2007-04-03 12:26:41 +00:00
|
|
|
psteps = of_get_property(np, "AAPL,address-step", NULL);
|
2005-09-26 06:04:21 +00:00
|
|
|
steps = psteps ? (*psteps) : 0x10;
|
|
|
|
for (host->bsteps = 0; (steps & 0x01) == 0; host->bsteps++)
|
|
|
|
steps >>= 1;
|
|
|
|
/* Select interface rate */
|
2005-11-23 06:57:25 +00:00
|
|
|
host->speed = KW_I2C_MODE_25KHZ;
|
2007-04-03 12:26:41 +00:00
|
|
|
prate = of_get_property(np, "AAPL,i2c-rate", NULL);
|
2005-09-26 06:04:21 +00:00
|
|
|
if (prate) switch(*prate) {
|
|
|
|
case 100:
|
|
|
|
host->speed = KW_I2C_MODE_100KHZ;
|
|
|
|
break;
|
|
|
|
case 50:
|
|
|
|
host->speed = KW_I2C_MODE_50KHZ;
|
|
|
|
break;
|
|
|
|
case 25:
|
|
|
|
host->speed = KW_I2C_MODE_25KHZ;
|
|
|
|
break;
|
|
|
|
}
|
2006-07-03 11:36:01 +00:00
|
|
|
host->irq = irq_of_parse_and_map(np, 0);
|
2016-09-06 11:53:24 +00:00
|
|
|
if (!host->irq)
|
2006-07-03 11:36:01 +00:00
|
|
|
printk(KERN_WARNING
|
2017-08-21 15:16:47 +00:00
|
|
|
"low_i2c: Failed to map interrupt for %pOF\n",
|
|
|
|
np);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2005-11-23 06:57:25 +00:00
|
|
|
host->base = ioremap((*addrp), 0x1000);
|
2006-01-07 00:35:26 +00:00
|
|
|
if (host->base == NULL) {
|
2017-08-21 15:16:47 +00:00
|
|
|
printk(KERN_ERR "low_i2c: Can't map registers for %pOF\n",
|
|
|
|
np);
|
2006-01-07 00:35:26 +00:00
|
|
|
kfree(host);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2006-04-18 04:11:53 +00:00
|
|
|
/* Make sure IRQ is disabled */
|
2006-01-07 00:35:26 +00:00
|
|
|
kw_write_reg(reg_ier, 0);
|
|
|
|
|
2010-07-29 10:16:34 +00:00
|
|
|
/* Request chip interrupt. We set IRQF_NO_SUSPEND because we don't
|
2009-10-09 11:27:54 +00:00
|
|
|
* want that interrupt disabled between the 2 passes of driver
|
|
|
|
* suspend or we'll have issues running the pfuncs
|
|
|
|
*/
|
2010-07-29 10:16:34 +00:00
|
|
|
if (request_irq(host->irq, kw_i2c_irq, IRQF_NO_SUSPEND,
|
|
|
|
"keywest i2c", host))
|
2016-09-06 11:53:24 +00:00
|
|
|
host->irq = 0;
|
2006-01-07 00:35:26 +00:00
|
|
|
|
2017-08-21 15:16:47 +00:00
|
|
|
printk(KERN_INFO "KeyWest i2c @0x%08x irq %d %pOF\n",
|
|
|
|
*addrp, host->irq, np);
|
2006-01-07 00:30:44 +00:00
|
|
|
|
|
|
|
return host;
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
|
|
|
|
static void __init kw_i2c_add(struct pmac_i2c_host_kw *host,
|
|
|
|
struct device_node *controller,
|
|
|
|
struct device_node *busnode,
|
|
|
|
int channel)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_bus *bus;
|
|
|
|
|
|
|
|
bus = kzalloc(sizeof(struct pmac_i2c_bus), GFP_KERNEL);
|
|
|
|
if (bus == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
bus->controller = of_node_get(controller);
|
|
|
|
bus->busnode = of_node_get(busnode);
|
|
|
|
bus->type = pmac_i2c_bus_keywest;
|
|
|
|
bus->hostdata = host;
|
|
|
|
bus->channel = channel;
|
|
|
|
bus->mode = pmac_i2c_mode_std;
|
|
|
|
bus->open = kw_i2c_open;
|
|
|
|
bus->close = kw_i2c_close;
|
|
|
|
bus->xfer = kw_i2c_xfer;
|
2007-07-03 23:01:54 +00:00
|
|
|
mutex_init(&bus->mutex);
|
2021-11-30 09:32:42 +00:00
|
|
|
lockdep_register_key(&bus->lock_key);
|
2016-09-21 11:34:58 +00:00
|
|
|
lockdep_set_class(&bus->mutex, &bus->lock_key);
|
2006-01-07 00:30:44 +00:00
|
|
|
if (controller == busnode)
|
|
|
|
bus->flags = pmac_i2c_multibus;
|
|
|
|
list_add(&bus->link, &pmac_i2c_busses);
|
|
|
|
|
|
|
|
printk(KERN_INFO " channel %d bus %s\n", channel,
|
|
|
|
(controller == busnode) ? "<multibus>" : busnode->full_name);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __init kw_i2c_probe(void)
|
|
|
|
{
|
|
|
|
struct device_node *np, *child, *parent;
|
|
|
|
|
|
|
|
/* Probe keywest-i2c busses */
|
2007-11-29 19:46:54 +00:00
|
|
|
for_each_compatible_node(np, "i2c","keywest-i2c") {
|
2006-01-07 00:30:44 +00:00
|
|
|
struct pmac_i2c_host_kw *host;
|
2010-02-06 02:13:29 +00:00
|
|
|
int multibus;
|
2006-01-07 00:30:44 +00:00
|
|
|
|
|
|
|
/* Found one, init a host structure */
|
|
|
|
host = kw_i2c_host_init(np);
|
|
|
|
if (host == NULL)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
/* Now check if we have a multibus setup (old style) or if we
|
|
|
|
* have proper bus nodes. Note that the "new" way (proper bus
|
|
|
|
* nodes) might cause us to not create some busses that are
|
|
|
|
* kept hidden in the device-tree. In the future, we might
|
|
|
|
* want to work around that by creating busses without a node
|
|
|
|
* but not for now
|
|
|
|
*/
|
|
|
|
child = of_get_next_child(np, NULL);
|
2018-12-05 19:50:18 +00:00
|
|
|
multibus = !of_node_name_eq(child, "i2c-bus");
|
2006-01-07 00:30:44 +00:00
|
|
|
of_node_put(child);
|
|
|
|
|
|
|
|
/* For a multibus setup, we get the bus count based on the
|
|
|
|
* parent type
|
|
|
|
*/
|
|
|
|
if (multibus) {
|
2010-02-06 02:13:29 +00:00
|
|
|
int chans, i;
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
parent = of_get_parent(np);
|
|
|
|
if (parent == NULL)
|
|
|
|
continue;
|
|
|
|
chans = parent->name[0] == 'u' ? 2 : 1;
|
|
|
|
for (i = 0; i < chans; i++)
|
|
|
|
kw_i2c_add(host, np, np, i);
|
|
|
|
} else {
|
2020-07-28 02:28:07 +00:00
|
|
|
for_each_child_of_node(np, child) {
|
2007-04-03 12:26:41 +00:00
|
|
|
const u32 *reg = of_get_property(child,
|
2006-07-12 05:40:29 +00:00
|
|
|
"reg", NULL);
|
2006-01-07 00:30:44 +00:00
|
|
|
if (reg == NULL)
|
|
|
|
continue;
|
|
|
|
kw_i2c_add(host, np, child, *reg);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2005-09-26 06:04:21 +00:00
|
|
|
/*
|
|
|
|
*
|
|
|
|
* PMU implementation
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#ifdef CONFIG_ADB_PMU
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
/*
|
|
|
|
* i2c command block to the PMU
|
|
|
|
*/
|
|
|
|
struct pmu_i2c_hdr {
|
|
|
|
u8 bus;
|
|
|
|
u8 mode;
|
|
|
|
u8 bus2;
|
|
|
|
u8 address;
|
|
|
|
u8 sub_addr;
|
|
|
|
u8 comb_addr;
|
|
|
|
u8 count;
|
|
|
|
u8 data[];
|
|
|
|
};
|
|
|
|
|
|
|
|
static void pmu_i2c_complete(struct adb_request *req)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
complete(req->arg);
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
static int pmu_i2c_xfer(struct pmac_i2c_bus *bus, u8 addrdir, int subsize,
|
|
|
|
u32 subaddr, u8 *data, int len)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
struct adb_request *req = bus->hostdata;
|
|
|
|
struct pmu_i2c_hdr *hdr = (struct pmu_i2c_hdr *)&req->data[1];
|
|
|
|
struct completion comp;
|
|
|
|
int read = addrdir & 1;
|
|
|
|
int retry;
|
|
|
|
int rc = 0;
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
/* For now, limit ourselves to 16 bytes transfers */
|
|
|
|
if (len > 16)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
init_completion(&comp);
|
|
|
|
|
|
|
|
for (retry = 0; retry < 16; retry++) {
|
|
|
|
memset(req, 0, sizeof(struct adb_request));
|
|
|
|
hdr->bus = bus->channel;
|
|
|
|
hdr->count = len;
|
|
|
|
|
|
|
|
switch(bus->mode) {
|
|
|
|
case pmac_i2c_mode_std:
|
|
|
|
if (subsize != 0)
|
|
|
|
return -EINVAL;
|
|
|
|
hdr->address = addrdir;
|
|
|
|
hdr->mode = PMU_I2C_MODE_SIMPLE;
|
|
|
|
break;
|
|
|
|
case pmac_i2c_mode_stdsub:
|
|
|
|
case pmac_i2c_mode_combined:
|
|
|
|
if (subsize != 1)
|
|
|
|
return -EINVAL;
|
|
|
|
hdr->address = addrdir & 0xfe;
|
|
|
|
hdr->comb_addr = addrdir;
|
|
|
|
hdr->sub_addr = subaddr;
|
|
|
|
if (bus->mode == pmac_i2c_mode_stdsub)
|
|
|
|
hdr->mode = PMU_I2C_MODE_STDSUB;
|
|
|
|
else
|
|
|
|
hdr->mode = PMU_I2C_MODE_COMBINED;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2013-11-14 22:32:02 +00:00
|
|
|
reinit_completion(&comp);
|
2006-01-07 00:30:44 +00:00
|
|
|
req->data[0] = PMU_I2C_CMD;
|
|
|
|
req->reply[0] = 0xff;
|
|
|
|
req->nbytes = sizeof(struct pmu_i2c_hdr) + 1;
|
|
|
|
req->done = pmu_i2c_complete;
|
|
|
|
req->arg = ∁
|
2006-01-07 00:35:26 +00:00
|
|
|
if (!read && len) {
|
2006-01-07 00:30:44 +00:00
|
|
|
memcpy(hdr->data, data, len);
|
|
|
|
req->nbytes += len;
|
|
|
|
}
|
|
|
|
rc = pmu_queue_request(req);
|
|
|
|
if (rc)
|
|
|
|
return rc;
|
|
|
|
wait_for_completion(&comp);
|
|
|
|
if (req->reply[0] == PMU_I2C_STATUS_OK)
|
|
|
|
break;
|
|
|
|
msleep(15);
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
2006-01-07 00:30:44 +00:00
|
|
|
if (req->reply[0] != PMU_I2C_STATUS_OK)
|
|
|
|
return -EIO;
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
for (retry = 0; retry < 16; retry++) {
|
|
|
|
memset(req, 0, sizeof(struct adb_request));
|
|
|
|
|
|
|
|
/* I know that looks like a lot, slow as hell, but darwin
|
|
|
|
* does it so let's be on the safe side for now
|
|
|
|
*/
|
|
|
|
msleep(15);
|
|
|
|
|
|
|
|
hdr->bus = PMU_I2C_BUS_STATUS;
|
|
|
|
|
2013-11-14 22:32:02 +00:00
|
|
|
reinit_completion(&comp);
|
2006-01-07 00:30:44 +00:00
|
|
|
req->data[0] = PMU_I2C_CMD;
|
|
|
|
req->reply[0] = 0xff;
|
|
|
|
req->nbytes = 2;
|
|
|
|
req->done = pmu_i2c_complete;
|
|
|
|
req->arg = ∁
|
|
|
|
rc = pmu_queue_request(req);
|
|
|
|
if (rc)
|
|
|
|
return rc;
|
|
|
|
wait_for_completion(&comp);
|
|
|
|
|
|
|
|
if (req->reply[0] == PMU_I2C_STATUS_OK && !read)
|
|
|
|
return 0;
|
|
|
|
if (req->reply[0] == PMU_I2C_STATUS_DATAREAD && read) {
|
|
|
|
int rlen = req->reply_len - 1;
|
|
|
|
|
|
|
|
if (rlen != len) {
|
|
|
|
printk(KERN_WARNING "low_i2c: PMU returned %d"
|
|
|
|
" bytes, expected %d !\n", rlen, len);
|
|
|
|
return -EIO;
|
|
|
|
}
|
2006-01-07 00:35:26 +00:00
|
|
|
if (len)
|
|
|
|
memcpy(data, &req->reply[1], len);
|
2006-01-07 00:30:44 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __init pmu_i2c_probe(void)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_bus *bus;
|
|
|
|
struct device_node *busnode;
|
|
|
|
int channel, sz;
|
|
|
|
|
|
|
|
if (!pmu_present())
|
|
|
|
return;
|
|
|
|
|
|
|
|
/* There might or might not be a "pmu-i2c" node, we use that
|
|
|
|
* or via-pmu itself, whatever we find. I haven't seen a machine
|
|
|
|
* with separate bus nodes, so we assume a multibus setup
|
|
|
|
*/
|
|
|
|
busnode = of_find_node_by_name(NULL, "pmu-i2c");
|
|
|
|
if (busnode == NULL)
|
|
|
|
busnode = of_find_node_by_name(NULL, "via-pmu");
|
|
|
|
if (busnode == NULL)
|
|
|
|
return;
|
|
|
|
|
2017-08-21 15:16:47 +00:00
|
|
|
printk(KERN_INFO "PMU i2c %pOF\n", busnode);
|
2006-01-07 00:30:44 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* We add bus 1 and 2 only for now, bus 0 is "special"
|
|
|
|
*/
|
|
|
|
for (channel = 1; channel <= 2; channel++) {
|
|
|
|
sz = sizeof(struct pmac_i2c_bus) + sizeof(struct adb_request);
|
|
|
|
bus = kzalloc(sz, GFP_KERNEL);
|
|
|
|
if (bus == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
bus->controller = busnode;
|
|
|
|
bus->busnode = busnode;
|
|
|
|
bus->type = pmac_i2c_bus_pmu;
|
|
|
|
bus->channel = channel;
|
|
|
|
bus->mode = pmac_i2c_mode_std;
|
|
|
|
bus->hostdata = bus + 1;
|
|
|
|
bus->xfer = pmu_i2c_xfer;
|
2007-07-03 23:01:54 +00:00
|
|
|
mutex_init(&bus->mutex);
|
2021-12-08 17:36:52 +00:00
|
|
|
lockdep_register_key(&bus->lock_key);
|
2016-09-21 11:34:58 +00:00
|
|
|
lockdep_set_class(&bus->mutex, &bus->lock_key);
|
2006-01-07 00:30:44 +00:00
|
|
|
bus->flags = pmac_i2c_multibus;
|
|
|
|
list_add(&bus->link, &pmac_i2c_busses);
|
|
|
|
|
|
|
|
printk(KERN_INFO " channel %d bus <multibus>\n", channel);
|
|
|
|
}
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
#endif /* CONFIG_ADB_PMU */
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
*
|
|
|
|
* SMU implementation
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#ifdef CONFIG_PMAC_SMU
|
|
|
|
|
|
|
|
static void smu_i2c_complete(struct smu_i2c_cmd *cmd, void *misc)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
complete(misc);
|
|
|
|
}
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
static int smu_i2c_xfer(struct pmac_i2c_bus *bus, u8 addrdir, int subsize,
|
|
|
|
u32 subaddr, u8 *data, int len)
|
|
|
|
{
|
|
|
|
struct smu_i2c_cmd *cmd = bus->hostdata;
|
|
|
|
struct completion comp;
|
|
|
|
int read = addrdir & 1;
|
|
|
|
int rc = 0;
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
if ((read && len > SMU_I2C_READ_MAX) ||
|
|
|
|
((!read) && len > SMU_I2C_WRITE_MAX))
|
|
|
|
return -EINVAL;
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
memset(cmd, 0, sizeof(struct smu_i2c_cmd));
|
|
|
|
cmd->info.bus = bus->channel;
|
|
|
|
cmd->info.devaddr = addrdir;
|
|
|
|
cmd->info.datalen = len;
|
|
|
|
|
|
|
|
switch(bus->mode) {
|
|
|
|
case pmac_i2c_mode_std:
|
|
|
|
if (subsize != 0)
|
|
|
|
return -EINVAL;
|
|
|
|
cmd->info.type = SMU_I2C_TRANSFER_SIMPLE;
|
|
|
|
break;
|
|
|
|
case pmac_i2c_mode_stdsub:
|
|
|
|
case pmac_i2c_mode_combined:
|
|
|
|
if (subsize > 3 || subsize < 1)
|
|
|
|
return -EINVAL;
|
|
|
|
cmd->info.sublen = subsize;
|
|
|
|
/* that's big-endian only but heh ! */
|
|
|
|
memcpy(&cmd->info.subaddr, ((char *)&subaddr) + (4 - subsize),
|
|
|
|
subsize);
|
|
|
|
if (bus->mode == pmac_i2c_mode_stdsub)
|
|
|
|
cmd->info.type = SMU_I2C_TRANSFER_STDSUB;
|
|
|
|
else
|
|
|
|
cmd->info.type = SMU_I2C_TRANSFER_COMBINED;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return -EINVAL;
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
2006-01-07 00:35:26 +00:00
|
|
|
if (!read && len)
|
2006-01-07 00:30:44 +00:00
|
|
|
memcpy(cmd->info.data, data, len);
|
|
|
|
|
|
|
|
init_completion(&comp);
|
|
|
|
cmd->done = smu_i2c_complete;
|
|
|
|
cmd->misc = ∁
|
|
|
|
rc = smu_queue_i2c(cmd);
|
|
|
|
if (rc < 0)
|
|
|
|
return rc;
|
|
|
|
wait_for_completion(&comp);
|
|
|
|
rc = cmd->status;
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
if (read && len)
|
2006-01-07 00:30:44 +00:00
|
|
|
memcpy(data, cmd->info.data, len);
|
|
|
|
return rc < 0 ? rc : 0;
|
|
|
|
}
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
static void __init smu_i2c_probe(void)
|
|
|
|
{
|
|
|
|
struct device_node *controller, *busnode;
|
|
|
|
struct pmac_i2c_bus *bus;
|
2006-07-12 05:40:29 +00:00
|
|
|
const u32 *reg;
|
2006-01-07 00:30:44 +00:00
|
|
|
int sz;
|
|
|
|
|
|
|
|
if (!smu_present())
|
|
|
|
return;
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
controller = of_find_node_by_name(NULL, "smu-i2c-control");
|
2006-01-07 00:30:44 +00:00
|
|
|
if (controller == NULL)
|
|
|
|
controller = of_find_node_by_name(NULL, "smu");
|
|
|
|
if (controller == NULL)
|
|
|
|
return;
|
|
|
|
|
2017-08-21 15:16:47 +00:00
|
|
|
printk(KERN_INFO "SMU i2c %pOF\n", controller);
|
2006-01-07 00:30:44 +00:00
|
|
|
|
|
|
|
/* Look for childs, note that they might not be of the right
|
2011-03-31 01:57:33 +00:00
|
|
|
* type as older device trees mix i2c busses and other things
|
2006-01-07 00:30:44 +00:00
|
|
|
* at the same level
|
|
|
|
*/
|
2018-11-16 22:11:00 +00:00
|
|
|
for_each_child_of_node(controller, busnode) {
|
|
|
|
if (!of_node_is_type(busnode, "i2c") &&
|
|
|
|
!of_node_is_type(busnode, "i2c-bus"))
|
2006-01-07 00:30:44 +00:00
|
|
|
continue;
|
2007-04-03 12:26:41 +00:00
|
|
|
reg = of_get_property(busnode, "reg", NULL);
|
2006-01-07 00:30:44 +00:00
|
|
|
if (reg == NULL)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
sz = sizeof(struct pmac_i2c_bus) + sizeof(struct smu_i2c_cmd);
|
|
|
|
bus = kzalloc(sz, GFP_KERNEL);
|
|
|
|
if (bus == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
bus->controller = controller;
|
|
|
|
bus->busnode = of_node_get(busnode);
|
|
|
|
bus->type = pmac_i2c_bus_smu;
|
|
|
|
bus->channel = *reg;
|
|
|
|
bus->mode = pmac_i2c_mode_std;
|
|
|
|
bus->hostdata = bus + 1;
|
|
|
|
bus->xfer = smu_i2c_xfer;
|
2007-07-03 23:01:54 +00:00
|
|
|
mutex_init(&bus->mutex);
|
2021-12-08 17:36:52 +00:00
|
|
|
lockdep_register_key(&bus->lock_key);
|
2016-09-21 11:34:58 +00:00
|
|
|
lockdep_set_class(&bus->mutex, &bus->lock_key);
|
2006-01-07 00:30:44 +00:00
|
|
|
bus->flags = 0;
|
|
|
|
list_add(&bus->link, &pmac_i2c_busses);
|
|
|
|
|
2017-08-21 15:16:47 +00:00
|
|
|
printk(KERN_INFO " channel %x bus %pOF\n",
|
|
|
|
bus->channel, busnode);
|
2006-01-07 00:30:44 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif /* CONFIG_PMAC_SMU */
|
|
|
|
|
|
|
|
/*
|
|
|
|
*
|
|
|
|
* Core code
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
struct pmac_i2c_bus *pmac_i2c_find_bus(struct device_node *node)
|
|
|
|
{
|
|
|
|
struct device_node *p = of_node_get(node);
|
|
|
|
struct device_node *prev = NULL;
|
|
|
|
struct pmac_i2c_bus *bus;
|
|
|
|
|
|
|
|
while(p) {
|
|
|
|
list_for_each_entry(bus, &pmac_i2c_busses, link) {
|
|
|
|
if (p == bus->busnode) {
|
|
|
|
if (prev && bus->flags & pmac_i2c_multibus) {
|
2006-07-12 05:40:29 +00:00
|
|
|
const u32 *reg;
|
2007-04-03 12:26:41 +00:00
|
|
|
reg = of_get_property(prev, "reg",
|
|
|
|
NULL);
|
2006-01-07 00:30:44 +00:00
|
|
|
if (!reg)
|
|
|
|
continue;
|
|
|
|
if (((*reg) >> 8) != bus->channel)
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
of_node_put(p);
|
|
|
|
of_node_put(prev);
|
|
|
|
return bus;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
of_node_put(prev);
|
|
|
|
prev = p;
|
|
|
|
p = of_get_parent(p);
|
|
|
|
}
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_find_bus);
|
|
|
|
|
|
|
|
u8 pmac_i2c_get_dev_addr(struct device_node *device)
|
|
|
|
{
|
2007-04-03 12:26:41 +00:00
|
|
|
const u32 *reg = of_get_property(device, "reg", NULL);
|
2006-01-07 00:30:44 +00:00
|
|
|
|
|
|
|
if (reg == NULL)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
return (*reg) & 0xff;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_get_dev_addr);
|
|
|
|
|
|
|
|
struct device_node *pmac_i2c_get_controller(struct pmac_i2c_bus *bus)
|
|
|
|
{
|
|
|
|
return bus->controller;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_get_controller);
|
|
|
|
|
|
|
|
struct device_node *pmac_i2c_get_bus_node(struct pmac_i2c_bus *bus)
|
|
|
|
{
|
|
|
|
return bus->busnode;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_get_bus_node);
|
|
|
|
|
|
|
|
int pmac_i2c_get_type(struct pmac_i2c_bus *bus)
|
|
|
|
{
|
|
|
|
return bus->type;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_get_type);
|
|
|
|
|
|
|
|
int pmac_i2c_get_flags(struct pmac_i2c_bus *bus)
|
|
|
|
{
|
|
|
|
return bus->flags;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_get_flags);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
int pmac_i2c_get_channel(struct pmac_i2c_bus *bus)
|
|
|
|
{
|
|
|
|
return bus->channel;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_get_channel);
|
|
|
|
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
struct i2c_adapter *pmac_i2c_get_adapter(struct pmac_i2c_bus *bus)
|
|
|
|
{
|
2009-12-06 16:06:19 +00:00
|
|
|
return &bus->adapter;
|
2006-01-07 00:30:44 +00:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_get_adapter);
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
struct pmac_i2c_bus *pmac_i2c_adapter_to_bus(struct i2c_adapter *adapter)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_bus *bus;
|
|
|
|
|
|
|
|
list_for_each_entry(bus, &pmac_i2c_busses, link)
|
2009-12-06 16:06:19 +00:00
|
|
|
if (&bus->adapter == adapter)
|
2006-01-07 00:35:26 +00:00
|
|
|
return bus;
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_adapter_to_bus);
|
|
|
|
|
2006-02-01 12:25:14 +00:00
|
|
|
int pmac_i2c_match_adapter(struct device_node *dev, struct i2c_adapter *adapter)
|
2006-01-07 00:30:44 +00:00
|
|
|
{
|
|
|
|
struct pmac_i2c_bus *bus = pmac_i2c_find_bus(dev);
|
|
|
|
|
|
|
|
if (bus == NULL)
|
|
|
|
return 0;
|
2009-12-06 16:06:19 +00:00
|
|
|
return (&bus->adapter == adapter);
|
2006-01-07 00:30:44 +00:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_match_adapter);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
|
|
|
int pmac_low_i2c_lock(struct device_node *np)
|
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
struct pmac_i2c_bus *bus, *found = NULL;
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
list_for_each_entry(bus, &pmac_i2c_busses, link) {
|
|
|
|
if (np == bus->controller) {
|
|
|
|
found = bus;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (!found)
|
2005-09-26 06:04:21 +00:00
|
|
|
return -ENODEV;
|
2006-01-07 00:30:44 +00:00
|
|
|
return pmac_i2c_open(bus, 0);
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
2006-01-07 00:30:44 +00:00
|
|
|
EXPORT_SYMBOL_GPL(pmac_low_i2c_lock);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
|
|
|
int pmac_low_i2c_unlock(struct device_node *np)
|
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
struct pmac_i2c_bus *bus, *found = NULL;
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
list_for_each_entry(bus, &pmac_i2c_busses, link) {
|
|
|
|
if (np == bus->controller) {
|
|
|
|
found = bus;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (!found)
|
2005-09-26 06:04:21 +00:00
|
|
|
return -ENODEV;
|
2006-01-07 00:30:44 +00:00
|
|
|
pmac_i2c_close(bus);
|
2005-09-26 06:04:21 +00:00
|
|
|
return 0;
|
|
|
|
}
|
2006-01-07 00:30:44 +00:00
|
|
|
EXPORT_SYMBOL_GPL(pmac_low_i2c_unlock);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
int pmac_i2c_open(struct pmac_i2c_bus *bus, int polled)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
int rc;
|
|
|
|
|
2007-07-03 23:01:54 +00:00
|
|
|
mutex_lock(&bus->mutex);
|
2006-01-07 00:35:26 +00:00
|
|
|
bus->polled = polled || pmac_i2c_force_poll;
|
2006-01-07 00:30:44 +00:00
|
|
|
bus->opened = 1;
|
|
|
|
bus->mode = pmac_i2c_mode_std;
|
|
|
|
if (bus->open && (rc = bus->open(bus)) != 0) {
|
|
|
|
bus->opened = 0;
|
2007-07-03 23:01:54 +00:00
|
|
|
mutex_unlock(&bus->mutex);
|
2006-01-07 00:30:44 +00:00
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_open);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
void pmac_i2c_close(struct pmac_i2c_bus *bus)
|
|
|
|
{
|
|
|
|
WARN_ON(!bus->opened);
|
|
|
|
if (bus->close)
|
|
|
|
bus->close(bus);
|
|
|
|
bus->opened = 0;
|
2007-07-03 23:01:54 +00:00
|
|
|
mutex_unlock(&bus->mutex);
|
2006-01-07 00:30:44 +00:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_close);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
int pmac_i2c_setmode(struct pmac_i2c_bus *bus, int mode)
|
|
|
|
{
|
|
|
|
WARN_ON(!bus->opened);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
/* Report me if you see the error below as there might be a new
|
|
|
|
* "combined4" mode that I need to implement for the SMU bus
|
|
|
|
*/
|
|
|
|
if (mode < pmac_i2c_mode_dumb || mode > pmac_i2c_mode_combined) {
|
|
|
|
printk(KERN_ERR "low_i2c: Invalid mode %d requested on"
|
2017-08-21 15:16:47 +00:00
|
|
|
" bus %pOF !\n", mode, bus->busnode);
|
2006-01-07 00:30:44 +00:00
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
bus->mode = mode;
|
2005-09-26 06:04:21 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
2006-01-07 00:30:44 +00:00
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_setmode);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
int pmac_i2c_xfer(struct pmac_i2c_bus *bus, u8 addrdir, int subsize,
|
|
|
|
u32 subaddr, u8 *data, int len)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
int rc;
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
WARN_ON(!bus->opened);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
DBG("xfer() chan=%d, addrdir=0x%x, mode=%d, subsize=%d, subaddr=0x%x,"
|
2017-08-21 15:16:47 +00:00
|
|
|
" %d bytes, bus %pOF\n", bus->channel, addrdir, bus->mode, subsize,
|
|
|
|
subaddr, len, bus->busnode);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
rc = bus->xfer(bus, addrdir, subsize, subaddr, data, len);
|
|
|
|
|
|
|
|
#ifdef DEBUG
|
|
|
|
if (rc)
|
|
|
|
DBG("xfer error %d\n", rc);
|
|
|
|
#endif
|
|
|
|
return rc;
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
2006-01-07 00:30:44 +00:00
|
|
|
EXPORT_SYMBOL_GPL(pmac_i2c_xfer);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:41:02 +00:00
|
|
|
/* some quirks for platform function decoding */
|
|
|
|
enum {
|
|
|
|
pmac_i2c_quirk_invmask = 0x00000001u,
|
2006-05-31 04:26:51 +00:00
|
|
|
pmac_i2c_quirk_skip = 0x00000002u,
|
2006-01-07 00:41:02 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
static void pmac_i2c_devscan(void (*callback)(struct device_node *dev,
|
|
|
|
int quirks))
|
|
|
|
{
|
|
|
|
struct pmac_i2c_bus *bus;
|
|
|
|
struct device_node *np;
|
|
|
|
static struct whitelist_ent {
|
|
|
|
char *name;
|
|
|
|
char *compatible;
|
|
|
|
int quirks;
|
|
|
|
} whitelist[] = {
|
|
|
|
/* XXX Study device-tree's & apple drivers are get the quirks
|
|
|
|
* right !
|
|
|
|
*/
|
2006-05-31 04:26:51 +00:00
|
|
|
/* Workaround: It seems that running the clockspreading
|
|
|
|
* properties on the eMac will cause lockups during boot.
|
|
|
|
* The machine seems to work fine without that. So for now,
|
|
|
|
* let's make sure i2c-hwclock doesn't match about "imic"
|
|
|
|
* clocks and we'll figure out if we really need to do
|
|
|
|
* something special about those later.
|
|
|
|
*/
|
|
|
|
{ "i2c-hwclock", "imic5002", pmac_i2c_quirk_skip },
|
|
|
|
{ "i2c-hwclock", "imic5003", pmac_i2c_quirk_skip },
|
2006-01-07 00:41:02 +00:00
|
|
|
{ "i2c-hwclock", NULL, pmac_i2c_quirk_invmask },
|
|
|
|
{ "i2c-cpu-voltage", NULL, 0},
|
|
|
|
{ "temp-monitor", NULL, 0 },
|
|
|
|
{ "supply-monitor", NULL, 0 },
|
|
|
|
{ NULL, NULL, 0 },
|
|
|
|
};
|
|
|
|
|
2018-08-24 00:00:52 +00:00
|
|
|
/* Only some devices need to have platform functions instantiated
|
2006-01-07 00:41:02 +00:00
|
|
|
* here. For now, we have a table. Others, like 9554 i2c GPIOs used
|
|
|
|
* on Xserve, if we ever do a driver for them, will use their own
|
|
|
|
* platform function instance
|
|
|
|
*/
|
|
|
|
list_for_each_entry(bus, &pmac_i2c_busses, link) {
|
2020-07-28 02:28:07 +00:00
|
|
|
for_each_child_of_node(bus->busnode, np) {
|
2006-01-07 00:41:02 +00:00
|
|
|
struct whitelist_ent *p;
|
|
|
|
/* If multibus, check if device is on that bus */
|
|
|
|
if (bus->flags & pmac_i2c_multibus)
|
|
|
|
if (bus != pmac_i2c_find_bus(np))
|
|
|
|
continue;
|
|
|
|
for (p = whitelist; p->name != NULL; p++) {
|
2018-12-05 19:50:18 +00:00
|
|
|
if (!of_node_name_eq(np, p->name))
|
2006-01-07 00:41:02 +00:00
|
|
|
continue;
|
|
|
|
if (p->compatible &&
|
2007-05-03 07:26:52 +00:00
|
|
|
!of_device_is_compatible(np, p->compatible))
|
2006-01-07 00:41:02 +00:00
|
|
|
continue;
|
2006-05-31 04:26:51 +00:00
|
|
|
if (p->quirks & pmac_i2c_quirk_skip)
|
|
|
|
break;
|
2006-01-07 00:41:02 +00:00
|
|
|
callback(np, p->quirks);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
#define MAX_I2C_DATA 64
|
|
|
|
|
|
|
|
struct pmac_i2c_pf_inst
|
|
|
|
{
|
|
|
|
struct pmac_i2c_bus *bus;
|
|
|
|
u8 addr;
|
|
|
|
u8 buffer[MAX_I2C_DATA];
|
|
|
|
u8 scratch[MAX_I2C_DATA];
|
|
|
|
int bytes;
|
|
|
|
int quirks;
|
|
|
|
};
|
|
|
|
|
|
|
|
static void* pmac_i2c_do_begin(struct pmf_function *func, struct pmf_args *args)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_pf_inst *inst;
|
|
|
|
struct pmac_i2c_bus *bus;
|
|
|
|
|
|
|
|
bus = pmac_i2c_find_bus(func->node);
|
|
|
|
if (bus == NULL) {
|
2017-08-21 15:16:47 +00:00
|
|
|
printk(KERN_ERR "low_i2c: Can't find bus for %pOF (pfunc)\n",
|
|
|
|
func->node);
|
2006-01-07 00:41:02 +00:00
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
if (pmac_i2c_open(bus, 0)) {
|
2017-08-21 15:16:47 +00:00
|
|
|
printk(KERN_ERR "low_i2c: Can't open i2c bus for %pOF (pfunc)\n",
|
|
|
|
func->node);
|
2006-01-07 00:41:02 +00:00
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* XXX might need GFP_ATOMIC when called during the suspend process,
|
|
|
|
* but then, there are already lots of issues with suspending when
|
|
|
|
* near OOM that need to be resolved, the allocator itself should
|
|
|
|
* probably make GFP_NOIO implicit during suspend
|
|
|
|
*/
|
|
|
|
inst = kzalloc(sizeof(struct pmac_i2c_pf_inst), GFP_KERNEL);
|
|
|
|
if (inst == NULL) {
|
|
|
|
pmac_i2c_close(bus);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
inst->bus = bus;
|
|
|
|
inst->addr = pmac_i2c_get_dev_addr(func->node);
|
|
|
|
inst->quirks = (int)(long)func->driver_data;
|
|
|
|
return inst;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pmac_i2c_do_end(struct pmf_function *func, void *instdata)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_pf_inst *inst = instdata;
|
|
|
|
|
|
|
|
if (inst == NULL)
|
|
|
|
return;
|
|
|
|
pmac_i2c_close(inst->bus);
|
2010-02-06 02:13:29 +00:00
|
|
|
kfree(inst);
|
2006-01-07 00:41:02 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int pmac_i2c_do_read(PMF_STD_ARGS, u32 len)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_pf_inst *inst = instdata;
|
|
|
|
|
|
|
|
inst->bytes = len;
|
|
|
|
return pmac_i2c_xfer(inst->bus, inst->addr | pmac_i2c_read, 0, 0,
|
|
|
|
inst->buffer, len);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int pmac_i2c_do_write(PMF_STD_ARGS, u32 len, const u8 *data)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_pf_inst *inst = instdata;
|
|
|
|
|
|
|
|
return pmac_i2c_xfer(inst->bus, inst->addr | pmac_i2c_write, 0, 0,
|
|
|
|
(u8 *)data, len);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* This function is used to do the masking & OR'ing for the "rmw" type
|
|
|
|
* callbacks. Ze should apply the mask and OR in the values in the
|
|
|
|
* buffer before writing back. The problem is that it seems that
|
|
|
|
* various darwin drivers implement the mask/or differently, thus
|
|
|
|
* we need to check the quirks first
|
|
|
|
*/
|
|
|
|
static void pmac_i2c_do_apply_rmw(struct pmac_i2c_pf_inst *inst,
|
|
|
|
u32 len, const u8 *mask, const u8 *val)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
|
|
|
if (inst->quirks & pmac_i2c_quirk_invmask) {
|
|
|
|
for (i = 0; i < len; i ++)
|
|
|
|
inst->scratch[i] = (inst->buffer[i] & mask[i]) | val[i];
|
|
|
|
} else {
|
|
|
|
for (i = 0; i < len; i ++)
|
|
|
|
inst->scratch[i] = (inst->buffer[i] & ~mask[i])
|
|
|
|
| (val[i] & mask[i]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static int pmac_i2c_do_rmw(PMF_STD_ARGS, u32 masklen, u32 valuelen,
|
|
|
|
u32 totallen, const u8 *maskdata,
|
|
|
|
const u8 *valuedata)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_pf_inst *inst = instdata;
|
|
|
|
|
|
|
|
if (masklen > inst->bytes || valuelen > inst->bytes ||
|
|
|
|
totallen > inst->bytes || valuelen > masklen)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
pmac_i2c_do_apply_rmw(inst, masklen, maskdata, valuedata);
|
|
|
|
|
|
|
|
return pmac_i2c_xfer(inst->bus, inst->addr | pmac_i2c_write, 0, 0,
|
|
|
|
inst->scratch, totallen);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int pmac_i2c_do_read_sub(PMF_STD_ARGS, u8 subaddr, u32 len)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_pf_inst *inst = instdata;
|
|
|
|
|
|
|
|
inst->bytes = len;
|
|
|
|
return pmac_i2c_xfer(inst->bus, inst->addr | pmac_i2c_read, 1, subaddr,
|
|
|
|
inst->buffer, len);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int pmac_i2c_do_write_sub(PMF_STD_ARGS, u8 subaddr, u32 len,
|
|
|
|
const u8 *data)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_pf_inst *inst = instdata;
|
|
|
|
|
|
|
|
return pmac_i2c_xfer(inst->bus, inst->addr | pmac_i2c_write, 1,
|
|
|
|
subaddr, (u8 *)data, len);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int pmac_i2c_do_set_mode(PMF_STD_ARGS, int mode)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_pf_inst *inst = instdata;
|
|
|
|
|
|
|
|
return pmac_i2c_setmode(inst->bus, mode);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int pmac_i2c_do_rmw_sub(PMF_STD_ARGS, u8 subaddr, u32 masklen,
|
|
|
|
u32 valuelen, u32 totallen, const u8 *maskdata,
|
|
|
|
const u8 *valuedata)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_pf_inst *inst = instdata;
|
|
|
|
|
|
|
|
if (masklen > inst->bytes || valuelen > inst->bytes ||
|
|
|
|
totallen > inst->bytes || valuelen > masklen)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
pmac_i2c_do_apply_rmw(inst, masklen, maskdata, valuedata);
|
|
|
|
|
|
|
|
return pmac_i2c_xfer(inst->bus, inst->addr | pmac_i2c_write, 1,
|
|
|
|
subaddr, inst->scratch, totallen);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int pmac_i2c_do_mask_and_comp(PMF_STD_ARGS, u32 len,
|
|
|
|
const u8 *maskdata,
|
|
|
|
const u8 *valuedata)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_pf_inst *inst = instdata;
|
|
|
|
int i, match;
|
|
|
|
|
|
|
|
/* Get return value pointer, it's assumed to be a u32 */
|
|
|
|
if (!args || !args->count || !args->u[0].p)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
/* Check buffer */
|
|
|
|
if (len > inst->bytes)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
for (i = 0, match = 1; match && i < len; i ++)
|
|
|
|
if ((inst->buffer[i] & maskdata[i]) != valuedata[i])
|
|
|
|
match = 0;
|
|
|
|
*args->u[0].p = match;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int pmac_i2c_do_delay(PMF_STD_ARGS, u32 duration)
|
|
|
|
{
|
|
|
|
msleep((duration + 999) / 1000);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static struct pmf_handlers pmac_i2c_pfunc_handlers = {
|
|
|
|
.begin = pmac_i2c_do_begin,
|
|
|
|
.end = pmac_i2c_do_end,
|
|
|
|
.read_i2c = pmac_i2c_do_read,
|
|
|
|
.write_i2c = pmac_i2c_do_write,
|
|
|
|
.rmw_i2c = pmac_i2c_do_rmw,
|
|
|
|
.read_i2c_sub = pmac_i2c_do_read_sub,
|
|
|
|
.write_i2c_sub = pmac_i2c_do_write_sub,
|
|
|
|
.rmw_i2c_sub = pmac_i2c_do_rmw_sub,
|
|
|
|
.set_i2c_mode = pmac_i2c_do_set_mode,
|
|
|
|
.mask_and_compare = pmac_i2c_do_mask_and_comp,
|
|
|
|
.delay = pmac_i2c_do_delay,
|
|
|
|
};
|
|
|
|
|
|
|
|
static void __init pmac_i2c_dev_create(struct device_node *np, int quirks)
|
|
|
|
{
|
2017-08-21 15:16:47 +00:00
|
|
|
DBG("dev_create(%pOF)\n", np);
|
2006-01-07 00:41:02 +00:00
|
|
|
|
|
|
|
pmf_register_driver(np, &pmac_i2c_pfunc_handlers,
|
|
|
|
(void *)(long)quirks);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __init pmac_i2c_dev_init(struct device_node *np, int quirks)
|
|
|
|
{
|
2017-08-21 15:16:47 +00:00
|
|
|
DBG("dev_create(%pOF)\n", np);
|
2006-01-07 00:41:02 +00:00
|
|
|
|
|
|
|
pmf_do_functions(np, NULL, 0, PMF_FLAGS_ON_INIT, NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pmac_i2c_dev_suspend(struct device_node *np, int quirks)
|
|
|
|
{
|
2017-08-21 15:16:47 +00:00
|
|
|
DBG("dev_suspend(%pOF)\n", np);
|
2006-01-07 00:41:02 +00:00
|
|
|
pmf_do_functions(np, NULL, 0, PMF_FLAGS_ON_SLEEP, NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pmac_i2c_dev_resume(struct device_node *np, int quirks)
|
|
|
|
{
|
2017-08-21 15:16:47 +00:00
|
|
|
DBG("dev_resume(%pOF)\n", np);
|
2006-01-07 00:41:02 +00:00
|
|
|
pmf_do_functions(np, NULL, 0, PMF_FLAGS_ON_WAKE, NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
void pmac_pfunc_i2c_suspend(void)
|
|
|
|
{
|
|
|
|
pmac_i2c_devscan(pmac_i2c_dev_suspend);
|
|
|
|
}
|
|
|
|
|
|
|
|
void pmac_pfunc_i2c_resume(void)
|
|
|
|
{
|
|
|
|
pmac_i2c_devscan(pmac_i2c_dev_resume);
|
|
|
|
}
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
/*
|
2006-01-07 00:41:02 +00:00
|
|
|
* Initialize us: probe all i2c busses on the machine, instantiate
|
|
|
|
* busses and platform functions as needed.
|
2006-01-07 00:30:44 +00:00
|
|
|
*/
|
|
|
|
/* This is non-static as it might be called early by smp code */
|
|
|
|
int __init pmac_i2c_init(void)
|
2005-09-26 06:04:21 +00:00
|
|
|
{
|
2006-01-07 00:30:44 +00:00
|
|
|
static int i2c_inited;
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
if (i2c_inited)
|
|
|
|
return 0;
|
|
|
|
i2c_inited = 1;
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
/* Probe keywest-i2c busses */
|
|
|
|
kw_i2c_probe();
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
#ifdef CONFIG_ADB_PMU
|
2006-01-07 00:35:26 +00:00
|
|
|
/* Probe PMU i2c busses */
|
2006-01-07 00:30:44 +00:00
|
|
|
pmu_i2c_probe();
|
|
|
|
#endif
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
#ifdef CONFIG_PMAC_SMU
|
2006-01-07 00:35:26 +00:00
|
|
|
/* Probe SMU i2c busses */
|
2006-01-07 00:30:44 +00:00
|
|
|
smu_i2c_probe();
|
|
|
|
#endif
|
2006-01-07 00:41:02 +00:00
|
|
|
|
2022-04-30 18:56:54 +00:00
|
|
|
/* Now add platform functions for some known devices */
|
2006-01-07 00:41:02 +00:00
|
|
|
pmac_i2c_devscan(pmac_i2c_dev_create);
|
|
|
|
|
2006-01-07 00:30:44 +00:00
|
|
|
return 0;
|
2005-09-26 06:04:21 +00:00
|
|
|
}
|
2008-01-02 19:14:28 +00:00
|
|
|
machine_arch_initcall(powermac, pmac_i2c_init);
|
2005-09-26 06:04:21 +00:00
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
/* Since pmac_i2c_init can be called too early for the platform device
|
|
|
|
* registration, we need to do it at a later time. In our case, subsys
|
|
|
|
* happens to fit well, though I agree it's a bit of a hack...
|
|
|
|
*/
|
|
|
|
static int __init pmac_i2c_create_platform_devices(void)
|
|
|
|
{
|
|
|
|
struct pmac_i2c_bus *bus;
|
|
|
|
int i = 0;
|
|
|
|
|
|
|
|
/* In the case where we are initialized from smp_init(), we must
|
|
|
|
* not use the timer (and thus the irq). It's safe from now on
|
|
|
|
* though
|
|
|
|
*/
|
|
|
|
pmac_i2c_force_poll = 0;
|
|
|
|
|
|
|
|
/* Create platform devices */
|
|
|
|
list_for_each_entry(bus, &pmac_i2c_busses, link) {
|
|
|
|
bus->platform_dev =
|
|
|
|
platform_device_alloc("i2c-powermac", i++);
|
|
|
|
if (bus->platform_dev == NULL)
|
|
|
|
return -ENOMEM;
|
|
|
|
bus->platform_dev->dev.platform_data = bus;
|
2012-04-18 22:16:42 +00:00
|
|
|
bus->platform_dev->dev.of_node = bus->busnode;
|
2006-01-07 00:35:26 +00:00
|
|
|
platform_device_add(bus->platform_dev);
|
|
|
|
}
|
|
|
|
|
2006-01-07 00:41:02 +00:00
|
|
|
/* Now call platform "init" functions */
|
|
|
|
pmac_i2c_devscan(pmac_i2c_dev_init);
|
|
|
|
|
2006-01-07 00:35:26 +00:00
|
|
|
return 0;
|
|
|
|
}
|
2008-01-02 19:14:28 +00:00
|
|
|
machine_subsys_initcall(powermac, pmac_i2c_create_platform_devices);
|