123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256 |
- /*
- * ADE7854/58/68/78 Polyphase Multifunction Energy Metering IC Driver (I2C Bus)
- *
- * Copyright 2010 Analog Devices Inc.
- *
- * Licensed under the GPL-2 or later.
- */
- #include <linux/device.h>
- #include <linux/kernel.h>
- #include <linux/i2c.h>
- #include <linux/slab.h>
- #include <linux/module.h>
- #include <linux/iio/iio.h>
- #include "ade7854.h"
- static int ade7854_i2c_write_reg_8(struct device *dev,
- u16 reg_address,
- u8 value)
- {
- int ret;
- struct iio_dev *indio_dev = dev_to_iio_dev(dev);
- struct ade7854_state *st = iio_priv(indio_dev);
- mutex_lock(&st->buf_lock);
- st->tx[0] = (reg_address >> 8) & 0xFF;
- st->tx[1] = reg_address & 0xFF;
- st->tx[2] = value;
- ret = i2c_master_send(st->i2c, st->tx, 3);
- mutex_unlock(&st->buf_lock);
- return ret;
- }
- static int ade7854_i2c_write_reg_16(struct device *dev,
- u16 reg_address,
- u16 value)
- {
- int ret;
- struct iio_dev *indio_dev = dev_to_iio_dev(dev);
- struct ade7854_state *st = iio_priv(indio_dev);
- mutex_lock(&st->buf_lock);
- st->tx[0] = (reg_address >> 8) & 0xFF;
- st->tx[1] = reg_address & 0xFF;
- st->tx[2] = (value >> 8) & 0xFF;
- st->tx[3] = value & 0xFF;
- ret = i2c_master_send(st->i2c, st->tx, 4);
- mutex_unlock(&st->buf_lock);
- return ret;
- }
- static int ade7854_i2c_write_reg_24(struct device *dev,
- u16 reg_address,
- u32 value)
- {
- int ret;
- struct iio_dev *indio_dev = dev_to_iio_dev(dev);
- struct ade7854_state *st = iio_priv(indio_dev);
- mutex_lock(&st->buf_lock);
- st->tx[0] = (reg_address >> 8) & 0xFF;
- st->tx[1] = reg_address & 0xFF;
- st->tx[2] = (value >> 16) & 0xFF;
- st->tx[3] = (value >> 8) & 0xFF;
- st->tx[4] = value & 0xFF;
- ret = i2c_master_send(st->i2c, st->tx, 5);
- mutex_unlock(&st->buf_lock);
- return ret;
- }
- static int ade7854_i2c_write_reg_32(struct device *dev,
- u16 reg_address,
- u32 value)
- {
- int ret;
- struct iio_dev *indio_dev = dev_to_iio_dev(dev);
- struct ade7854_state *st = iio_priv(indio_dev);
- mutex_lock(&st->buf_lock);
- st->tx[0] = (reg_address >> 8) & 0xFF;
- st->tx[1] = reg_address & 0xFF;
- st->tx[2] = (value >> 24) & 0xFF;
- st->tx[3] = (value >> 16) & 0xFF;
- st->tx[4] = (value >> 8) & 0xFF;
- st->tx[5] = value & 0xFF;
- ret = i2c_master_send(st->i2c, st->tx, 6);
- mutex_unlock(&st->buf_lock);
- return ret;
- }
- static int ade7854_i2c_read_reg_8(struct device *dev,
- u16 reg_address,
- u8 *val)
- {
- struct iio_dev *indio_dev = dev_to_iio_dev(dev);
- struct ade7854_state *st = iio_priv(indio_dev);
- int ret;
- mutex_lock(&st->buf_lock);
- st->tx[0] = (reg_address >> 8) & 0xFF;
- st->tx[1] = reg_address & 0xFF;
- ret = i2c_master_send(st->i2c, st->tx, 2);
- if (ret)
- goto out;
- ret = i2c_master_recv(st->i2c, st->rx, 1);
- if (ret)
- goto out;
- *val = st->rx[0];
- out:
- mutex_unlock(&st->buf_lock);
- return ret;
- }
- static int ade7854_i2c_read_reg_16(struct device *dev,
- u16 reg_address,
- u16 *val)
- {
- struct iio_dev *indio_dev = dev_to_iio_dev(dev);
- struct ade7854_state *st = iio_priv(indio_dev);
- int ret;
- mutex_lock(&st->buf_lock);
- st->tx[0] = (reg_address >> 8) & 0xFF;
- st->tx[1] = reg_address & 0xFF;
- ret = i2c_master_send(st->i2c, st->tx, 2);
- if (ret)
- goto out;
- ret = i2c_master_recv(st->i2c, st->rx, 2);
- if (ret)
- goto out;
- *val = (st->rx[0] << 8) | st->rx[1];
- out:
- mutex_unlock(&st->buf_lock);
- return ret;
- }
- static int ade7854_i2c_read_reg_24(struct device *dev,
- u16 reg_address,
- u32 *val)
- {
- struct iio_dev *indio_dev = dev_to_iio_dev(dev);
- struct ade7854_state *st = iio_priv(indio_dev);
- int ret;
- mutex_lock(&st->buf_lock);
- st->tx[0] = (reg_address >> 8) & 0xFF;
- st->tx[1] = reg_address & 0xFF;
- ret = i2c_master_send(st->i2c, st->tx, 2);
- if (ret)
- goto out;
- ret = i2c_master_recv(st->i2c, st->rx, 3);
- if (ret)
- goto out;
- *val = (st->rx[0] << 16) | (st->rx[1] << 8) | st->rx[2];
- out:
- mutex_unlock(&st->buf_lock);
- return ret;
- }
- static int ade7854_i2c_read_reg_32(struct device *dev,
- u16 reg_address,
- u32 *val)
- {
- struct iio_dev *indio_dev = dev_to_iio_dev(dev);
- struct ade7854_state *st = iio_priv(indio_dev);
- int ret;
- mutex_lock(&st->buf_lock);
- st->tx[0] = (reg_address >> 8) & 0xFF;
- st->tx[1] = reg_address & 0xFF;
- ret = i2c_master_send(st->i2c, st->tx, 2);
- if (ret)
- goto out;
- ret = i2c_master_recv(st->i2c, st->rx, 3);
- if (ret)
- goto out;
- *val = (st->rx[0] << 24) | (st->rx[1] << 16) |
- (st->rx[2] << 8) | st->rx[3];
- out:
- mutex_unlock(&st->buf_lock);
- return ret;
- }
- static int ade7854_i2c_probe(struct i2c_client *client,
- const struct i2c_device_id *id)
- {
- struct ade7854_state *st;
- struct iio_dev *indio_dev;
- indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*st));
- if (!indio_dev)
- return -ENOMEM;
- st = iio_priv(indio_dev);
- i2c_set_clientdata(client, indio_dev);
- st->read_reg_8 = ade7854_i2c_read_reg_8;
- st->read_reg_16 = ade7854_i2c_read_reg_16;
- st->read_reg_24 = ade7854_i2c_read_reg_24;
- st->read_reg_32 = ade7854_i2c_read_reg_32;
- st->write_reg_8 = ade7854_i2c_write_reg_8;
- st->write_reg_16 = ade7854_i2c_write_reg_16;
- st->write_reg_24 = ade7854_i2c_write_reg_24;
- st->write_reg_32 = ade7854_i2c_write_reg_32;
- st->i2c = client;
- st->irq = client->irq;
- return ade7854_probe(indio_dev, &client->dev);
- }
- static int ade7854_i2c_remove(struct i2c_client *client)
- {
- return ade7854_remove(i2c_get_clientdata(client));
- }
- static const struct i2c_device_id ade7854_id[] = {
- { "ade7854", 0 },
- { "ade7858", 0 },
- { "ade7868", 0 },
- { "ade7878", 0 },
- { }
- };
- MODULE_DEVICE_TABLE(i2c, ade7854_id);
- static struct i2c_driver ade7854_i2c_driver = {
- .driver = {
- .name = "ade7854",
- },
- .probe = ade7854_i2c_probe,
- .remove = ade7854_i2c_remove,
- .id_table = ade7854_id,
- };
- module_i2c_driver(ade7854_i2c_driver);
- MODULE_AUTHOR("Barry Song <21cnbao@gmail.com>");
- MODULE_DESCRIPTION("Analog Devices ADE7854/58/68/78 Polyphase Multifunction Energy Metering IC I2C Driver");
- MODULE_LICENSE("GPL v2");
|