1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * Load Analog Devices SigmaStudio firmware files
4 *
5 * Copyright 2009-2011 Analog Devices Inc.
6 */
7
8#include <linux/export.h>
9#include <linux/i2c.h>
10#include <linux/module.h>
11#include <linux/slab.h>
12#include <asm/unaligned.h>
13
14#include "sigmadsp.h"
15
16static int sigmadsp_write_i2c(void *control_data,
17 unsigned int addr, const uint8_t data[], size_t len)
18{
19 uint8_t *buf;
20 int ret;
21
22 buf = kzalloc(size: 2 + len, GFP_KERNEL | GFP_DMA);
23 if (!buf)
24 return -ENOMEM;
25
26 put_unaligned_be16(val: addr, p: buf);
27 memcpy(buf + 2, data, len);
28
29 ret = i2c_master_send(client: control_data, buf, count: len + 2);
30
31 kfree(objp: buf);
32
33 if (ret < 0)
34 return ret;
35
36 return 0;
37}
38
39static int sigmadsp_read_i2c(void *control_data,
40 unsigned int addr, uint8_t data[], size_t len)
41{
42 struct i2c_client *client = control_data;
43 struct i2c_msg msgs[2];
44 uint8_t buf[2];
45 int ret;
46
47 put_unaligned_be16(val: addr, p: buf);
48
49 msgs[0].addr = client->addr;
50 msgs[0].len = sizeof(buf);
51 msgs[0].buf = buf;
52 msgs[0].flags = 0;
53
54 msgs[1].addr = client->addr;
55 msgs[1].len = len;
56 msgs[1].buf = data;
57 msgs[1].flags = I2C_M_RD;
58
59 ret = i2c_transfer(adap: client->adapter, msgs, ARRAY_SIZE(msgs));
60 if (ret < 0)
61 return ret;
62 else if (ret != ARRAY_SIZE(msgs))
63 return -EIO;
64 return 0;
65}
66
67/**
68 * devm_sigmadsp_init_i2c() - Initialize SigmaDSP instance
69 * @client: The parent I2C device
70 * @ops: The sigmadsp_ops to use for this instance
71 * @firmware_name: Name of the firmware file to load
72 *
73 * Allocates a SigmaDSP instance and loads the specified firmware file.
74 *
75 * Returns a pointer to a struct sigmadsp on success, or a PTR_ERR() on error.
76 */
77struct sigmadsp *devm_sigmadsp_init_i2c(struct i2c_client *client,
78 const struct sigmadsp_ops *ops, const char *firmware_name)
79{
80 struct sigmadsp *sigmadsp;
81
82 sigmadsp = devm_sigmadsp_init(dev: &client->dev, ops, firmware_name);
83 if (IS_ERR(ptr: sigmadsp))
84 return sigmadsp;
85
86 sigmadsp->control_data = client;
87 sigmadsp->write = sigmadsp_write_i2c;
88 sigmadsp->read = sigmadsp_read_i2c;
89
90 return sigmadsp;
91}
92EXPORT_SYMBOL_GPL(devm_sigmadsp_init_i2c);
93
94MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
95MODULE_DESCRIPTION("SigmaDSP I2C firmware loader");
96MODULE_LICENSE("GPL");
97

source code of linux/sound/soc/codecs/sigmadsp-i2c.c