clock.c (42249094f79422fbf5ed4b54eeb48ff096809b8f) clock.c (0ba41d917eeb87f608cf147f870ff2f4c1056bab)
1/*
2 * Clock domain and sample rate management functions
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
8 *

--- 101 unchanged lines hidden (view full) ---

110 USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT,
111 UAC2_CX_CLOCK_SELECTOR << 8,
112 snd_usb_ctrl_intf(chip) | (selector_id << 8),
113 &pin, sizeof(pin));
114 if (ret < 0)
115 return ret;
116
117 if (ret != sizeof(pin)) {
1/*
2 * Clock domain and sample rate management functions
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
8 *

--- 101 unchanged lines hidden (view full) ---

110 USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT,
111 UAC2_CX_CLOCK_SELECTOR << 8,
112 snd_usb_ctrl_intf(chip) | (selector_id << 8),
113 &pin, sizeof(pin));
114 if (ret < 0)
115 return ret;
116
117 if (ret != sizeof(pin)) {
118 snd_printk(KERN_ERR
119 "usb-audio:%d: setting selector (id %d) unexpected length %d\n",
120 chip->dev->devnum, selector_id, ret);
118 usb_audio_err(chip,
119 "setting selector (id %d) unexpected length %d\n",
120 selector_id, ret);
121 return -EINVAL;
122 }
123
124 ret = uac_clock_selector_get_val(chip, selector_id);
125 if (ret < 0)
126 return ret;
127
128 if (ret != pin) {
121 return -EINVAL;
122 }
123
124 ret = uac_clock_selector_get_val(chip, selector_id);
125 if (ret < 0)
126 return ret;
127
128 if (ret != pin) {
129 snd_printk(KERN_ERR
130 "usb-audio:%d: setting selector (id %d) to %x failed (current: %d)\n",
131 chip->dev->devnum, selector_id, pin, ret);
129 usb_audio_err(chip,
130 "setting selector (id %d) to %x failed (current: %d)\n",
131 selector_id, pin, ret);
132 return -EINVAL;
133 }
134
135 return ret;
136}
137
138static bool uac_clock_source_is_valid(struct snd_usb_audio *chip, int source_id)
139{

--- 13 unchanged lines hidden (view full) ---

153
154 err = snd_usb_ctl_msg(dev, usb_rcvctrlpipe(dev, 0), UAC2_CS_CUR,
155 USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_IN,
156 UAC2_CS_CONTROL_CLOCK_VALID << 8,
157 snd_usb_ctrl_intf(chip) | (source_id << 8),
158 &data, sizeof(data));
159
160 if (err < 0) {
132 return -EINVAL;
133 }
134
135 return ret;
136}
137
138static bool uac_clock_source_is_valid(struct snd_usb_audio *chip, int source_id)
139{

--- 13 unchanged lines hidden (view full) ---

153
154 err = snd_usb_ctl_msg(dev, usb_rcvctrlpipe(dev, 0), UAC2_CS_CUR,
155 USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_IN,
156 UAC2_CS_CONTROL_CLOCK_VALID << 8,
157 snd_usb_ctrl_intf(chip) | (source_id << 8),
158 &data, sizeof(data));
159
160 if (err < 0) {
161 snd_printk(KERN_WARNING "%s(): cannot get clock validity for id %d\n",
161 dev_warn(&dev->dev,
162 "%s(): cannot get clock validity for id %d\n",
162 __func__, source_id);
163 return 0;
164 }
165
166 return !!data;
167}
168
169static int __uac_clock_find_source(struct snd_usb_audio *chip,
170 int entity_id, unsigned long *visited,
171 bool validate)
172{
173 struct uac_clock_source_descriptor *source;
174 struct uac_clock_selector_descriptor *selector;
175 struct uac_clock_multiplier_descriptor *multiplier;
176
177 entity_id &= 0xff;
178
179 if (test_and_set_bit(entity_id, visited)) {
163 __func__, source_id);
164 return 0;
165 }
166
167 return !!data;
168}
169
170static int __uac_clock_find_source(struct snd_usb_audio *chip,
171 int entity_id, unsigned long *visited,
172 bool validate)
173{
174 struct uac_clock_source_descriptor *source;
175 struct uac_clock_selector_descriptor *selector;
176 struct uac_clock_multiplier_descriptor *multiplier;
177
178 entity_id &= 0xff;
179
180 if (test_and_set_bit(entity_id, visited)) {
180 snd_printk(KERN_WARNING
181 "%s(): recursive clock topology detected, id %d.\n",
182 __func__, entity_id);
181 usb_audio_warn(chip,
182 "%s(): recursive clock topology detected, id %d.\n",
183 __func__, entity_id);
183 return -EINVAL;
184 }
185
186 /* first, see if the ID we're looking for is a clock source already */
187 source = snd_usb_find_clock_source(chip->ctrl_intf, entity_id);
188 if (source) {
189 entity_id = source->bClockID;
190 if (validate && !uac_clock_source_is_valid(chip, entity_id)) {
184 return -EINVAL;
185 }
186
187 /* first, see if the ID we're looking for is a clock source already */
188 source = snd_usb_find_clock_source(chip->ctrl_intf, entity_id);
189 if (source) {
190 entity_id = source->bClockID;
191 if (validate && !uac_clock_source_is_valid(chip, entity_id)) {
191 snd_printk(KERN_ERR "usb-audio:%d: clock source %d is not valid, cannot use\n",
192 chip->dev->devnum, entity_id);
192 usb_audio_err(chip,
193 "clock source %d is not valid, cannot use\n",
194 entity_id);
193 return -ENXIO;
194 }
195 return entity_id;
196 }
197
198 selector = snd_usb_find_clock_selector(chip->ctrl_intf, entity_id);
199 if (selector) {
200 int ret, i, cur;
201
202 /* the entity ID we are looking for is a selector.
203 * find out what it currently selects */
204 ret = uac_clock_selector_get_val(chip, selector->bClockID);
205 if (ret < 0)
206 return ret;
207
208 /* Selector values are one-based */
209
210 if (ret > selector->bNrInPins || ret < 1) {
195 return -ENXIO;
196 }
197 return entity_id;
198 }
199
200 selector = snd_usb_find_clock_selector(chip->ctrl_intf, entity_id);
201 if (selector) {
202 int ret, i, cur;
203
204 /* the entity ID we are looking for is a selector.
205 * find out what it currently selects */
206 ret = uac_clock_selector_get_val(chip, selector->bClockID);
207 if (ret < 0)
208 return ret;
209
210 /* Selector values are one-based */
211
212 if (ret > selector->bNrInPins || ret < 1) {
211 snd_printk(KERN_ERR
213 usb_audio_err(chip,
212 "%s(): selector reported illegal value, id %d, ret %d\n",
213 __func__, selector->bClockID, ret);
214
215 return -EINVAL;
216 }
217
218 cur = ret;
219 ret = __uac_clock_find_source(chip, selector->baCSourceID[ret - 1],

--- 12 unchanged lines hidden (view full) ---

232 visited, true);
233 if (ret < 0)
234 continue;
235
236 err = uac_clock_selector_set_val(chip, entity_id, i);
237 if (err < 0)
238 continue;
239
214 "%s(): selector reported illegal value, id %d, ret %d\n",
215 __func__, selector->bClockID, ret);
216
217 return -EINVAL;
218 }
219
220 cur = ret;
221 ret = __uac_clock_find_source(chip, selector->baCSourceID[ret - 1],

--- 12 unchanged lines hidden (view full) ---

234 visited, true);
235 if (ret < 0)
236 continue;
237
238 err = uac_clock_selector_set_val(chip, entity_id, i);
239 if (err < 0)
240 continue;
241
240 snd_printk(KERN_INFO
241 "usb-audio:%d: found and selected valid clock source %d\n",
242 chip->dev->devnum, ret);
242 usb_audio_info(chip,
243 "found and selected valid clock source %d\n",
244 ret);
243 return ret;
244 }
245
246 return -ENXIO;
247 }
248
249 /* FIXME: multipliers only act as pass-thru element for now */
250 multiplier = snd_usb_find_clock_multiplier(chip->ctrl_intf, entity_id);

