1
2
3
4
5#include <linux/init.h>
6#include <linux/device.h>
7#include <linux/module.h>
8#include <linux/export.h>
9#include <sound/hdaudio.h>
10#include "trace.h"
11
12static const struct hdac_bus_ops default_ops = {
13 .command = snd_hdac_bus_send_cmd,
14 .get_response = snd_hdac_bus_get_response,
15};
16
17
18
19
20
21
22
23
24
25int snd_hdac_bus_init(struct hdac_bus *bus, struct device *dev,
26 const struct hdac_bus_ops *ops,
27 const struct hdac_io_ops *io_ops)
28{
29 memset(bus, 0, sizeof(*bus));
30 bus->dev = dev;
31 if (ops)
32 bus->ops = ops;
33 else
34 bus->ops = &default_ops;
35 bus->io_ops = io_ops;
36 INIT_LIST_HEAD(&bus->stream_list);
37 INIT_LIST_HEAD(&bus->codec_list);
38 INIT_WORK(&bus->unsol_work, snd_hdac_bus_process_unsol_events);
39 spin_lock_init(&bus->reg_lock);
40 mutex_init(&bus->cmd_mutex);
41 mutex_init(&bus->lock);
42 INIT_LIST_HEAD(&bus->hlink_list);
43 bus->irq = -1;
44 return 0;
45}
46EXPORT_SYMBOL_GPL(snd_hdac_bus_init);
47
48
49
50
51
52void snd_hdac_bus_exit(struct hdac_bus *bus)
53{
54 WARN_ON(!list_empty(&bus->stream_list));
55 WARN_ON(!list_empty(&bus->codec_list));
56 cancel_work_sync(&bus->unsol_work);
57}
58EXPORT_SYMBOL_GPL(snd_hdac_bus_exit);
59
60
61
62
63
64
65
66
67
68int snd_hdac_bus_exec_verb(struct hdac_bus *bus, unsigned int addr,
69 unsigned int cmd, unsigned int *res)
70{
71 int err;
72
73 mutex_lock(&bus->cmd_mutex);
74 err = snd_hdac_bus_exec_verb_unlocked(bus, addr, cmd, res);
75 mutex_unlock(&bus->cmd_mutex);
76 return err;
77}
78EXPORT_SYMBOL_GPL(snd_hdac_bus_exec_verb);
79
80
81
82
83
84
85
86
87
88int snd_hdac_bus_exec_verb_unlocked(struct hdac_bus *bus, unsigned int addr,
89 unsigned int cmd, unsigned int *res)
90{
91 unsigned int tmp;
92 int err;
93
94 if (cmd == ~0)
95 return -EINVAL;
96
97 if (res)
98 *res = -1;
99 else if (bus->sync_write)
100 res = &tmp;
101 for (;;) {
102 trace_hda_send_cmd(bus, cmd);
103 err = bus->ops->command(bus, cmd);
104 if (err != -EAGAIN)
105 break;
106
107 err = bus->ops->get_response(bus, addr, &tmp);
108 if (err)
109 break;
110 }
111 if (!err && res) {
112 err = bus->ops->get_response(bus, addr, res);
113 trace_hda_get_response(bus, addr, *res);
114 }
115 return err;
116}
117EXPORT_SYMBOL_GPL(snd_hdac_bus_exec_verb_unlocked);
118
119
120
121
122
123
124
125
126
127
128
129void snd_hdac_bus_queue_event(struct hdac_bus *bus, u32 res, u32 res_ex)
130{
131 unsigned int wp;
132
133 if (!bus)
134 return;
135
136 trace_hda_unsol_event(bus, res, res_ex);
137 wp = (bus->unsol_wp + 1) % HDA_UNSOL_QUEUE_SIZE;
138 bus->unsol_wp = wp;
139
140 wp <<= 1;
141 bus->unsol_queue[wp] = res;
142 bus->unsol_queue[wp + 1] = res_ex;
143
144 schedule_work(&bus->unsol_work);
145}
146EXPORT_SYMBOL_GPL(snd_hdac_bus_queue_event);
147
148
149
150
151void snd_hdac_bus_process_unsol_events(struct work_struct *work)
152{
153 struct hdac_bus *bus = container_of(work, struct hdac_bus, unsol_work);
154 struct hdac_device *codec;
155 struct hdac_driver *drv;
156 unsigned int rp, caddr, res;
157
158 while (bus->unsol_rp != bus->unsol_wp) {
159 rp = (bus->unsol_rp + 1) % HDA_UNSOL_QUEUE_SIZE;
160 bus->unsol_rp = rp;
161 rp <<= 1;
162 res = bus->unsol_queue[rp];
163 caddr = bus->unsol_queue[rp + 1];
164 if (!(caddr & (1 << 4)))
165 continue;
166 codec = bus->caddr_tbl[caddr & 0x0f];
167 if (!codec || !codec->dev.driver)
168 continue;
169 drv = drv_to_hdac_driver(codec->dev.driver);
170 if (drv->unsol_event)
171 drv->unsol_event(codec, res);
172 }
173}
174EXPORT_SYMBOL_GPL(snd_hdac_bus_process_unsol_events);
175
176
177
178
179
180
181
182
183
184
185int snd_hdac_bus_add_device(struct hdac_bus *bus, struct hdac_device *codec)
186{
187 if (bus->caddr_tbl[codec->addr]) {
188 dev_err(bus->dev, "address 0x%x is already occupied\n",
189 codec->addr);
190 return -EBUSY;
191 }
192
193 list_add_tail(&codec->list, &bus->codec_list);
194 bus->caddr_tbl[codec->addr] = codec;
195 set_bit(codec->addr, &bus->codec_powered);
196 bus->num_codecs++;
197 return 0;
198}
199EXPORT_SYMBOL_GPL(snd_hdac_bus_add_device);
200
201
202
203
204
205
206void snd_hdac_bus_remove_device(struct hdac_bus *bus,
207 struct hdac_device *codec)
208{
209 WARN_ON(bus != codec->bus);
210 if (list_empty(&codec->list))
211 return;
212 list_del_init(&codec->list);
213 bus->caddr_tbl[codec->addr] = NULL;
214 clear_bit(codec->addr, &bus->codec_powered);
215 bus->num_codecs--;
216 flush_work(&bus->unsol_work);
217}
218EXPORT_SYMBOL_GPL(snd_hdac_bus_remove_device);
219