i2c: Move to Linux like struct i2c_msg
Our current struct for I2C segments `i2c_seg` was close to being compa- tible to the Linux version `i2c_msg`, close to being compatible to SMBus and close to being readable (e.g. what was `chip` supposed to mean?) but turned out to be hard to fix. Instead of extending it in a backwards compatible way (and not touching current controller drivers), replace it with a Linux source compatible `struct i2c_msg` and patch all the drivers and users with Coccinelle. The new `struct i2c_msg` should ease porting drivers from Linux and help to write SMBus compatible controller drivers. Beside integer type changes, the field `read` is replaced with a generic field `flags` and `chip` is renamed to `slave`. Patched with Coccinelle using the clumsy spatch below and some manual changes: * Nested struct initializers and one field access skipped by Coccinelle. * Removed assumption in the code that I2C_M_RD is 1. * In `i2c.h`, changed all occurences of `chip` to `slave`. @@ @@ -struct i2c_seg +struct i2c_msg @@ identifier msg; expression e; @@ ( struct i2c_msg msg = { - .read = 0, + .flags = 0, }; | struct i2c_msg msg = { - .read = 1, + .flags = I2C_M_RD, }; | struct i2c_msg msg = { - .chip = e, + .slave = e, }; ) @@ struct i2c_msg msg; statement S1, S2; @@ ( -if (msg.read) +if (msg.flags & I2C_M_RD) S1 else S2 | -if (msg.read) +if (msg.flags & I2C_M_RD) S1 ) @@ struct i2c_msg *msg; statement S1, S2; @@ ( -if (msg->read) +if (msg->flags & I2C_M_RD) S1 else S2 | -if (msg->read) +if (msg->flags & I2C_M_RD) S1 ) @@ struct i2c_msg msg; expression e; @@ ( -msg.read = 0; +msg.flags = 0; | -msg.read = 1; +msg.flags = I2C_M_RD; | -msg.read = e; +msg.flags = e ? I2C_M_RD : 0; | -!!(msg.read) +(msg.flags & I2C_M_RD) | -(msg.read) +(msg.flags & I2C_M_RD) ) @@ struct i2c_msg *msg; expression e; @@ ( -msg->read = 0; +msg->flags = 0; | -msg->read = 1; +msg->flags = I2C_M_RD; | -msg->read = e; +msg->flags = e ? I2C_M_RD : 0; | -!!(msg->read) +(msg->flags & I2C_M_RD) | -(msg->read) +(msg->flags & I2C_M_RD) ) @@ struct i2c_msg msg; @@ -msg.chip +msg.slave @@ struct i2c_msg *msg; expression e; @@ -msg[e].chip +msg[e].slave @ slave disable ptr_to_array @ struct i2c_msg *msg; @@ -msg->chip +msg->slave Change-Id: Ifd7cabf0a18ffd7a1def25d1d7059b713d0b7ea9 Signed-off-by: Nico Huber <nico.huber@secunet.com> Reviewed-on: https://review.coreboot.org/20542 Tested-by: build bot (Jenkins) <no-reply@coreboot.org> Reviewed-by: Aaron Durbin <adurbin@chromium.org> Reviewed-by: Werner Zeh <werner.zeh@siemens.com> Reviewed-by: Kyösti Mälkki <kyosti.malkki@gmail.com> Reviewed-by: Paul Menzel <paulepanter@users.sourceforge.net>
This commit is contained in:
parent
673e014fab
commit
029dfff30c
@ -185,10 +185,10 @@ static int i2c_write(struct a1x_twi *twi, uint8_t chip,
|
|||||||
return len;
|
return len;
|
||||||
}
|
}
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int count)
|
int platform_i2c_transfer(unsigned bus, struct i2c_msg *segments, int count)
|
||||||
{
|
{
|
||||||
int i, ret = CB_SUCCESS;
|
int i, ret = CB_SUCCESS;
|
||||||
struct i2c_seg *seg = segments;
|
struct i2c_msg *seg = segments;
|
||||||
struct a1x_twi *twi = (void *)TWI_BASE(bus);
|
struct a1x_twi *twi = (void *)TWI_BASE(bus);
|
||||||
|
|
||||||
|
|
||||||
@ -198,12 +198,12 @@ int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int count)
|
|||||||
for (i = 0; i < count; i++) {
|
for (i = 0; i < count; i++) {
|
||||||
seg = segments + i;
|
seg = segments + i;
|
||||||
|
|
||||||
if (seg->read) {
|
if (seg->flags & I2C_M_RD) {
|
||||||
ret = i2c_read(twi, seg->chip, seg->buf, seg->len);
|
ret = i2c_read(twi, seg->slave, seg->buf, seg->len);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
break;
|
break;
|
||||||
} else {
|
} else {
|
||||||
ret = i2c_write(twi, seg->chip, seg->buf, seg->len);
|
ret = i2c_write(twi, seg->slave, seg->buf, seg->len);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
@ -49,7 +49,7 @@ int i2c_dev_find_bus(struct device *dev)
|
|||||||
return ops->dev_to_bus(pbus->dev);
|
return ops->dev_to_bus(pbus->dev);
|
||||||
}
|
}
|
||||||
|
|
||||||
int i2c_dev_transfer(struct device *dev, struct i2c_seg *segments, int count)
|
int i2c_dev_transfer(struct device *dev, struct i2c_msg *segments, int count)
|
||||||
{
|
{
|
||||||
int bus = i2c_dev_find_bus(dev);
|
int bus = i2c_dev_find_bus(dev);
|
||||||
if (bus < 0)
|
if (bus < 0)
|
||||||
|
@ -238,19 +238,20 @@ static int in_byte(unsigned bus, int ack)
|
|||||||
return byte;
|
return byte;
|
||||||
}
|
}
|
||||||
|
|
||||||
int software_i2c_transfer(unsigned bus, struct i2c_seg *segments, int count)
|
int software_i2c_transfer(unsigned bus, struct i2c_msg *segments, int count)
|
||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
struct i2c_seg *seg;
|
struct i2c_msg *seg;
|
||||||
|
|
||||||
for (seg = segments; seg - segments < count; seg++) {
|
for (seg = segments; seg - segments < count; seg++) {
|
||||||
if (start_cond(bus) < 0)
|
if (start_cond(bus) < 0)
|
||||||
return -1;
|
return -1;
|
||||||
if (out_byte(bus, seg->chip << 1 | !!seg->read) < 0)
|
const u8 addr_dir = seg->slave << 1 | !!(seg->flags & I2C_M_RD);
|
||||||
|
if (out_byte(bus, addr_dir) < 0)
|
||||||
return -1;
|
return -1;
|
||||||
for (i = 0; i < seg->len; i++) {
|
for (i = 0; i < seg->len; i++) {
|
||||||
int ret;
|
int ret;
|
||||||
if (seg->read) {
|
if (seg->flags & I2C_M_RD) {
|
||||||
ret = in_byte(bus, i < seg->len - 1);
|
ret = in_byte(bus, i < seg->len - 1);
|
||||||
seg->buf[i] = (u8)ret;
|
seg->buf[i] = (u8)ret;
|
||||||
} else {
|
} else {
|
||||||
|
@ -144,9 +144,10 @@ static int iic_tpm_read(uint8_t addr, uint8_t *buffer, size_t len)
|
|||||||
* retries should usually not be needed, but are kept just to
|
* retries should usually not be needed, but are kept just to
|
||||||
* be safe on the safe side.
|
* be safe on the safe side.
|
||||||
*/
|
*/
|
||||||
struct i2c_seg aseg = { .read = 0, .chip = tpm_dev->addr,
|
struct i2c_msg aseg = { .flags = 0, .slave = tpm_dev->addr,
|
||||||
.buf = &addr, .len = 1 };
|
.buf = &addr, .len = 1 };
|
||||||
struct i2c_seg dseg = { .read = 1, .chip = tpm_dev->addr,
|
struct i2c_msg dseg = { .flags = I2C_M_RD,
|
||||||
|
.slave = tpm_dev->addr,
|
||||||
.buf = buffer, .len = len };
|
.buf = buffer, .len = len };
|
||||||
for (count = 0; count < MAX_COUNT; count++) {
|
for (count = 0; count < MAX_COUNT; count++) {
|
||||||
rc = i2c_transfer(tpm_dev->bus, &aseg, 1) ||
|
rc = i2c_transfer(tpm_dev->bus, &aseg, 1) ||
|
||||||
|
@ -111,7 +111,7 @@ static TiLp55231 lp55231s[WW_RING_NUM_LED_CONTROLLERS];
|
|||||||
* the transfer function ignores errors when accessing the reset register.
|
* the transfer function ignores errors when accessing the reset register.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
static int ledc_transfer(TiLp55231 *ledc, struct i2c_seg *segs,
|
static int ledc_transfer(TiLp55231 *ledc, struct i2c_msg *segs,
|
||||||
int seg_count, int reset)
|
int seg_count, int reset)
|
||||||
{
|
{
|
||||||
int rv, max_attempts = 2;
|
int rv, max_attempts = 2;
|
||||||
@ -128,7 +128,7 @@ static int ledc_transfer(TiLp55231 *ledc, struct i2c_seg *segs,
|
|||||||
if (!reset)
|
if (!reset)
|
||||||
printk(BIOS_WARNING,
|
printk(BIOS_WARNING,
|
||||||
"%s: dev %#x, reg %#x, %s transaction error.\n",
|
"%s: dev %#x, reg %#x, %s transaction error.\n",
|
||||||
__func__, segs->chip, segs->buf[0],
|
__func__, segs->slave, segs->buf[0],
|
||||||
seg_count == 1 ? "write" : "read");
|
seg_count == 1 ? "write" : "read");
|
||||||
else
|
else
|
||||||
rv = 0;
|
rv = 0;
|
||||||
@ -144,7 +144,7 @@ static int ledc_transfer(TiLp55231 *ledc, struct i2c_seg *segs,
|
|||||||
static int ledc_write(TiLp55231 *ledc, uint8_t start_addr,
|
static int ledc_write(TiLp55231 *ledc, uint8_t start_addr,
|
||||||
const uint8_t *data, unsigned count)
|
const uint8_t *data, unsigned count)
|
||||||
{
|
{
|
||||||
struct i2c_seg seg;
|
struct i2c_msg seg;
|
||||||
|
|
||||||
if (count > (sizeof(ledc->data_buffer) - 1)) {
|
if (count > (sizeof(ledc->data_buffer) - 1)) {
|
||||||
printk(BIOS_WARNING, "%s: transfer size too large (%d bytes)\n",
|
printk(BIOS_WARNING, "%s: transfer size too large (%d bytes)\n",
|
||||||
@ -155,8 +155,8 @@ static int ledc_write(TiLp55231 *ledc, uint8_t start_addr,
|
|||||||
memcpy(ledc->data_buffer + 1, data, count);
|
memcpy(ledc->data_buffer + 1, data, count);
|
||||||
ledc->data_buffer[0] = start_addr;
|
ledc->data_buffer[0] = start_addr;
|
||||||
|
|
||||||
seg.read = 0;
|
seg.flags = 0;
|
||||||
seg.chip = ledc->dev_addr;
|
seg.slave = ledc->dev_addr;
|
||||||
seg.buf = ledc->data_buffer;
|
seg.buf = ledc->data_buffer;
|
||||||
seg.len = count + 1;
|
seg.len = count + 1;
|
||||||
|
|
||||||
@ -166,15 +166,15 @@ static int ledc_write(TiLp55231 *ledc, uint8_t start_addr,
|
|||||||
/* To keep things simple, read is limited to one byte at a time. */
|
/* To keep things simple, read is limited to one byte at a time. */
|
||||||
static int ledc_read(TiLp55231 *ledc, uint8_t addr, uint8_t *data)
|
static int ledc_read(TiLp55231 *ledc, uint8_t addr, uint8_t *data)
|
||||||
{
|
{
|
||||||
struct i2c_seg seg[2];
|
struct i2c_msg seg[2];
|
||||||
|
|
||||||
seg[0].read = 0;
|
seg[0].flags = 0;
|
||||||
seg[0].chip = ledc->dev_addr;
|
seg[0].slave = ledc->dev_addr;
|
||||||
seg[0].buf = &addr;
|
seg[0].buf = &addr;
|
||||||
seg[0].len = 1;
|
seg[0].len = 1;
|
||||||
|
|
||||||
seg[1].read = 1;
|
seg[1].flags = I2C_M_RD;
|
||||||
seg[1].chip = ledc->dev_addr;
|
seg[1].slave = ledc->dev_addr;
|
||||||
seg[1].buf = data;
|
seg[1].buf = data;
|
||||||
seg[1].len = 1;
|
seg[1].len = 1;
|
||||||
|
|
||||||
|
@ -45,20 +45,20 @@ enum {
|
|||||||
|
|
||||||
struct i2c_ec {
|
struct i2c_ec {
|
||||||
int bus;
|
int bus;
|
||||||
struct i2c_seg segs[SEGS_PER_CMD];
|
struct i2c_msg segs[SEGS_PER_CMD];
|
||||||
};
|
};
|
||||||
|
|
||||||
static struct i2c_ec ec_dev = {
|
static struct i2c_ec ec_dev = {
|
||||||
.bus = CONFIG_EC_GOOGLE_CHROMEEC_I2C_BUS,
|
.bus = CONFIG_EC_GOOGLE_CHROMEEC_I2C_BUS,
|
||||||
.segs[CMD_INDEX] = {
|
.segs[CMD_INDEX] = {
|
||||||
.read = 0,
|
.flags = 0,
|
||||||
.chip = CONFIG_EC_GOOGLE_CHROMEEC_I2C_CHIP,
|
.slave = CONFIG_EC_GOOGLE_CHROMEEC_I2C_CHIP,
|
||||||
/* Framing byte to be transferred prior to request. */
|
/* Framing byte to be transferred prior to request. */
|
||||||
.buf = &req_buf.framing_bytes[3],
|
.buf = &req_buf.framing_bytes[3],
|
||||||
},
|
},
|
||||||
.segs[RESP_INDEX] = {
|
.segs[RESP_INDEX] = {
|
||||||
.read = 1,
|
.flags = I2C_M_RD,
|
||||||
.chip = CONFIG_EC_GOOGLE_CHROMEEC_I2C_CHIP,
|
.slave = CONFIG_EC_GOOGLE_CHROMEEC_I2C_CHIP,
|
||||||
/* return code and total length before full response. */
|
/* return code and total length before full response. */
|
||||||
.buf = &resp_buf.framing_bytes[2],
|
.buf = &resp_buf.framing_bytes[2],
|
||||||
},
|
},
|
||||||
@ -100,7 +100,7 @@ static int crosec_i2c_io(size_t req_size, size_t resp_size, void *context)
|
|||||||
|
|
||||||
if (i2c_transfer(ec->bus, ec->segs, ARRAY_SIZE(ec->segs)) != 0) {
|
if (i2c_transfer(ec->bus, ec->segs, ARRAY_SIZE(ec->segs)) != 0) {
|
||||||
printk(BIOS_ERR, "%s: Cannot complete read from i2c-%d:%#x\n",
|
printk(BIOS_ERR, "%s: Cannot complete read from i2c-%d:%#x\n",
|
||||||
__func__, ec->bus, ec->segs[0].chip);
|
__func__, ec->bus, ec->segs[0].slave);
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -19,6 +19,41 @@
|
|||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
|
|
||||||
|
/**
|
||||||
|
* struct i2c_msg - an I2C transaction segment beginning with START
|
||||||
|
* @addr: Slave address, either seven or ten bits. When this is a ten
|
||||||
|
* bit address, I2C_M_TEN must be set in @flags.
|
||||||
|
* @flags: I2C_M_RD is handled by all adapters.
|
||||||
|
* @len: Number of data bytes in @buf being read from or written to the
|
||||||
|
* I2C slave address. For read transactions where I2C_M_RECV_LEN
|
||||||
|
* is set, the caller guarantees that this buffer can hold up to
|
||||||
|
* 32 bytes in addition to the initial length byte sent by the
|
||||||
|
* slave (plus, if used, the SMBus PEC).
|
||||||
|
* @buf: The buffer into which data is read, or from which it's written.
|
||||||
|
*
|
||||||
|
* An i2c_msg is the low level representation of one segment of an I2C
|
||||||
|
* transaction. It is visible to drivers in the @i2c_transfer() procedure.
|
||||||
|
*
|
||||||
|
* All I2C adapters implement the standard rules for I2C transactions. Each
|
||||||
|
* transaction begins with a START. That is followed by the slave address,
|
||||||
|
* and a bit encoding read versus write. Then follow all the data bytes,
|
||||||
|
* possibly including a byte with SMBus PEC. The transfer terminates with
|
||||||
|
* a NAK, or when all those bytes have been transferred and ACKed. If this
|
||||||
|
* is the last message in a group, it is followed by a STOP. Otherwise it
|
||||||
|
* is followed by the next @i2c_msg transaction segment, beginning with a
|
||||||
|
* (repeated) START.
|
||||||
|
*/
|
||||||
|
struct i2c_msg {
|
||||||
|
uint16_t flags;
|
||||||
|
#define I2C_M_RD 0x0001 /* read data, from slave to master */
|
||||||
|
#define I2C_M_TEN 0x0010 /* this is a ten bit chip address */
|
||||||
|
#define I2C_M_RECV_LEN 0x0400 /* length will be first received byte */
|
||||||
|
#define I2C_M_NOSTART 0x4000 /* don't send a repeated START */
|
||||||
|
uint16_t slave; /* slave address */
|
||||||
|
uint16_t len; /* msg length */
|
||||||
|
uint8_t *buf; /* pointer to msg data */
|
||||||
|
};
|
||||||
|
|
||||||
enum i2c_speed {
|
enum i2c_speed {
|
||||||
I2C_SPEED_STANDARD = 100000,
|
I2C_SPEED_STANDARD = 100000,
|
||||||
I2C_SPEED_FAST = 400000,
|
I2C_SPEED_FAST = 400000,
|
||||||
@ -32,15 +67,9 @@ enum i2c_address_mode {
|
|||||||
I2C_MODE_10_BIT
|
I2C_MODE_10_BIT
|
||||||
};
|
};
|
||||||
|
|
||||||
struct i2c_seg {
|
|
||||||
int read;
|
|
||||||
uint8_t chip;
|
|
||||||
uint8_t *buf;
|
|
||||||
int len;
|
|
||||||
};
|
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned int bus, struct i2c_seg *segments,
|
int platform_i2c_transfer(unsigned int bus, struct i2c_msg *segments,
|
||||||
int count);
|
int count);
|
||||||
|
|
||||||
#define SOFTWARE_I2C_MAX_BUS 10 /* increase as necessary */
|
#define SOFTWARE_I2C_MAX_BUS 10 /* increase as necessary */
|
||||||
|
|
||||||
@ -53,15 +82,16 @@ struct software_i2c_ops {
|
|||||||
|
|
||||||
extern struct software_i2c_ops *software_i2c[];
|
extern struct software_i2c_ops *software_i2c[];
|
||||||
|
|
||||||
int software_i2c_transfer(unsigned int bus, struct i2c_seg *segments,
|
int software_i2c_transfer(unsigned int bus, struct i2c_msg *segments,
|
||||||
int count);
|
int count);
|
||||||
void software_i2c_wedge_ack(unsigned int bus, u8 chip);
|
void software_i2c_wedge_ack(unsigned int bus, u8 slave);
|
||||||
void software_i2c_wedge_read(unsigned int bus, u8 chip, u8 reg, int bit_count);
|
void software_i2c_wedge_read(unsigned int bus, u8 slave, u8 reg, int bit_count);
|
||||||
void software_i2c_wedge_write(unsigned int bus, u8 chip, u8 reg, int bit_count);
|
void software_i2c_wedge_write(unsigned int bus, u8 slave, u8 reg,
|
||||||
|
int bit_count);
|
||||||
|
|
||||||
int i2c_read_field(unsigned int bus, uint8_t chip, uint8_t reg, uint8_t *data,
|
int i2c_read_field(unsigned int bus, uint8_t slave, uint8_t reg, uint8_t *data,
|
||||||
uint8_t mask, uint8_t shift);
|
uint8_t mask, uint8_t shift);
|
||||||
int i2c_write_field(unsigned int bus, uint8_t chip, uint8_t reg, uint8_t data,
|
int i2c_write_field(unsigned int bus, uint8_t slave, uint8_t reg, uint8_t data,
|
||||||
uint8_t mask, uint8_t shift);
|
uint8_t mask, uint8_t shift);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@ -70,7 +100,7 @@ int i2c_write_field(unsigned int bus, uint8_t chip, uint8_t reg, uint8_t data,
|
|||||||
* Need this ugly stub to arbitrate since I2C device drivers hardcode
|
* Need this ugly stub to arbitrate since I2C device drivers hardcode
|
||||||
* 'i2c_transfer()' as their entry point.
|
* 'i2c_transfer()' as their entry point.
|
||||||
*/
|
*/
|
||||||
static inline int i2c_transfer(unsigned int bus, struct i2c_seg *segments,
|
static inline int i2c_transfer(unsigned int bus, struct i2c_msg *segments,
|
||||||
int count)
|
int count)
|
||||||
{
|
{
|
||||||
if (CONFIG_SOFTWARE_I2C)
|
if (CONFIG_SOFTWARE_I2C)
|
||||||
@ -85,11 +115,11 @@ static inline int i2c_transfer(unsigned int bus, struct i2c_seg *segments,
|
|||||||
*
|
*
|
||||||
* [start][slave addr][r][data][stop]
|
* [start][slave addr][r][data][stop]
|
||||||
*/
|
*/
|
||||||
static inline int i2c_read_raw(unsigned int bus, uint8_t chip, uint8_t *data,
|
static inline int i2c_read_raw(unsigned int bus, uint8_t slave, uint8_t *data,
|
||||||
int len)
|
int len)
|
||||||
{
|
{
|
||||||
struct i2c_seg seg = {
|
struct i2c_msg seg = {
|
||||||
.read = 1, .chip = chip, .buf = data, .len = len
|
.flags = I2C_M_RD, .slave = slave, .buf = data, .len = len
|
||||||
};
|
};
|
||||||
|
|
||||||
return i2c_transfer(bus, &seg, 1);
|
return i2c_transfer(bus, &seg, 1);
|
||||||
@ -100,11 +130,11 @@ static inline int i2c_read_raw(unsigned int bus, uint8_t chip, uint8_t *data,
|
|||||||
*
|
*
|
||||||
* [start][slave addr][w][data][stop]
|
* [start][slave addr][w][data][stop]
|
||||||
*/
|
*/
|
||||||
static inline int i2c_write_raw(unsigned int bus, uint8_t chip, uint8_t *data,
|
static inline int i2c_write_raw(unsigned int bus, uint8_t slave, uint8_t *data,
|
||||||
int len)
|
int len)
|
||||||
{
|
{
|
||||||
struct i2c_seg seg = {
|
struct i2c_msg seg = {
|
||||||
.read = 0, .chip = chip, .buf = data, .len = len
|
.flags = 0, .slave = slave, .buf = data, .len = len
|
||||||
};
|
};
|
||||||
|
|
||||||
return i2c_transfer(bus, &seg, 1);
|
return i2c_transfer(bus, &seg, 1);
|
||||||
@ -115,19 +145,19 @@ static inline int i2c_write_raw(unsigned int bus, uint8_t chip, uint8_t *data,
|
|||||||
*
|
*
|
||||||
* [start][slave addr][w][register addr][start][slave addr][r][data...][stop]
|
* [start][slave addr][w][register addr][start][slave addr][r][data...][stop]
|
||||||
*/
|
*/
|
||||||
static inline int i2c_read_bytes(unsigned int bus, uint8_t chip, uint8_t reg,
|
static inline int i2c_read_bytes(unsigned int bus, uint8_t slave, uint8_t reg,
|
||||||
uint8_t *data, int len)
|
uint8_t *data, int len)
|
||||||
{
|
{
|
||||||
struct i2c_seg seg[2];
|
struct i2c_msg seg[2];
|
||||||
|
|
||||||
seg[0].read = 0;
|
seg[0].flags = 0;
|
||||||
seg[0].chip = chip;
|
seg[0].slave = slave;
|
||||||
seg[0].buf = ®
|
seg[0].buf = ®
|
||||||
seg[0].len = 1;
|
seg[0].len = 1;
|
||||||
seg[1].read = 1;
|
seg[1].flags = I2C_M_RD;
|
||||||
seg[1].chip = chip;
|
seg[1].slave = slave;
|
||||||
seg[1].buf = data;
|
seg[1].buf = data;
|
||||||
seg[1].len = len;
|
seg[1].len = len;
|
||||||
|
|
||||||
return i2c_transfer(bus, seg, ARRAY_SIZE(seg));
|
return i2c_transfer(bus, seg, ARRAY_SIZE(seg));
|
||||||
}
|
}
|
||||||
@ -137,19 +167,19 @@ static inline int i2c_read_bytes(unsigned int bus, uint8_t chip, uint8_t reg,
|
|||||||
*
|
*
|
||||||
* [start][slave addr][w][register addr][start][slave addr][r][data][stop]
|
* [start][slave addr][w][register addr][start][slave addr][r][data][stop]
|
||||||
*/
|
*/
|
||||||
static inline int i2c_readb(unsigned int bus, uint8_t chip, uint8_t reg,
|
static inline int i2c_readb(unsigned int bus, uint8_t slave, uint8_t reg,
|
||||||
uint8_t *data)
|
uint8_t *data)
|
||||||
{
|
{
|
||||||
struct i2c_seg seg[2];
|
struct i2c_msg seg[2];
|
||||||
|
|
||||||
seg[0].read = 0;
|
seg[0].flags = 0;
|
||||||
seg[0].chip = chip;
|
seg[0].slave = slave;
|
||||||
seg[0].buf = ®
|
seg[0].buf = ®
|
||||||
seg[0].len = 1;
|
seg[0].len = 1;
|
||||||
seg[1].read = 1;
|
seg[1].flags = I2C_M_RD;
|
||||||
seg[1].chip = chip;
|
seg[1].slave = slave;
|
||||||
seg[1].buf = data;
|
seg[1].buf = data;
|
||||||
seg[1].len = 1;
|
seg[1].len = 1;
|
||||||
|
|
||||||
return i2c_transfer(bus, seg, ARRAY_SIZE(seg));
|
return i2c_transfer(bus, seg, ARRAY_SIZE(seg));
|
||||||
}
|
}
|
||||||
@ -159,16 +189,16 @@ static inline int i2c_readb(unsigned int bus, uint8_t chip, uint8_t reg,
|
|||||||
*
|
*
|
||||||
* [start][slave addr][w][register addr][data][stop]
|
* [start][slave addr][w][register addr][data][stop]
|
||||||
*/
|
*/
|
||||||
static inline int i2c_writeb(unsigned int bus, uint8_t chip, uint8_t reg,
|
static inline int i2c_writeb(unsigned int bus, uint8_t slave, uint8_t reg,
|
||||||
uint8_t data)
|
uint8_t data)
|
||||||
{
|
{
|
||||||
struct i2c_seg seg;
|
struct i2c_msg seg;
|
||||||
uint8_t buf[] = {reg, data};
|
uint8_t buf[] = {reg, data};
|
||||||
|
|
||||||
seg.read = 0;
|
seg.flags = 0;
|
||||||
seg.chip = chip;
|
seg.slave = slave;
|
||||||
seg.buf = buf;
|
seg.buf = buf;
|
||||||
seg.len = ARRAY_SIZE(buf);
|
seg.len = ARRAY_SIZE(buf);
|
||||||
|
|
||||||
return i2c_transfer(bus, &seg, 1);
|
return i2c_transfer(bus, &seg, 1);
|
||||||
}
|
}
|
||||||
@ -188,7 +218,7 @@ struct i2c_bus_operations {
|
|||||||
int i2c_dev_find_bus(struct device *dev);
|
int i2c_dev_find_bus(struct device *dev);
|
||||||
|
|
||||||
/* Variants of I2C helper functions that take a device instead of bus number */
|
/* Variants of I2C helper functions that take a device instead of bus number */
|
||||||
int i2c_dev_transfer(struct device *dev, struct i2c_seg *segments, int count);
|
int i2c_dev_transfer(struct device *dev, struct i2c_msg *segments, int count);
|
||||||
int i2c_dev_readb(struct device *dev, uint8_t reg, uint8_t *data);
|
int i2c_dev_readb(struct device *dev, uint8_t reg, uint8_t *data);
|
||||||
int i2c_dev_writeb(struct device *dev, uint8_t reg, uint8_t data);
|
int i2c_dev_writeb(struct device *dev, uint8_t reg, uint8_t data);
|
||||||
int i2c_dev_read_bytes(struct device *dev, uint8_t reg, uint8_t *data, int len);
|
int i2c_dev_read_bytes(struct device *dev, uint8_t reg, uint8_t *data, int len);
|
||||||
|
@ -103,13 +103,14 @@ static void i2c_flush_fifo(struct cygnus_i2c_regs *reg_addr)
|
|||||||
I2C_MASTER_RX_FIFO_FLUSH | I2C_MASTER_TX_FIFO_FLUSH);
|
I2C_MASTER_RX_FIFO_FLUSH | I2C_MASTER_TX_FIFO_FLUSH);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int i2c_write(struct cygnus_i2c_regs *reg_addr, struct i2c_seg *segment)
|
static int i2c_write(struct cygnus_i2c_regs *reg_addr,
|
||||||
|
struct i2c_msg *segment)
|
||||||
{
|
{
|
||||||
uint8_t *data = segment->buf;
|
uint8_t *data = segment->buf;
|
||||||
unsigned int val, status;
|
unsigned int val, status;
|
||||||
int i, ret;
|
int i, ret;
|
||||||
|
|
||||||
write32(®_addr->i2c_master_data_wr, segment->chip << 1);
|
write32(®_addr->i2c_master_data_wr, segment->slave << 1);
|
||||||
|
|
||||||
for (i = 0; i < segment->len; i++) {
|
for (i = 0; i < segment->len; i++) {
|
||||||
val = data[i];
|
val = data[i];
|
||||||
@ -150,13 +151,13 @@ flush_fifo:
|
|||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int i2c_read(struct cygnus_i2c_regs *reg_addr, struct i2c_seg *segment)
|
static int i2c_read(struct cygnus_i2c_regs *reg_addr, struct i2c_msg *segment)
|
||||||
{
|
{
|
||||||
uint8_t *data = segment->buf;
|
uint8_t *data = segment->buf;
|
||||||
int i, ret;
|
int i, ret;
|
||||||
unsigned int status;
|
unsigned int status;
|
||||||
|
|
||||||
write32(®_addr->i2c_master_data_wr, segment->chip << 1 | 1);
|
write32(®_addr->i2c_master_data_wr, segment->slave << 1 | 1);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Now we can activate the transfer. Specify the number of bytes to read
|
* Now we can activate the transfer. Specify the number of bytes to read
|
||||||
@ -190,7 +191,7 @@ flush_fifo:
|
|||||||
}
|
}
|
||||||
|
|
||||||
static int i2c_do_xfer(struct cygnus_i2c_regs *reg_addr,
|
static int i2c_do_xfer(struct cygnus_i2c_regs *reg_addr,
|
||||||
struct i2c_seg *segment)
|
struct i2c_msg *segment)
|
||||||
{
|
{
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
@ -206,7 +207,7 @@ static int i2c_do_xfer(struct cygnus_i2c_regs *reg_addr,
|
|||||||
return EBUSY;
|
return EBUSY;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (segment->read)
|
if (segment->flags & I2C_M_RD)
|
||||||
ret = i2c_read(reg_addr, segment);
|
ret = i2c_read(reg_addr, segment);
|
||||||
else
|
else
|
||||||
ret = i2c_write(reg_addr, segment);
|
ret = i2c_write(reg_addr, segment);
|
||||||
@ -214,12 +215,13 @@ static int i2c_do_xfer(struct cygnus_i2c_regs *reg_addr,
|
|||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int seg_count)
|
int platform_i2c_transfer(unsigned bus, struct i2c_msg *segments,
|
||||||
|
int seg_count)
|
||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
int res = 0;
|
int res = 0;
|
||||||
struct cygnus_i2c_regs *regs = i2c_bus[bus];
|
struct cygnus_i2c_regs *regs = i2c_bus[bus];
|
||||||
struct i2c_seg *seg = segments;
|
struct i2c_msg *seg = segments;
|
||||||
|
|
||||||
for (i = 0; i < seg_count; i++, seg++) {
|
for (i = 0; i < seg_count; i++, seg++) {
|
||||||
res = i2c_do_xfer(regs, seg);
|
res = i2c_do_xfer(regs, seg);
|
||||||
|
@ -258,7 +258,7 @@ static int lpss_i2c_wait_for_bus_idle(struct lpss_i2c_regs *regs)
|
|||||||
|
|
||||||
/* Transfer one byte of one segment, sending stop bit if requested */
|
/* Transfer one byte of one segment, sending stop bit if requested */
|
||||||
static int lpss_i2c_transfer_byte(struct lpss_i2c_regs *regs,
|
static int lpss_i2c_transfer_byte(struct lpss_i2c_regs *regs,
|
||||||
struct i2c_seg *segment,
|
struct i2c_msg *segment,
|
||||||
size_t byte, int send_stop)
|
size_t byte, int send_stop)
|
||||||
{
|
{
|
||||||
struct stopwatch sw;
|
struct stopwatch sw;
|
||||||
@ -266,7 +266,7 @@ static int lpss_i2c_transfer_byte(struct lpss_i2c_regs *regs,
|
|||||||
|
|
||||||
stopwatch_init_usecs_expire(&sw, LPSS_I2C_TIMEOUT_US);
|
stopwatch_init_usecs_expire(&sw, LPSS_I2C_TIMEOUT_US);
|
||||||
|
|
||||||
if (!segment->read) {
|
if (!(segment->flags & I2C_M_RD)) {
|
||||||
/* Write op only: Wait for FIFO not full */
|
/* Write op only: Wait for FIFO not full */
|
||||||
while (!(read32(®s->status) & STATUS_TX_FIFO_NOT_FULL)) {
|
while (!(read32(®s->status) & STATUS_TX_FIFO_NOT_FULL)) {
|
||||||
if (stopwatch_expired(&sw)) {
|
if (stopwatch_expired(&sw)) {
|
||||||
@ -283,7 +283,7 @@ static int lpss_i2c_transfer_byte(struct lpss_i2c_regs *regs,
|
|||||||
|
|
||||||
write32(®s->cmd_data, cmd);
|
write32(®s->cmd_data, cmd);
|
||||||
|
|
||||||
if (segment->read) {
|
if (segment->flags & I2C_M_RD) {
|
||||||
/* Read op only: Wait for FIFO data and store it */
|
/* Read op only: Wait for FIFO data and store it */
|
||||||
while (!(read32(®s->status) & STATUS_RX_FIFO_NOT_EMPTY)) {
|
while (!(read32(®s->status) & STATUS_RX_FIFO_NOT_EMPTY)) {
|
||||||
if (stopwatch_expired(&sw)) {
|
if (stopwatch_expired(&sw)) {
|
||||||
@ -298,7 +298,8 @@ static int lpss_i2c_transfer_byte(struct lpss_i2c_regs *regs,
|
|||||||
}
|
}
|
||||||
|
|
||||||
/* Global I2C bus handler, defined in include/i2c.h */
|
/* Global I2C bus handler, defined in include/i2c.h */
|
||||||
int platform_i2c_transfer(unsigned int bus, struct i2c_seg *segments, int count)
|
int platform_i2c_transfer(unsigned int bus, struct i2c_msg *segments,
|
||||||
|
int count)
|
||||||
{
|
{
|
||||||
struct stopwatch sw;
|
struct stopwatch sw;
|
||||||
struct lpss_i2c_regs *regs;
|
struct lpss_i2c_regs *regs;
|
||||||
@ -325,11 +326,12 @@ int platform_i2c_transfer(unsigned int bus, struct i2c_seg *segments, int count)
|
|||||||
while (count--) {
|
while (count--) {
|
||||||
if (CONFIG_SOC_INTEL_COMMON_LPSS_I2C_DEBUG)
|
if (CONFIG_SOC_INTEL_COMMON_LPSS_I2C_DEBUG)
|
||||||
printk(BIOS_DEBUG, "i2c %u:%02x %s %d bytes : ",
|
printk(BIOS_DEBUG, "i2c %u:%02x %s %d bytes : ",
|
||||||
bus, segments->chip, segments->read ? "R" : "W",
|
bus, segments->slave,
|
||||||
|
(segments->flags & I2C_M_RD) ? "R" : "W",
|
||||||
segments->len);
|
segments->len);
|
||||||
|
|
||||||
/* Set target slave address */
|
/* Set target slave address */
|
||||||
write32(®s->target_addr, segments->chip);
|
write32(®s->target_addr, segments->slave);
|
||||||
|
|
||||||
/* Read or write each byte in segment */
|
/* Read or write each byte in segment */
|
||||||
for (byte = 0; byte < segments->len; byte++) {
|
for (byte = 0; byte < segments->len; byte++) {
|
||||||
@ -341,8 +343,9 @@ int platform_i2c_transfer(unsigned int bus, struct i2c_seg *segments, int count)
|
|||||||
if (lpss_i2c_transfer_byte(regs, segments, byte,
|
if (lpss_i2c_transfer_byte(regs, segments, byte,
|
||||||
count == 0) < 0) {
|
count == 0) < 0) {
|
||||||
printk(BIOS_ERR, "I2C %s failed: bus %u "
|
printk(BIOS_ERR, "I2C %s failed: bus %u "
|
||||||
"addr 0x%02x\n", segments->read ?
|
"addr 0x%02x\n",
|
||||||
"read" : "write", bus, segments->chip);
|
(segments->flags & I2C_M_RD) ?
|
||||||
|
"read" : "write", bus, segments->slave);
|
||||||
goto out;
|
goto out;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -186,8 +186,8 @@ static int platform_i2c_read(uint32_t restart, uint8_t *rx_buffer, int length,
|
|||||||
return bytes_transferred;
|
return bytes_transferred;
|
||||||
}
|
}
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned int bus, struct i2c_seg *segment,
|
int platform_i2c_transfer(unsigned int bus, struct i2c_msg *segment,
|
||||||
int seg_count)
|
int seg_count)
|
||||||
{
|
{
|
||||||
int bytes_transferred;
|
int bytes_transferred;
|
||||||
uint8_t chip;
|
uint8_t chip;
|
||||||
@ -212,9 +212,9 @@ int platform_i2c_transfer(unsigned int bus, struct i2c_seg *segment,
|
|||||||
printk(BIOS_ERR,
|
printk(BIOS_ERR,
|
||||||
"I2C segment[%d]: %s 0x%02x %s 0x%p, 0x%08x bytes\n",
|
"I2C segment[%d]: %s 0x%02x %s 0x%p, 0x%08x bytes\n",
|
||||||
index,
|
index,
|
||||||
segment[index].read ? "Read from" : "Write to",
|
(segment[index].flags & I2C_M_RD) ? "Read from" : "Write to",
|
||||||
segment[index].chip,
|
segment[index].slave,
|
||||||
segment[index].read ? "to " : "from",
|
(segment[index].flags & I2C_M_RD) ? "to " : "from",
|
||||||
segment[index].buf,
|
segment[index].buf,
|
||||||
segment[index].len);
|
segment[index].len);
|
||||||
printk(BIOS_ERR, "I2C %s\n",
|
printk(BIOS_ERR, "I2C %s\n",
|
||||||
@ -243,7 +243,7 @@ int platform_i2c_transfer(unsigned int bus, struct i2c_seg *segment,
|
|||||||
regs->ic_con = cmd;
|
regs->ic_con = cmd;
|
||||||
|
|
||||||
/* Set the target chip address */
|
/* Set the target chip address */
|
||||||
chip = segment->chip;
|
chip = segment->slave;
|
||||||
regs->ic_tar = chip;
|
regs->ic_tar = chip;
|
||||||
|
|
||||||
/* Enable the I2C controller */
|
/* Enable the I2C controller */
|
||||||
@ -270,13 +270,13 @@ int platform_i2c_transfer(unsigned int bus, struct i2c_seg *segment,
|
|||||||
total_bytes += length;
|
total_bytes += length;
|
||||||
ASSERT(segment->buf != NULL);
|
ASSERT(segment->buf != NULL);
|
||||||
ASSERT(length >= 1);
|
ASSERT(length >= 1);
|
||||||
ASSERT(segment->chip == chip);
|
ASSERT(segment->slave == chip);
|
||||||
|
|
||||||
/* Determine if this is the last segment of the transaction */
|
/* Determine if this is the last segment of the transaction */
|
||||||
stop = (index == seg_count) ? IC_DATA_CMD_STOP : 0;
|
stop = (index == seg_count) ? IC_DATA_CMD_STOP : 0;
|
||||||
|
|
||||||
/* Fill the FIFO with the necessary command bytes */
|
/* Fill the FIFO with the necessary command bytes */
|
||||||
if (segment->read) {
|
if (segment->flags & I2C_M_RD) {
|
||||||
/* Place read commands into the FIFO */
|
/* Place read commands into the FIFO */
|
||||||
rx_buffer = segment->buf;
|
rx_buffer = segment->buf;
|
||||||
data_bytes = platform_i2c_read(restart, rx_buffer,
|
data_bytes = platform_i2c_read(restart, rx_buffer,
|
||||||
|
@ -136,7 +136,7 @@ static inline void mtk_i2c_dump_info(uint8_t bus)
|
|||||||
I2CLOG("addr address %x\n", (uint32_t)regs);
|
I2CLOG("addr address %x\n", (uint32_t)regs);
|
||||||
}
|
}
|
||||||
|
|
||||||
static uint32_t mtk_i2c_transfer(uint8_t bus, struct i2c_seg *seg,
|
static uint32_t mtk_i2c_transfer(uint8_t bus, struct i2c_msg *seg,
|
||||||
enum i2c_modes read)
|
enum i2c_modes read)
|
||||||
{
|
{
|
||||||
uint32_t ret_code = I2C_OK;
|
uint32_t ret_code = I2C_OK;
|
||||||
@ -154,7 +154,7 @@ static uint32_t mtk_i2c_transfer(uint8_t bus, struct i2c_seg *seg,
|
|||||||
regs = i2c[bus].i2c_regs;
|
regs = i2c[bus].i2c_regs;
|
||||||
dma_regs = i2c[bus].i2c_dma_regs;
|
dma_regs = i2c[bus].i2c_dma_regs;
|
||||||
|
|
||||||
addr = seg[0].chip;
|
addr = seg[0].slave;
|
||||||
|
|
||||||
switch (read) {
|
switch (read) {
|
||||||
case I2C_WRITE_MODE:
|
case I2C_WRITE_MODE:
|
||||||
@ -305,26 +305,31 @@ static uint32_t mtk_i2c_transfer(uint8_t bus, struct i2c_seg *seg,
|
|||||||
return ret_code;
|
return ret_code;
|
||||||
}
|
}
|
||||||
|
|
||||||
static uint8_t mtk_i2c_should_combine(struct i2c_seg *seg, int left_count)
|
static uint8_t mtk_i2c_should_combine(struct i2c_msg *seg, int left_count)
|
||||||
{
|
{
|
||||||
if (left_count >= 2 && seg[0].read == 0 && seg[1].read == 1 &&
|
if (left_count >= 2 &&
|
||||||
seg[0].chip == seg[1].chip)
|
!(seg[0].flags & I2C_M_RD) &&
|
||||||
|
(seg[1].flags & I2C_M_RD) &&
|
||||||
|
seg[0].slave == seg[1].slave)
|
||||||
return 1;
|
return 1;
|
||||||
else
|
else
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int seg_count)
|
int platform_i2c_transfer(unsigned bus, struct i2c_msg *segments,
|
||||||
|
int seg_count)
|
||||||
{
|
{
|
||||||
int ret = 0;
|
int ret = 0;
|
||||||
int i;
|
int i;
|
||||||
int read;
|
int read;
|
||||||
|
|
||||||
for (i = 0; i < seg_count; i++) {
|
for (i = 0; i < seg_count; i++) {
|
||||||
if (mtk_i2c_should_combine(&segments[i], seg_count - i))
|
if (mtk_i2c_should_combine(&segments[i], seg_count - i)) {
|
||||||
read = I2C_WRITE_READ_MODE;
|
read = I2C_WRITE_READ_MODE;
|
||||||
else
|
} else {
|
||||||
read = segments[i].read;
|
read = (segments[i].flags & I2C_M_RD) ?
|
||||||
|
I2C_READ_MODE : I2C_WRITE_MODE;
|
||||||
|
}
|
||||||
|
|
||||||
ret = mtk_i2c_transfer(bus, &segments[i], read);
|
ret = mtk_i2c_transfer(bus, &segments[i], read);
|
||||||
|
|
||||||
|
@ -187,9 +187,9 @@ static int i2c_transfer_segment(unsigned bus, unsigned chip, int restart,
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int count)
|
int platform_i2c_transfer(unsigned bus, struct i2c_msg *segments, int count)
|
||||||
{
|
{
|
||||||
struct i2c_seg *seg = segments;
|
struct i2c_msg *seg = segments;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
if (bus >= g_num_i2c_buses) {
|
if (bus >= g_num_i2c_buses) {
|
||||||
@ -199,8 +199,9 @@ int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int count)
|
|||||||
}
|
}
|
||||||
|
|
||||||
for (i = 0; i < count; seg++, i++) {
|
for (i = 0; i < count; seg++, i++) {
|
||||||
if (i2c_transfer_segment(bus, seg->chip, i < count - 1,
|
if (i2c_transfer_segment(bus, seg->slave, i < count - 1,
|
||||||
seg->read, seg->buf, seg->len))
|
seg->flags & I2C_M_RD,
|
||||||
|
seg->buf, seg->len))
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
return 0;
|
return 0;
|
||||||
|
@ -155,19 +155,20 @@ static int i2c_init(blsp_qup_id_t id)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int seg_count)
|
int platform_i2c_transfer(unsigned bus, struct i2c_msg *segments,
|
||||||
|
int seg_count)
|
||||||
{
|
{
|
||||||
struct i2c_seg *seg = segments;
|
struct i2c_msg *seg = segments;
|
||||||
int ret = 0;
|
int ret = 0;
|
||||||
|
|
||||||
if (i2c_init(bus))
|
if (i2c_init(bus))
|
||||||
return 1;
|
return 1;
|
||||||
|
|
||||||
while (!ret && seg_count--) {
|
while (!ret && seg_count--) {
|
||||||
if (seg->read)
|
if (seg->flags & I2C_M_RD)
|
||||||
ret = i2c_read(bus, seg->chip, seg->buf, seg->len);
|
ret = i2c_read(bus, seg->slave, seg->buf, seg->len);
|
||||||
else
|
else
|
||||||
ret = i2c_write(bus, seg->chip, seg->buf, seg->len,
|
ret = i2c_write(bus, seg->slave, seg->buf, seg->len,
|
||||||
(seg_count ? 0 : 1));
|
(seg_count ? 0 : 1));
|
||||||
seg++;
|
seg++;
|
||||||
}
|
}
|
||||||
|
@ -142,19 +142,20 @@ static int i2c_init(unsigned bus)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int seg_count)
|
int platform_i2c_transfer(unsigned bus, struct i2c_msg *segments,
|
||||||
|
int seg_count)
|
||||||
{
|
{
|
||||||
struct i2c_seg *seg = segments;
|
struct i2c_msg *seg = segments;
|
||||||
int ret = 0;
|
int ret = 0;
|
||||||
|
|
||||||
if (i2c_init(bus))
|
if (i2c_init(bus))
|
||||||
return 1;
|
return 1;
|
||||||
|
|
||||||
while (!ret && seg_count--) {
|
while (!ret && seg_count--) {
|
||||||
if (seg->read)
|
if (seg->flags & I2C_M_RD)
|
||||||
ret = i2c_read(bus, seg->chip, seg->buf, seg->len);
|
ret = i2c_read(bus, seg->slave, seg->buf, seg->len);
|
||||||
else
|
else
|
||||||
ret = i2c_write(bus, seg->chip, seg->buf, seg->len,
|
ret = i2c_write(bus, seg->slave, seg->buf, seg->len,
|
||||||
(seg_count ? 0 : 1));
|
(seg_count ? 0 : 1));
|
||||||
seg++;
|
seg++;
|
||||||
}
|
}
|
||||||
|
@ -124,7 +124,7 @@ static int i2c_send_stop(struct rk_i2c_regs *reg_addr)
|
|||||||
return res;
|
return res;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int i2c_read(struct rk_i2c_regs *reg_addr, struct i2c_seg segment)
|
static int i2c_read(struct rk_i2c_regs *reg_addr, struct i2c_msg segment)
|
||||||
{
|
{
|
||||||
int res = 0;
|
int res = 0;
|
||||||
uint8_t *data = segment.buf;
|
uint8_t *data = segment.buf;
|
||||||
@ -136,7 +136,7 @@ static int i2c_read(struct rk_i2c_regs *reg_addr, struct i2c_seg segment)
|
|||||||
unsigned int con = 0;
|
unsigned int con = 0;
|
||||||
unsigned int i, j;
|
unsigned int i, j;
|
||||||
|
|
||||||
write32(®_addr->i2c_mrxaddr, I2C_8BIT | segment.chip << 1 | 1);
|
write32(®_addr->i2c_mrxaddr, I2C_8BIT | segment.slave << 1 | 1);
|
||||||
write32(®_addr->i2c_mrxraddr, 0);
|
write32(®_addr->i2c_mrxraddr, 0);
|
||||||
con = I2C_MODE_TRX | I2C_EN | I2C_ACT2NAK;
|
con = I2C_MODE_TRX | I2C_EN | I2C_ACT2NAK;
|
||||||
while (bytes_remaining) {
|
while (bytes_remaining) {
|
||||||
@ -182,7 +182,7 @@ static int i2c_read(struct rk_i2c_regs *reg_addr, struct i2c_seg segment)
|
|||||||
return res;
|
return res;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int i2c_write(struct rk_i2c_regs *reg_addr, struct i2c_seg segment)
|
static int i2c_write(struct rk_i2c_regs *reg_addr, struct i2c_msg segment)
|
||||||
{
|
{
|
||||||
int res = 0;
|
int res = 0;
|
||||||
uint8_t *data = segment.buf;
|
uint8_t *data = segment.buf;
|
||||||
@ -194,7 +194,7 @@ static int i2c_write(struct rk_i2c_regs *reg_addr, struct i2c_seg segment)
|
|||||||
unsigned int j = 1;
|
unsigned int j = 1;
|
||||||
u32 txdata = 0;
|
u32 txdata = 0;
|
||||||
|
|
||||||
txdata |= (segment.chip << 1);
|
txdata |= (segment.slave << 1);
|
||||||
while (bytes_remaining) {
|
while (bytes_remaining) {
|
||||||
bytes_transferred = MIN(bytes_remaining, 32);
|
bytes_transferred = MIN(bytes_remaining, 32);
|
||||||
words_transferred = ALIGN_UP(bytes_transferred, 4) / 4;
|
words_transferred = ALIGN_UP(bytes_transferred, 4) / 4;
|
||||||
@ -239,25 +239,26 @@ static int i2c_write(struct rk_i2c_regs *reg_addr, struct i2c_seg segment)
|
|||||||
return res;
|
return res;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int i2c_do_xfer(void *reg_addr, struct i2c_seg segment)
|
static int i2c_do_xfer(void *reg_addr, struct i2c_msg segment)
|
||||||
{
|
{
|
||||||
int res = 0;
|
int res = 0;
|
||||||
|
|
||||||
if (i2c_send_start(reg_addr))
|
if (i2c_send_start(reg_addr))
|
||||||
return I2C_TIMEOUT;
|
return I2C_TIMEOUT;
|
||||||
if (segment.read)
|
if (segment.flags & I2C_M_RD)
|
||||||
res = i2c_read(reg_addr, segment);
|
res = i2c_read(reg_addr, segment);
|
||||||
else
|
else
|
||||||
res = i2c_write(reg_addr, segment);
|
res = i2c_write(reg_addr, segment);
|
||||||
return i2c_send_stop(reg_addr) || res;
|
return i2c_send_stop(reg_addr) || res;
|
||||||
}
|
}
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int seg_count)
|
int platform_i2c_transfer(unsigned bus, struct i2c_msg *segments,
|
||||||
|
int seg_count)
|
||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
int res = 0;
|
int res = 0;
|
||||||
struct rk_i2c_regs *regs = (struct rk_i2c_regs *)(i2c_bus[bus]);
|
struct rk_i2c_regs *regs = (struct rk_i2c_regs *)(i2c_bus[bus]);
|
||||||
struct i2c_seg *seg = segments;
|
struct i2c_msg *seg = segments;
|
||||||
|
|
||||||
for (i = 0; i < seg_count; i++, seg++) {
|
for (i = 0; i < seg_count; i++, seg++) {
|
||||||
res = i2c_do_xfer(regs, *seg);
|
res = i2c_do_xfer(regs, *seg);
|
||||||
|
@ -234,7 +234,8 @@ static int i2c_recv_buf(struct i2c_regs *regs, uint8_t *data, int len)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int seg_count)
|
int platform_i2c_transfer(unsigned bus, struct i2c_msg *segments,
|
||||||
|
int seg_count)
|
||||||
{
|
{
|
||||||
struct s3c24x0_i2c_bus *i2c = &i2c_busses[bus];
|
struct s3c24x0_i2c_bus *i2c = &i2c_busses[bus];
|
||||||
struct i2c_regs *regs = i2c->regs;
|
struct i2c_regs *regs = i2c->regs;
|
||||||
@ -247,12 +248,12 @@ int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int seg_count)
|
|||||||
|
|
||||||
int i;
|
int i;
|
||||||
for (i = 0; i < seg_count; i++) {
|
for (i = 0; i < seg_count; i++) {
|
||||||
struct i2c_seg *seg = &segments[i];
|
struct i2c_msg *seg = &segments[i];
|
||||||
|
|
||||||
res = i2c_send_start(regs, seg->read, seg->chip);
|
res = i2c_send_start(regs, seg->flags & I2C_M_RD, seg->slave);
|
||||||
if (res)
|
if (res)
|
||||||
break;
|
break;
|
||||||
if (seg->read)
|
if (seg->flags & I2C_M_RD)
|
||||||
res = i2c_recv_buf(regs, seg->buf, seg->len);
|
res = i2c_recv_buf(regs, seg->buf, seg->len);
|
||||||
else
|
else
|
||||||
res = i2c_xmit_buf(regs, seg->buf, seg->len);
|
res = i2c_xmit_buf(regs, seg->buf, seg->len);
|
||||||
|
@ -445,11 +445,12 @@ static int hsi2c_recvdata(struct hsi2c_regs *regs, uint8_t *data, int len)
|
|||||||
return len ? -1 : 0;
|
return len ? -1 : 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int hsi2c_segment(struct i2c_seg *seg, struct hsi2c_regs *regs, int stop)
|
static int hsi2c_segment(struct i2c_msg *seg, struct hsi2c_regs *regs,
|
||||||
|
int stop)
|
||||||
{
|
{
|
||||||
const uint32_t usi_ctl = Hsi2cFuncModeI2c | Hsi2cMaster;
|
const uint32_t usi_ctl = Hsi2cFuncModeI2c | Hsi2cMaster;
|
||||||
|
|
||||||
write32(®s->i2c_addr, HSI2C_SLV_ADDR_MAS(seg->chip));
|
write32(®s->i2c_addr, HSI2C_SLV_ADDR_MAS(seg->slave));
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* We really only want to stop after this transaction (I think) if the
|
* We really only want to stop after this transaction (I think) if the
|
||||||
@ -461,7 +462,7 @@ static int hsi2c_segment(struct i2c_seg *seg, struct hsi2c_regs *regs, int stop)
|
|||||||
uint32_t autoconf =
|
uint32_t autoconf =
|
||||||
seg->len | Hsi2cMasterRun | Hsi2cStopAfterTrans;
|
seg->len | Hsi2cMasterRun | Hsi2cStopAfterTrans;
|
||||||
|
|
||||||
if (seg->read) {
|
if (seg->flags & I2C_M_RD) {
|
||||||
write32(®s->usi_ctl, usi_ctl | Hsi2cRxchon);
|
write32(®s->usi_ctl, usi_ctl | Hsi2cRxchon);
|
||||||
write32(®s->i2c_auto_conf, autoconf | Hsi2cReadWrite);
|
write32(®s->i2c_auto_conf, autoconf | Hsi2cReadWrite);
|
||||||
|
|
||||||
@ -482,7 +483,7 @@ static int hsi2c_segment(struct i2c_seg *seg, struct hsi2c_regs *regs, int stop)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int hsi2c_transfer(struct i2c_bus *i2c, struct i2c_seg *segments,
|
static int hsi2c_transfer(struct i2c_bus *i2c, struct i2c_msg *segments,
|
||||||
int count)
|
int count)
|
||||||
{
|
{
|
||||||
struct hsi2c_regs *regs = i2c->hsregs;
|
struct hsi2c_regs *regs = i2c->hsregs;
|
||||||
@ -627,7 +628,7 @@ static int i2c_recv_buf(struct i2c_regs *regs, uint8_t *data, int len)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int count)
|
int platform_i2c_transfer(unsigned bus, struct i2c_msg *segments, int count)
|
||||||
{
|
{
|
||||||
struct i2c_bus *i2c = &i2c_busses[bus];
|
struct i2c_bus *i2c = &i2c_busses[bus];
|
||||||
if (i2c->is_highspeed)
|
if (i2c->is_highspeed)
|
||||||
@ -643,12 +644,12 @@ int platform_i2c_transfer(unsigned bus, struct i2c_seg *segments, int count)
|
|||||||
|
|
||||||
int i;
|
int i;
|
||||||
for (i = 0; i < count; i++) {
|
for (i = 0; i < count; i++) {
|
||||||
struct i2c_seg *seg = &segments[i];
|
struct i2c_msg *seg = &segments[i];
|
||||||
|
|
||||||
res = i2c_send_start(regs, seg->read, seg->chip);
|
res = i2c_send_start(regs, seg->flags & I2C_M_RD, seg->slave);
|
||||||
if (res)
|
if (res)
|
||||||
break;
|
break;
|
||||||
if (seg->read)
|
if (seg->flags & I2C_M_RD)
|
||||||
res = i2c_recv_buf(regs, seg->buf, seg->len);
|
res = i2c_recv_buf(regs, seg->buf, seg->len);
|
||||||
else
|
else
|
||||||
res = i2c_xmit_buf(regs, seg->buf, seg->len);
|
res = i2c_xmit_buf(regs, seg->buf, seg->len);
|
||||||
|
Loading…
x
Reference in New Issue
Block a user