soc/codecs/sigmadsp-i2c.c

0001 // SPDX-License-Identifier: GPL-2.0-or-later
0002 /*
0003  * Load Analog Devices SigmaStudio firmware files
0004  *
0005  * Copyright 2009-2011 Analog Devices Inc.
0006  */
0007
0008 #include <linux/export.h>
0009 #include <linux/i2c.h>
0010 #include <linux/module.h>
0011 #include <linux/slab.h>
0012 #include <asm/unaligned.h>
0013
0014 #include "sigmadsp.h"
0015
0016 static int sigmadsp_write_i2c(void *control_data,
0017     unsigned int addr, const uint8_t data[], size_t len)
0018 {
0019     uint8_t *buf;
0020     int ret;
0021
0022     buf = kzalloc(2 + len, GFP_KERNEL | GFP_DMA);
0023     if (!buf)
0024         return -ENOMEM;
0025
0026     put_unaligned_be16(addr, buf);
0027     memcpy(buf + 2, data, len);
0028
0029     ret = i2c_master_send(control_data, buf, len + 2);
0030
0031     kfree(buf);
0032
0033     if (ret < 0)
0034         return ret;
0035
0036     return 0;
0037 }
0038
0039 static int sigmadsp_read_i2c(void *control_data,
0040     unsigned int addr, uint8_t data[], size_t len)
0041 {
0042     struct i2c_client *client = control_data;
0043     struct i2c_msg msgs[2];
0044     uint8_t buf[2];
0045     int ret;
0046
0047     put_unaligned_be16(addr, buf);
0048
0049     msgs[0].addr = client->addr;
0050     msgs[0].len = sizeof(buf);
0051     msgs[0].buf = buf;
0052     msgs[0].flags = 0;
0053
0054     msgs[1].addr = client->addr;
0055     msgs[1].len = len;
0056     msgs[1].buf = data;
0057     msgs[1].flags = I2C_M_RD;
0058
0059     ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
0060     if (ret < 0)
0061         return ret;
0062     else if (ret != ARRAY_SIZE(msgs))
0063         return -EIO;
0064     return 0;
0065 }
0066
0067 /**
0068  * devm_sigmadsp_init_i2c() - Initialize SigmaDSP instance
0069  * @client: The parent I2C device
0070  * @ops: The sigmadsp_ops to use for this instance
0071  * @firmware_name: Name of the firmware file to load
0072  *
0073  * Allocates a SigmaDSP instance and loads the specified firmware file.
0074  *
0075  * Returns a pointer to a struct sigmadsp on success, or a PTR_ERR() on error.
0076  */
0077 struct sigmadsp *devm_sigmadsp_init_i2c(struct i2c_client *client,
0078     const struct sigmadsp_ops *ops, const char *firmware_name)
0079 {
0080     struct sigmadsp *sigmadsp;
0081
0082     sigmadsp = devm_sigmadsp_init(&client->dev, ops, firmware_name);
0083     if (IS_ERR(sigmadsp))
0084         return sigmadsp;
0085
0086     sigmadsp->control_data = client;
0087     sigmadsp->write = sigmadsp_write_i2c;
0088     sigmadsp->read = sigmadsp_read_i2c;
0089
0090     return sigmadsp;
0091 }
0092 EXPORT_SYMBOL_GPL(devm_sigmadsp_init_i2c);
0093
0094 MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
0095 MODULE_DESCRIPTION("SigmaDSP I2C firmware loader");
0096 MODULE_LICENSE("GPL");