--- 40 unchanged lines hidden (view full) ---

291
292 data[0] = rate;
293 data[1] = rate >> 8;
294 data[2] = rate >> 16;
295 if ((err = snd_usb_ctl_msg(dev, usb_sndctrlpipe(dev, 0), UAC_SET_CUR,
296 USB_TYPE_CLASS | USB_RECIP_ENDPOINT | USB_DIR_OUT,
297 UAC_EP_CS_ATTR_SAMPLE_RATE << 8, ep,
298 data, sizeof(data))) < 0) {
245 return ret;
246 }
247
248 return -ENXIO;
249 }
250
251 /* FIXME: multipliers only act as pass-thru element for now */
252 multiplier = snd_usb_find_clock_multiplier(chip->ctrl_intf, entity_id);

--- 40 unchanged lines hidden (view full) ---

293
294 data[0] = rate;
295 data[1] = rate >> 8;
296 data[2] = rate >> 16;
297 if ((err = snd_usb_ctl_msg(dev, usb_sndctrlpipe(dev, 0), UAC_SET_CUR,
298 USB_TYPE_CLASS | USB_RECIP_ENDPOINT | USB_DIR_OUT,
299 UAC_EP_CS_ATTR_SAMPLE_RATE << 8, ep,
300 data, sizeof(data))) < 0) {
299 snd_printk(KERN_ERR "%d:%d:%d: cannot set freq %d to ep %#x\n",
300 dev->devnum, iface, fmt->altsetting, rate, ep);
301 dev_err(&dev->dev, "%d:%d: cannot set freq %d to ep %#x\n",
302 iface, fmt->altsetting, rate, ep);
301 return err;
302 }
303
304 if ((err = snd_usb_ctl_msg(dev, usb_rcvctrlpipe(dev, 0), UAC_GET_CUR,
305 USB_TYPE_CLASS | USB_RECIP_ENDPOINT | USB_DIR_IN,
306 UAC_EP_CS_ATTR_SAMPLE_RATE << 8, ep,
307 data, sizeof(data))) < 0) {
303 return err;
304 }
305
306 if ((err = snd_usb_ctl_msg(dev, usb_rcvctrlpipe(dev, 0), UAC_GET_CUR,
307 USB_TYPE_CLASS | USB_RECIP_ENDPOINT | USB_DIR_IN,
308 UAC_EP_CS_ATTR_SAMPLE_RATE << 8, ep,
309 data, sizeof(data))) < 0) {
308 snd_printk(KERN_WARNING "%d:%d:%d: cannot get freq at ep %#x\n",
309 dev->devnum, iface, fmt->altsetting, ep);
310 dev_err(&dev->dev, "%d:%d: cannot get freq at ep %#x\n",
311 iface, fmt->altsetting, ep);
310 return 0; /* some devices don't support reading */
311 }
312
313 crate = data[0] | (data[1] << 8) | (data[2] << 16);
314 if (crate != rate) {
312 return 0; /* some devices don't support reading */
313 }
314
315 crate = data[0] | (data[1] << 8) | (data[2] << 16);
316 if (crate != rate) {
315 snd_printd(KERN_WARNING "current rate %d is different from the runtime rate %d\n", crate, rate);
317 dev_warn(&dev->dev, "current rate %d is different from the runtime rate %d\n", crate, rate);
316 // runtime->rate = crate;
317 }
318
319 return 0;
320}
321
322static int get_sample_rate_v2(struct snd_usb_audio *chip, int iface,
323 int altsetting, int clock)
324{
325 struct usb_device *dev = chip->dev;
326 __le32 data;
327 int err;
328
329 err = snd_usb_ctl_msg(dev, usb_rcvctrlpipe(dev, 0), UAC2_CS_CUR,
330 USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_IN,
331 UAC2_CS_CONTROL_SAM_FREQ << 8,
332 snd_usb_ctrl_intf(chip) | (clock << 8),
333 &data, sizeof(data));
334 if (err < 0) {
318 // runtime->rate = crate;
319 }
320
321 return 0;
322}
323
324static int get_sample_rate_v2(struct snd_usb_audio *chip, int iface,
325 int altsetting, int clock)
326{
327 struct usb_device *dev = chip->dev;
328 __le32 data;
329 int err;
330
331 err = snd_usb_ctl_msg(dev, usb_rcvctrlpipe(dev, 0), UAC2_CS_CUR,
332 USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_IN,
333 UAC2_CS_CONTROL_SAM_FREQ << 8,
334 snd_usb_ctrl_intf(chip) | (clock << 8),
335 &data, sizeof(data));
336 if (err < 0) {
335 snd_printk(KERN_WARNING "%d:%d:%d: cannot get freq (v2): err %d\n",
336 dev->devnum, iface, altsetting, err);
337 dev_warn(&dev->dev, "%d:%d: cannot get freq (v2): err %d\n",
338 iface, altsetting, err);
337 return 0;
338 }
339
340 return le32_to_cpu(data);
341}
342
343static int set_sample_rate_v2(struct snd_usb_audio *chip, int iface,
344 struct usb_host_interface *alts,

--- 19 unchanged lines hidden (view full) ---

364 if (writeable) {
365 data = cpu_to_le32(rate);
366 err = snd_usb_ctl_msg(dev, usb_sndctrlpipe(dev, 0), UAC2_CS_CUR,
367 USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_OUT,
368 UAC2_CS_CONTROL_SAM_FREQ << 8,
369 snd_usb_ctrl_intf(chip) | (clock << 8),
370 &data, sizeof(data));
371 if (err < 0) {
339 return 0;
340 }
341
342 return le32_to_cpu(data);
343}
344
345static int set_sample_rate_v2(struct snd_usb_audio *chip, int iface,
346 struct usb_host_interface *alts,

--- 19 unchanged lines hidden (view full) ---

366 if (writeable) {
367 data = cpu_to_le32(rate);
368 err = snd_usb_ctl_msg(dev, usb_sndctrlpipe(dev, 0), UAC2_CS_CUR,
369 USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_OUT,
370 UAC2_CS_CONTROL_SAM_FREQ << 8,
371 snd_usb_ctrl_intf(chip) | (clock << 8),
372 &data, sizeof(data));
373 if (err < 0) {
372 snd_printk(KERN_ERR "%d:%d:%d: cannot set freq %d (v2): err %d\n",
373 dev->devnum, iface, fmt->altsetting, rate, err);
374 usb_audio_err(chip,
375 "%d:%d: cannot set freq %d (v2): err %d\n",
376 iface, fmt->altsetting, rate, err);
374 return err;
375 }
376
377 cur_rate = get_sample_rate_v2(chip, iface, fmt->altsetting, clock);
378 } else {
379 cur_rate = prev_rate;
380 }
381
382 if (cur_rate != rate) {
383 if (!writeable) {
377 return err;
378 }
379
380 cur_rate = get_sample_rate_v2(chip, iface, fmt->altsetting, clock);
381 } else {
382 cur_rate = prev_rate;
383 }
384
385 if (cur_rate != rate) {
386 if (!writeable) {
384 snd_printk(KERN_WARNING
385 "%d:%d:%d: freq mismatch (RO clock): req %d, clock runs @%d\n",
386 dev->devnum, iface, fmt->altsetting, rate, cur_rate);
387 usb_audio_warn(chip,
388 "%d:%d: freq mismatch (RO clock): req %d, clock runs @%d\n",
389 iface, fmt->altsetting, rate, cur_rate);
387 return -ENXIO;
388 }
390 return -ENXIO;
391 }
389 snd_printd(KERN_WARNING
390 "current rate %d is different from the runtime rate %d\n",
391 cur_rate, rate);
392 usb_audio_dbg(chip,
393 "current rate %d is different from the runtime rate %d\n",
394 cur_rate, rate);
392 }
393
394 /* Some devices doesn't respond to sample rate changes while the
395 * interface is active. */
396 if (rate != prev_rate) {
397 usb_set_interface(dev, iface, 0);
398 snd_usb_set_interface_quirk(dev);
399 usb_set_interface(dev, iface, fmt->altsetting);

--- 20 unchanged lines hidden --- 		395 }
396
397 /* Some devices doesn't respond to sample rate changes while the
398 * interface is active. */
399 if (rate != prev_rate) {
400 usb_set_interface(dev, iface, 0);
401 snd_usb_set_interface_quirk(dev);
402 usb_set_interface(dev, iface, fmt->altsetting);

--- 20 unchanged lines hidden ---