Release 4.11 drivers/staging/greybus/i2c.c
/*
* I2C bridge driver for the Greybus "generic" I2C module.
*
* Copyright 2014 Google Inc.
* Copyright 2014 Linaro Ltd.
*
* Released under the GPLv2 only.
*/
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/i2c.h>
#include "greybus.h"
#include "gbphy.h"
struct gb_i2c_device {
struct gb_connection *connection;
struct gbphy_device *gbphy_dev;
u32 functionality;
struct i2c_adapter adapter;
};
/*
* Map Greybus i2c functionality bits into Linux ones
*/
static u32 gb_i2c_functionality_map(u32 gb_i2c_functionality)
{
return gb_i2c_functionality; /* All bits the same for now */
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 13 | 100.00% | 1 | 100.00% |
Total | 13 | 100.00% | 1 | 100.00% |
static int gb_i2c_functionality_operation(struct gb_i2c_device *gb_i2c_dev)
{
struct gb_i2c_functionality_response response;
u32 functionality;
int ret;
ret = gb_operation_sync(gb_i2c_dev->connection,
GB_I2C_TYPE_FUNCTIONALITY,
NULL, 0, &response, sizeof(response));
if (ret)
return ret;
functionality = le32_to_cpu(response.functionality);
gb_i2c_dev->functionality = gb_i2c_functionality_map(functionality);
return 0;
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 58 | 80.56% | 1 | 33.33% |
Greg Kroah-Hartman | 14 | 19.44% | 2 | 66.67% |
Total | 72 | 100.00% | 3 | 100.00% |
/*
* Map Linux i2c_msg flags into Greybus i2c transfer op flags.
*/
static u16 gb_i2c_transfer_op_flags_map(u16 flags)
{
return flags; /* All flags the same for now */
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 13 | 100.00% | 1 | 100.00% |
Total | 13 | 100.00% | 1 | 100.00% |
static void
gb_i2c_fill_transfer_op(struct gb_i2c_transfer_op *op, struct i2c_msg *msg)
{
u16 flags = gb_i2c_transfer_op_flags_map(msg->flags);
op->addr = cpu_to_le16(msg->addr);
op->flags = cpu_to_le16(flags);
op->size = cpu_to_le16(msg->len);
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 57 | 100.00% | 1 | 100.00% |
Total | 57 | 100.00% | 1 | 100.00% |
static struct gb_operation *
gb_i2c_operation_create(struct gb_connection *connection,
struct i2c_msg *msgs, u32 msg_count)
{
struct gb_i2c_device *gb_i2c_dev = gb_connection_get_data(connection);
struct gb_i2c_transfer_request *request;
struct gb_operation *operation;
struct gb_i2c_transfer_op *op;
struct i2c_msg *msg;
u32 data_out_size = 0;
u32 data_in_size = 0;
size_t request_size;
void *data;
u16 op_count;
u32 i;
if (msg_count > (u32)U16_MAX) {
dev_err(&gb_i2c_dev->gbphy_dev->dev, "msg_count (%u) too big\n",
msg_count);
return NULL;
}
op_count = (u16)msg_count;
/*
* In addition to space for all message descriptors we need
* to have enough to hold all outbound message data.
*/
msg = msgs;
for (i = 0; i < msg_count; i++, msg++)
if (msg->flags & I2C_M_RD)
data_in_size += (u32)msg->len;
else
data_out_size += (u32)msg->len;
request_size = sizeof(*request);
request_size += msg_count * sizeof(*op);
request_size += data_out_size;
/* Response consists only of incoming data */
operation = gb_operation_create(connection, GB_I2C_TYPE_TRANSFER,
request_size, data_in_size, GFP_KERNEL);
if (!operation)
return NULL;
request = operation->request->payload;
request->op_count = cpu_to_le16(op_count);
/* Fill in the ops array */
op = &request->ops[0];
msg = msgs;
for (i = 0; i < msg_count; i++)
gb_i2c_fill_transfer_op(op++, msg++);
if (!data_out_size)
return operation;
/* Copy over the outgoing data; it starts after the last op */
data = op;
msg = msgs;
for (i = 0; i < msg_count; i++) {
if (!(msg->flags & I2C_M_RD)) {
memcpy(data, msg->buf, msg->len);
data += msg->len;
}
msg++;
}
return operation;
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 301 | 92.05% | 3 | 27.27% |
Greg Kroah-Hartman | 12 | 3.67% | 2 | 18.18% |
Johan Hovold | 7 | 2.14% | 2 | 18.18% |
Viresh Kumar | 5 | 1.53% | 2 | 18.18% |
Alexandre Bailon | 1 | 0.31% | 1 | 9.09% |
Sandeep Patil | 1 | 0.31% | 1 | 9.09% |
Total | 327 | 100.00% | 11 | 100.00% |
static void gb_i2c_decode_response(struct i2c_msg *msgs, u32 msg_count,
struct gb_i2c_transfer_response *response)
{
struct i2c_msg *msg = msgs;
u8 *data;
u32 i;
if (!response)
return;
data = response->data;
for (i = 0; i < msg_count; i++) {
if (msg->flags & I2C_M_RD) {
memcpy(msg->buf, data, msg->len);
data += msg->len;
}
msg++;
}
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 91 | 98.91% | 2 | 66.67% |
Viresh Kumar | 1 | 1.09% | 1 | 33.33% |
Total | 92 | 100.00% | 3 | 100.00% |
/*
* Some i2c transfer operations return results that are expected.
*/
static bool gb_i2c_expected_transfer_error(int errno)
{
return errno == -EAGAIN || errno == -ENODEV;
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 20 | 100.00% | 1 | 100.00% |
Total | 20 | 100.00% | 1 | 100.00% |
static int gb_i2c_transfer_operation(struct gb_i2c_device *gb_i2c_dev,
struct i2c_msg *msgs, u32 msg_count)
{
struct gb_connection *connection = gb_i2c_dev->connection;
struct device *dev = &gb_i2c_dev->gbphy_dev->dev;
struct gb_operation *operation;
int ret;
operation = gb_i2c_operation_create(connection, msgs, msg_count);
if (!operation)
return -ENOMEM;
ret = gbphy_runtime_get_sync(gb_i2c_dev->gbphy_dev);
if (ret)
goto exit_operation_put;
ret = gb_operation_request_send_sync(operation);
if (!ret) {
struct gb_i2c_transfer_response *response;
response = operation->response->payload;
gb_i2c_decode_response(msgs, msg_count, response);
ret = msg_count;
} else if (!gb_i2c_expected_transfer_error(ret)) {
dev_err(dev, "transfer operation failed (%d)\n", ret);
}
gbphy_runtime_put_autosuspend(gb_i2c_dev->gbphy_dev);
exit_operation_put:
gb_operation_put(operation);
return ret;
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 113 | 70.19% | 6 | 42.86% |
David Lin | 25 | 15.53% | 1 | 7.14% |
Johan Hovold | 14 | 8.70% | 2 | 14.29% |
Greg Kroah-Hartman | 6 | 3.73% | 2 | 14.29% |
Viresh Kumar | 2 | 1.24% | 2 | 14.29% |
Sandeep Patil | 1 | 0.62% | 1 | 7.14% |
Total | 161 | 100.00% | 14 | 100.00% |
static int gb_i2c_master_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs,
int msg_count)
{
struct gb_i2c_device *gb_i2c_dev;
gb_i2c_dev = i2c_get_adapdata(adap);
return gb_i2c_transfer_operation(gb_i2c_dev, msgs, msg_count);
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Greg Kroah-Hartman | 29 | 70.73% | 3 | 75.00% |
Alex Elder | 12 | 29.27% | 1 | 25.00% |
Total | 41 | 100.00% | 4 | 100.00% |
#if 0
/* Later */
static int gb_i2c_smbus_xfer(struct i2c_adapter *adap,
u16 addr, unsigned short flags, char read_write,
u8 command, int size, union i2c_smbus_data *data)
{
struct gb_i2c_device *gb_i2c_dev;
gb_i2c_dev = i2c_get_adapdata(adap);
return 0;
}
#endif
static u32 gb_i2c_functionality(struct i2c_adapter *adap)
{
struct gb_i2c_device *gb_i2c_dev = i2c_get_adapdata(adap);
return gb_i2c_dev->functionality;
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 15 | 57.69% | 1 | 50.00% |
Greg Kroah-Hartman | 11 | 42.31% | 1 | 50.00% |
Total | 26 | 100.00% | 2 | 100.00% |
static const struct i2c_algorithm gb_i2c_algorithm = {
.master_xfer = gb_i2c_master_xfer,
/* .smbus_xfer = gb_i2c_smbus_xfer, */
.functionality = gb_i2c_functionality,
};
/*
* Do initial setup of the i2c device. This includes verifying we
* can support it (based on the protocol version it advertises).
* If that's OK, we get and cached its functionality bits.
*
* Note: gb_i2c_dev->connection is assumed to have been valid.
*/
static int gb_i2c_device_setup(struct gb_i2c_device *gb_i2c_dev)
{
/* Assume the functionality never changes, just get it once */
return gb_i2c_functionality_operation(gb_i2c_dev);
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 13 | 72.22% | 1 | 33.33% |
Greg Kroah-Hartman | 4 | 22.22% | 1 | 33.33% |
Michael Mogenson | 1 | 5.56% | 1 | 33.33% |
Total | 18 | 100.00% | 3 | 100.00% |
static int gb_i2c_probe(struct gbphy_device *gbphy_dev,
const struct gbphy_device_id *id)
{
struct gb_connection *connection;
struct gb_i2c_device *gb_i2c_dev;
struct i2c_adapter *adapter;
int ret;
gb_i2c_dev = kzalloc(sizeof(*gb_i2c_dev), GFP_KERNEL);
if (!gb_i2c_dev)
return -ENOMEM;
connection = gb_connection_create(gbphy_dev->bundle,
le16_to_cpu(gbphy_dev->cport_desc->id),
NULL);
if (IS_ERR(connection)) {
ret = PTR_ERR(connection);
goto exit_i2cdev_free;
}
gb_i2c_dev->connection = connection;
gb_connection_set_data(connection, gb_i2c_dev);
gb_i2c_dev->gbphy_dev = gbphy_dev;
gb_gbphy_set_data(gbphy_dev, gb_i2c_dev);
ret = gb_connection_enable(connection);
if (ret)
goto exit_connection_destroy;
ret = gb_i2c_device_setup(gb_i2c_dev);
if (ret)
goto exit_connection_disable;
/* Looks good; up our i2c adapter */
adapter = &gb_i2c_dev->adapter;
adapter->owner = THIS_MODULE;
adapter->class = I2C_CLASS_HWMON | I2C_CLASS_SPD;
adapter->algo = &gb_i2c_algorithm;
/* adapter->algo_data = what? */
adapter->dev.parent = &gbphy_dev->dev;
snprintf(adapter->name, sizeof(adapter->name), "Greybus i2c adapter");
i2c_set_adapdata(adapter, gb_i2c_dev);
ret = i2c_add_adapter(adapter);
if (ret)
goto exit_connection_disable;
gbphy_runtime_put_autosuspend(gbphy_dev);
return 0;
exit_connection_disable:
gb_connection_disable(connection);
exit_connection_destroy:
gb_connection_destroy(connection);
exit_i2cdev_free:
kfree(gb_i2c_dev);
return ret;
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Greg Kroah-Hartman | 202 | 77.69% | 7 | 53.85% |
Alex Elder | 43 | 16.54% | 4 | 30.77% |
Sandeep Patil | 10 | 3.85% | 1 | 7.69% |
David Lin | 5 | 1.92% | 1 | 7.69% |
Total | 260 | 100.00% | 13 | 100.00% |
static void gb_i2c_remove(struct gbphy_device *gbphy_dev)
{
struct gb_i2c_device *gb_i2c_dev = gb_gbphy_get_data(gbphy_dev);
struct gb_connection *connection = gb_i2c_dev->connection;
int ret;
ret = gbphy_runtime_get_sync(gbphy_dev);
if (ret)
gbphy_runtime_get_noresume(gbphy_dev);
i2c_del_adapter(&gb_i2c_dev->adapter);
gb_connection_disable(connection);
gb_connection_destroy(connection);
kfree(gb_i2c_dev);
}
Contributors
Person | Tokens | Prop | Commits | CommitProp |
Greg Kroah-Hartman | 45 | 62.50% | 5 | 50.00% |
David Lin | 19 | 26.39% | 1 | 10.00% |
Sandeep Patil | 4 | 5.56% | 1 | 10.00% |
Alex Elder | 4 | 5.56% | 3 | 30.00% |
Total | 72 | 100.00% | 10 | 100.00% |
static const struct gbphy_device_id gb_i2c_id_table[] = {
{ GBPHY_PROTOCOL(GREYBUS_PROTOCOL_I2C) },
{ },
};
MODULE_DEVICE_TABLE(gbphy, gb_i2c_id_table);
static struct gbphy_driver i2c_driver = {
.name = "i2c",
.probe = gb_i2c_probe,
.remove = gb_i2c_remove,
.id_table = gb_i2c_id_table,
};
module_gbphy_driver(i2c_driver);
MODULE_LICENSE("GPL v2");
Overall Contributors
Person | Tokens | Prop | Commits | CommitProp |
Alex Elder | 795 | 60.92% | 12 | 35.29% |
Greg Kroah-Hartman | 394 | 30.19% | 10 | 29.41% |
David Lin | 49 | 3.75% | 1 | 2.94% |
Sandeep Patil | 24 | 1.84% | 1 | 2.94% |
Johan Hovold | 21 | 1.61% | 4 | 11.76% |
Viresh Kumar | 19 | 1.46% | 4 | 11.76% |
Michael Mogenson | 2 | 0.15% | 1 | 2.94% |
Alexandre Bailon | 1 | 0.08% | 1 | 2.94% |
Total | 1305 | 100.00% | 34 | 100.00% |
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.