18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Copyright (c) 2006-2008 Daniel Mack, Karsten Wiese 48c2ecf20Sopenharmony_ci*/ 58c2ecf20Sopenharmony_ci 68c2ecf20Sopenharmony_ci#include <linux/device.h> 78c2ecf20Sopenharmony_ci#include <linux/spinlock.h> 88c2ecf20Sopenharmony_ci#include <linux/slab.h> 98c2ecf20Sopenharmony_ci#include <linux/init.h> 108c2ecf20Sopenharmony_ci#include <linux/usb.h> 118c2ecf20Sopenharmony_ci#include <sound/core.h> 128c2ecf20Sopenharmony_ci#include <sound/pcm.h> 138c2ecf20Sopenharmony_ci 148c2ecf20Sopenharmony_ci#include "device.h" 158c2ecf20Sopenharmony_ci#include "audio.h" 168c2ecf20Sopenharmony_ci 178c2ecf20Sopenharmony_ci#define N_URBS 32 188c2ecf20Sopenharmony_ci#define CLOCK_DRIFT_TOLERANCE 5 198c2ecf20Sopenharmony_ci#define FRAMES_PER_URB 8 208c2ecf20Sopenharmony_ci#define BYTES_PER_FRAME 512 218c2ecf20Sopenharmony_ci#define CHANNELS_PER_STREAM 2 228c2ecf20Sopenharmony_ci#define BYTES_PER_SAMPLE 3 238c2ecf20Sopenharmony_ci#define BYTES_PER_SAMPLE_USB 4 248c2ecf20Sopenharmony_ci#define MAX_BUFFER_SIZE (128*1024) 258c2ecf20Sopenharmony_ci#define MAX_ENDPOINT_SIZE 512 268c2ecf20Sopenharmony_ci 278c2ecf20Sopenharmony_ci#define ENDPOINT_CAPTURE 2 288c2ecf20Sopenharmony_ci#define ENDPOINT_PLAYBACK 6 298c2ecf20Sopenharmony_ci 308c2ecf20Sopenharmony_ci#define MAKE_CHECKBYTE(cdev,stream,i) \ 318c2ecf20Sopenharmony_ci (stream << 1) | (~(i / (cdev->n_streams * BYTES_PER_SAMPLE_USB)) & 1) 328c2ecf20Sopenharmony_ci 338c2ecf20Sopenharmony_cistatic const struct snd_pcm_hardware snd_usb_caiaq_pcm_hardware = { 348c2ecf20Sopenharmony_ci .info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED | 358c2ecf20Sopenharmony_ci SNDRV_PCM_INFO_BLOCK_TRANSFER), 368c2ecf20Sopenharmony_ci .formats = SNDRV_PCM_FMTBIT_S24_3BE, 378c2ecf20Sopenharmony_ci .rates = (SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 | 388c2ecf20Sopenharmony_ci SNDRV_PCM_RATE_96000), 398c2ecf20Sopenharmony_ci .rate_min = 44100, 408c2ecf20Sopenharmony_ci .rate_max = 0, /* will overwrite later */ 418c2ecf20Sopenharmony_ci .channels_min = CHANNELS_PER_STREAM, 428c2ecf20Sopenharmony_ci .channels_max = CHANNELS_PER_STREAM, 438c2ecf20Sopenharmony_ci .buffer_bytes_max = MAX_BUFFER_SIZE, 448c2ecf20Sopenharmony_ci .period_bytes_min = 128, 458c2ecf20Sopenharmony_ci .period_bytes_max = MAX_BUFFER_SIZE, 468c2ecf20Sopenharmony_ci .periods_min = 1, 478c2ecf20Sopenharmony_ci .periods_max = 1024, 488c2ecf20Sopenharmony_ci}; 498c2ecf20Sopenharmony_ci 508c2ecf20Sopenharmony_cistatic void 518c2ecf20Sopenharmony_ciactivate_substream(struct snd_usb_caiaqdev *cdev, 528c2ecf20Sopenharmony_ci struct snd_pcm_substream *sub) 538c2ecf20Sopenharmony_ci{ 548c2ecf20Sopenharmony_ci spin_lock(&cdev->spinlock); 558c2ecf20Sopenharmony_ci 568c2ecf20Sopenharmony_ci if (sub->stream == SNDRV_PCM_STREAM_PLAYBACK) 578c2ecf20Sopenharmony_ci cdev->sub_playback[sub->number] = sub; 588c2ecf20Sopenharmony_ci else 598c2ecf20Sopenharmony_ci cdev->sub_capture[sub->number] = sub; 608c2ecf20Sopenharmony_ci 618c2ecf20Sopenharmony_ci spin_unlock(&cdev->spinlock); 628c2ecf20Sopenharmony_ci} 638c2ecf20Sopenharmony_ci 648c2ecf20Sopenharmony_cistatic void 658c2ecf20Sopenharmony_cideactivate_substream(struct snd_usb_caiaqdev *cdev, 668c2ecf20Sopenharmony_ci struct snd_pcm_substream *sub) 678c2ecf20Sopenharmony_ci{ 688c2ecf20Sopenharmony_ci unsigned long flags; 698c2ecf20Sopenharmony_ci spin_lock_irqsave(&cdev->spinlock, flags); 708c2ecf20Sopenharmony_ci 718c2ecf20Sopenharmony_ci if (sub->stream == SNDRV_PCM_STREAM_PLAYBACK) 728c2ecf20Sopenharmony_ci cdev->sub_playback[sub->number] = NULL; 738c2ecf20Sopenharmony_ci else 748c2ecf20Sopenharmony_ci cdev->sub_capture[sub->number] = NULL; 758c2ecf20Sopenharmony_ci 768c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&cdev->spinlock, flags); 778c2ecf20Sopenharmony_ci} 788c2ecf20Sopenharmony_ci 798c2ecf20Sopenharmony_cistatic int 808c2ecf20Sopenharmony_ciall_substreams_zero(struct snd_pcm_substream **subs) 818c2ecf20Sopenharmony_ci{ 828c2ecf20Sopenharmony_ci int i; 838c2ecf20Sopenharmony_ci for (i = 0; i < MAX_STREAMS; i++) 848c2ecf20Sopenharmony_ci if (subs[i] != NULL) 858c2ecf20Sopenharmony_ci return 0; 868c2ecf20Sopenharmony_ci return 1; 878c2ecf20Sopenharmony_ci} 888c2ecf20Sopenharmony_ci 898c2ecf20Sopenharmony_cistatic int stream_start(struct snd_usb_caiaqdev *cdev) 908c2ecf20Sopenharmony_ci{ 918c2ecf20Sopenharmony_ci int i, ret; 928c2ecf20Sopenharmony_ci struct device *dev = caiaqdev_to_dev(cdev); 938c2ecf20Sopenharmony_ci 948c2ecf20Sopenharmony_ci dev_dbg(dev, "%s(%p)\n", __func__, cdev); 958c2ecf20Sopenharmony_ci 968c2ecf20Sopenharmony_ci if (cdev->streaming) 978c2ecf20Sopenharmony_ci return -EINVAL; 988c2ecf20Sopenharmony_ci 998c2ecf20Sopenharmony_ci memset(cdev->sub_playback, 0, sizeof(cdev->sub_playback)); 1008c2ecf20Sopenharmony_ci memset(cdev->sub_capture, 0, sizeof(cdev->sub_capture)); 1018c2ecf20Sopenharmony_ci cdev->input_panic = 0; 1028c2ecf20Sopenharmony_ci cdev->output_panic = 0; 1038c2ecf20Sopenharmony_ci cdev->first_packet = 4; 1048c2ecf20Sopenharmony_ci cdev->streaming = 1; 1058c2ecf20Sopenharmony_ci cdev->warned = 0; 1068c2ecf20Sopenharmony_ci 1078c2ecf20Sopenharmony_ci for (i = 0; i < N_URBS; i++) { 1088c2ecf20Sopenharmony_ci ret = usb_submit_urb(cdev->data_urbs_in[i], GFP_ATOMIC); 1098c2ecf20Sopenharmony_ci if (ret) { 1108c2ecf20Sopenharmony_ci dev_err(dev, "unable to trigger read #%d! (ret %d)\n", 1118c2ecf20Sopenharmony_ci i, ret); 1128c2ecf20Sopenharmony_ci cdev->streaming = 0; 1138c2ecf20Sopenharmony_ci return -EPIPE; 1148c2ecf20Sopenharmony_ci } 1158c2ecf20Sopenharmony_ci } 1168c2ecf20Sopenharmony_ci 1178c2ecf20Sopenharmony_ci return 0; 1188c2ecf20Sopenharmony_ci} 1198c2ecf20Sopenharmony_ci 1208c2ecf20Sopenharmony_cistatic void stream_stop(struct snd_usb_caiaqdev *cdev) 1218c2ecf20Sopenharmony_ci{ 1228c2ecf20Sopenharmony_ci int i; 1238c2ecf20Sopenharmony_ci struct device *dev = caiaqdev_to_dev(cdev); 1248c2ecf20Sopenharmony_ci 1258c2ecf20Sopenharmony_ci dev_dbg(dev, "%s(%p)\n", __func__, cdev); 1268c2ecf20Sopenharmony_ci if (!cdev->streaming) 1278c2ecf20Sopenharmony_ci return; 1288c2ecf20Sopenharmony_ci 1298c2ecf20Sopenharmony_ci cdev->streaming = 0; 1308c2ecf20Sopenharmony_ci 1318c2ecf20Sopenharmony_ci for (i = 0; i < N_URBS; i++) { 1328c2ecf20Sopenharmony_ci usb_kill_urb(cdev->data_urbs_in[i]); 1338c2ecf20Sopenharmony_ci 1348c2ecf20Sopenharmony_ci if (test_bit(i, &cdev->outurb_active_mask)) 1358c2ecf20Sopenharmony_ci usb_kill_urb(cdev->data_urbs_out[i]); 1368c2ecf20Sopenharmony_ci } 1378c2ecf20Sopenharmony_ci 1388c2ecf20Sopenharmony_ci cdev->outurb_active_mask = 0; 1398c2ecf20Sopenharmony_ci} 1408c2ecf20Sopenharmony_ci 1418c2ecf20Sopenharmony_cistatic int snd_usb_caiaq_substream_open(struct snd_pcm_substream *substream) 1428c2ecf20Sopenharmony_ci{ 1438c2ecf20Sopenharmony_ci struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(substream); 1448c2ecf20Sopenharmony_ci struct device *dev = caiaqdev_to_dev(cdev); 1458c2ecf20Sopenharmony_ci 1468c2ecf20Sopenharmony_ci dev_dbg(dev, "%s(%p)\n", __func__, substream); 1478c2ecf20Sopenharmony_ci substream->runtime->hw = cdev->pcm_info; 1488c2ecf20Sopenharmony_ci snd_pcm_limit_hw_rates(substream->runtime); 1498c2ecf20Sopenharmony_ci 1508c2ecf20Sopenharmony_ci return 0; 1518c2ecf20Sopenharmony_ci} 1528c2ecf20Sopenharmony_ci 1538c2ecf20Sopenharmony_cistatic int snd_usb_caiaq_substream_close(struct snd_pcm_substream *substream) 1548c2ecf20Sopenharmony_ci{ 1558c2ecf20Sopenharmony_ci struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(substream); 1568c2ecf20Sopenharmony_ci struct device *dev = caiaqdev_to_dev(cdev); 1578c2ecf20Sopenharmony_ci 1588c2ecf20Sopenharmony_ci dev_dbg(dev, "%s(%p)\n", __func__, substream); 1598c2ecf20Sopenharmony_ci if (all_substreams_zero(cdev->sub_playback) && 1608c2ecf20Sopenharmony_ci all_substreams_zero(cdev->sub_capture)) { 1618c2ecf20Sopenharmony_ci /* when the last client has stopped streaming, 1628c2ecf20Sopenharmony_ci * all sample rates are allowed again */ 1638c2ecf20Sopenharmony_ci stream_stop(cdev); 1648c2ecf20Sopenharmony_ci cdev->pcm_info.rates = cdev->samplerates; 1658c2ecf20Sopenharmony_ci } 1668c2ecf20Sopenharmony_ci 1678c2ecf20Sopenharmony_ci return 0; 1688c2ecf20Sopenharmony_ci} 1698c2ecf20Sopenharmony_ci 1708c2ecf20Sopenharmony_cistatic int snd_usb_caiaq_pcm_hw_free(struct snd_pcm_substream *sub) 1718c2ecf20Sopenharmony_ci{ 1728c2ecf20Sopenharmony_ci struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(sub); 1738c2ecf20Sopenharmony_ci deactivate_substream(cdev, sub); 1748c2ecf20Sopenharmony_ci return 0; 1758c2ecf20Sopenharmony_ci} 1768c2ecf20Sopenharmony_ci 1778c2ecf20Sopenharmony_ci/* this should probably go upstream */ 1788c2ecf20Sopenharmony_ci#if SNDRV_PCM_RATE_5512 != 1 << 0 || SNDRV_PCM_RATE_192000 != 1 << 12 1798c2ecf20Sopenharmony_ci#error "Change this table" 1808c2ecf20Sopenharmony_ci#endif 1818c2ecf20Sopenharmony_ci 1828c2ecf20Sopenharmony_cistatic const unsigned int rates[] = { 5512, 8000, 11025, 16000, 22050, 32000, 44100, 1838c2ecf20Sopenharmony_ci 48000, 64000, 88200, 96000, 176400, 192000 }; 1848c2ecf20Sopenharmony_ci 1858c2ecf20Sopenharmony_cistatic int snd_usb_caiaq_pcm_prepare(struct snd_pcm_substream *substream) 1868c2ecf20Sopenharmony_ci{ 1878c2ecf20Sopenharmony_ci int bytes_per_sample, bpp, ret, i; 1888c2ecf20Sopenharmony_ci int index = substream->number; 1898c2ecf20Sopenharmony_ci struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(substream); 1908c2ecf20Sopenharmony_ci struct snd_pcm_runtime *runtime = substream->runtime; 1918c2ecf20Sopenharmony_ci struct device *dev = caiaqdev_to_dev(cdev); 1928c2ecf20Sopenharmony_ci 1938c2ecf20Sopenharmony_ci dev_dbg(dev, "%s(%p)\n", __func__, substream); 1948c2ecf20Sopenharmony_ci 1958c2ecf20Sopenharmony_ci if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 1968c2ecf20Sopenharmony_ci int out_pos; 1978c2ecf20Sopenharmony_ci 1988c2ecf20Sopenharmony_ci switch (cdev->spec.data_alignment) { 1998c2ecf20Sopenharmony_ci case 0: 2008c2ecf20Sopenharmony_ci case 2: 2018c2ecf20Sopenharmony_ci out_pos = BYTES_PER_SAMPLE + 1; 2028c2ecf20Sopenharmony_ci break; 2038c2ecf20Sopenharmony_ci case 3: 2048c2ecf20Sopenharmony_ci default: 2058c2ecf20Sopenharmony_ci out_pos = 0; 2068c2ecf20Sopenharmony_ci break; 2078c2ecf20Sopenharmony_ci } 2088c2ecf20Sopenharmony_ci 2098c2ecf20Sopenharmony_ci cdev->period_out_count[index] = out_pos; 2108c2ecf20Sopenharmony_ci cdev->audio_out_buf_pos[index] = out_pos; 2118c2ecf20Sopenharmony_ci } else { 2128c2ecf20Sopenharmony_ci int in_pos; 2138c2ecf20Sopenharmony_ci 2148c2ecf20Sopenharmony_ci switch (cdev->spec.data_alignment) { 2158c2ecf20Sopenharmony_ci case 0: 2168c2ecf20Sopenharmony_ci in_pos = BYTES_PER_SAMPLE + 2; 2178c2ecf20Sopenharmony_ci break; 2188c2ecf20Sopenharmony_ci case 2: 2198c2ecf20Sopenharmony_ci in_pos = BYTES_PER_SAMPLE; 2208c2ecf20Sopenharmony_ci break; 2218c2ecf20Sopenharmony_ci case 3: 2228c2ecf20Sopenharmony_ci default: 2238c2ecf20Sopenharmony_ci in_pos = 0; 2248c2ecf20Sopenharmony_ci break; 2258c2ecf20Sopenharmony_ci } 2268c2ecf20Sopenharmony_ci 2278c2ecf20Sopenharmony_ci cdev->period_in_count[index] = in_pos; 2288c2ecf20Sopenharmony_ci cdev->audio_in_buf_pos[index] = in_pos; 2298c2ecf20Sopenharmony_ci } 2308c2ecf20Sopenharmony_ci 2318c2ecf20Sopenharmony_ci if (cdev->streaming) 2328c2ecf20Sopenharmony_ci return 0; 2338c2ecf20Sopenharmony_ci 2348c2ecf20Sopenharmony_ci /* the first client that opens a stream defines the sample rate 2358c2ecf20Sopenharmony_ci * setting for all subsequent calls, until the last client closed. */ 2368c2ecf20Sopenharmony_ci for (i=0; i < ARRAY_SIZE(rates); i++) 2378c2ecf20Sopenharmony_ci if (runtime->rate == rates[i]) 2388c2ecf20Sopenharmony_ci cdev->pcm_info.rates = 1 << i; 2398c2ecf20Sopenharmony_ci 2408c2ecf20Sopenharmony_ci snd_pcm_limit_hw_rates(runtime); 2418c2ecf20Sopenharmony_ci 2428c2ecf20Sopenharmony_ci bytes_per_sample = BYTES_PER_SAMPLE; 2438c2ecf20Sopenharmony_ci if (cdev->spec.data_alignment >= 2) 2448c2ecf20Sopenharmony_ci bytes_per_sample++; 2458c2ecf20Sopenharmony_ci 2468c2ecf20Sopenharmony_ci bpp = ((runtime->rate / 8000) + CLOCK_DRIFT_TOLERANCE) 2478c2ecf20Sopenharmony_ci * bytes_per_sample * CHANNELS_PER_STREAM * cdev->n_streams; 2488c2ecf20Sopenharmony_ci 2498c2ecf20Sopenharmony_ci if (bpp > MAX_ENDPOINT_SIZE) 2508c2ecf20Sopenharmony_ci bpp = MAX_ENDPOINT_SIZE; 2518c2ecf20Sopenharmony_ci 2528c2ecf20Sopenharmony_ci ret = snd_usb_caiaq_set_audio_params(cdev, runtime->rate, 2538c2ecf20Sopenharmony_ci runtime->sample_bits, bpp); 2548c2ecf20Sopenharmony_ci if (ret) 2558c2ecf20Sopenharmony_ci return ret; 2568c2ecf20Sopenharmony_ci 2578c2ecf20Sopenharmony_ci ret = stream_start(cdev); 2588c2ecf20Sopenharmony_ci if (ret) 2598c2ecf20Sopenharmony_ci return ret; 2608c2ecf20Sopenharmony_ci 2618c2ecf20Sopenharmony_ci cdev->output_running = 0; 2628c2ecf20Sopenharmony_ci wait_event_timeout(cdev->prepare_wait_queue, cdev->output_running, HZ); 2638c2ecf20Sopenharmony_ci if (!cdev->output_running) { 2648c2ecf20Sopenharmony_ci stream_stop(cdev); 2658c2ecf20Sopenharmony_ci return -EPIPE; 2668c2ecf20Sopenharmony_ci } 2678c2ecf20Sopenharmony_ci 2688c2ecf20Sopenharmony_ci return 0; 2698c2ecf20Sopenharmony_ci} 2708c2ecf20Sopenharmony_ci 2718c2ecf20Sopenharmony_cistatic int snd_usb_caiaq_pcm_trigger(struct snd_pcm_substream *sub, int cmd) 2728c2ecf20Sopenharmony_ci{ 2738c2ecf20Sopenharmony_ci struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(sub); 2748c2ecf20Sopenharmony_ci struct device *dev = caiaqdev_to_dev(cdev); 2758c2ecf20Sopenharmony_ci 2768c2ecf20Sopenharmony_ci dev_dbg(dev, "%s(%p) cmd %d\n", __func__, sub, cmd); 2778c2ecf20Sopenharmony_ci 2788c2ecf20Sopenharmony_ci switch (cmd) { 2798c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_START: 2808c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 2818c2ecf20Sopenharmony_ci activate_substream(cdev, sub); 2828c2ecf20Sopenharmony_ci break; 2838c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_STOP: 2848c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 2858c2ecf20Sopenharmony_ci deactivate_substream(cdev, sub); 2868c2ecf20Sopenharmony_ci break; 2878c2ecf20Sopenharmony_ci default: 2888c2ecf20Sopenharmony_ci return -EINVAL; 2898c2ecf20Sopenharmony_ci } 2908c2ecf20Sopenharmony_ci 2918c2ecf20Sopenharmony_ci return 0; 2928c2ecf20Sopenharmony_ci} 2938c2ecf20Sopenharmony_ci 2948c2ecf20Sopenharmony_cistatic snd_pcm_uframes_t 2958c2ecf20Sopenharmony_cisnd_usb_caiaq_pcm_pointer(struct snd_pcm_substream *sub) 2968c2ecf20Sopenharmony_ci{ 2978c2ecf20Sopenharmony_ci int index = sub->number; 2988c2ecf20Sopenharmony_ci struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(sub); 2998c2ecf20Sopenharmony_ci snd_pcm_uframes_t ptr; 3008c2ecf20Sopenharmony_ci 3018c2ecf20Sopenharmony_ci spin_lock(&cdev->spinlock); 3028c2ecf20Sopenharmony_ci 3038c2ecf20Sopenharmony_ci if (cdev->input_panic || cdev->output_panic) { 3048c2ecf20Sopenharmony_ci ptr = SNDRV_PCM_POS_XRUN; 3058c2ecf20Sopenharmony_ci goto unlock; 3068c2ecf20Sopenharmony_ci } 3078c2ecf20Sopenharmony_ci 3088c2ecf20Sopenharmony_ci if (sub->stream == SNDRV_PCM_STREAM_PLAYBACK) 3098c2ecf20Sopenharmony_ci ptr = bytes_to_frames(sub->runtime, 3108c2ecf20Sopenharmony_ci cdev->audio_out_buf_pos[index]); 3118c2ecf20Sopenharmony_ci else 3128c2ecf20Sopenharmony_ci ptr = bytes_to_frames(sub->runtime, 3138c2ecf20Sopenharmony_ci cdev->audio_in_buf_pos[index]); 3148c2ecf20Sopenharmony_ci 3158c2ecf20Sopenharmony_ciunlock: 3168c2ecf20Sopenharmony_ci spin_unlock(&cdev->spinlock); 3178c2ecf20Sopenharmony_ci return ptr; 3188c2ecf20Sopenharmony_ci} 3198c2ecf20Sopenharmony_ci 3208c2ecf20Sopenharmony_ci/* operators for both playback and capture */ 3218c2ecf20Sopenharmony_cistatic const struct snd_pcm_ops snd_usb_caiaq_ops = { 3228c2ecf20Sopenharmony_ci .open = snd_usb_caiaq_substream_open, 3238c2ecf20Sopenharmony_ci .close = snd_usb_caiaq_substream_close, 3248c2ecf20Sopenharmony_ci .hw_free = snd_usb_caiaq_pcm_hw_free, 3258c2ecf20Sopenharmony_ci .prepare = snd_usb_caiaq_pcm_prepare, 3268c2ecf20Sopenharmony_ci .trigger = snd_usb_caiaq_pcm_trigger, 3278c2ecf20Sopenharmony_ci .pointer = snd_usb_caiaq_pcm_pointer, 3288c2ecf20Sopenharmony_ci}; 3298c2ecf20Sopenharmony_ci 3308c2ecf20Sopenharmony_cistatic void check_for_elapsed_periods(struct snd_usb_caiaqdev *cdev, 3318c2ecf20Sopenharmony_ci struct snd_pcm_substream **subs) 3328c2ecf20Sopenharmony_ci{ 3338c2ecf20Sopenharmony_ci int stream, pb, *cnt; 3348c2ecf20Sopenharmony_ci struct snd_pcm_substream *sub; 3358c2ecf20Sopenharmony_ci 3368c2ecf20Sopenharmony_ci for (stream = 0; stream < cdev->n_streams; stream++) { 3378c2ecf20Sopenharmony_ci sub = subs[stream]; 3388c2ecf20Sopenharmony_ci if (!sub) 3398c2ecf20Sopenharmony_ci continue; 3408c2ecf20Sopenharmony_ci 3418c2ecf20Sopenharmony_ci pb = snd_pcm_lib_period_bytes(sub); 3428c2ecf20Sopenharmony_ci cnt = (sub->stream == SNDRV_PCM_STREAM_PLAYBACK) ? 3438c2ecf20Sopenharmony_ci &cdev->period_out_count[stream] : 3448c2ecf20Sopenharmony_ci &cdev->period_in_count[stream]; 3458c2ecf20Sopenharmony_ci 3468c2ecf20Sopenharmony_ci if (*cnt >= pb) { 3478c2ecf20Sopenharmony_ci snd_pcm_period_elapsed(sub); 3488c2ecf20Sopenharmony_ci *cnt %= pb; 3498c2ecf20Sopenharmony_ci } 3508c2ecf20Sopenharmony_ci } 3518c2ecf20Sopenharmony_ci} 3528c2ecf20Sopenharmony_ci 3538c2ecf20Sopenharmony_cistatic void read_in_urb_mode0(struct snd_usb_caiaqdev *cdev, 3548c2ecf20Sopenharmony_ci const struct urb *urb, 3558c2ecf20Sopenharmony_ci const struct usb_iso_packet_descriptor *iso) 3568c2ecf20Sopenharmony_ci{ 3578c2ecf20Sopenharmony_ci unsigned char *usb_buf = urb->transfer_buffer + iso->offset; 3588c2ecf20Sopenharmony_ci struct snd_pcm_substream *sub; 3598c2ecf20Sopenharmony_ci int stream, i; 3608c2ecf20Sopenharmony_ci 3618c2ecf20Sopenharmony_ci if (all_substreams_zero(cdev->sub_capture)) 3628c2ecf20Sopenharmony_ci return; 3638c2ecf20Sopenharmony_ci 3648c2ecf20Sopenharmony_ci for (i = 0; i < iso->actual_length;) { 3658c2ecf20Sopenharmony_ci for (stream = 0; stream < cdev->n_streams; stream++, i++) { 3668c2ecf20Sopenharmony_ci sub = cdev->sub_capture[stream]; 3678c2ecf20Sopenharmony_ci if (sub) { 3688c2ecf20Sopenharmony_ci struct snd_pcm_runtime *rt = sub->runtime; 3698c2ecf20Sopenharmony_ci char *audio_buf = rt->dma_area; 3708c2ecf20Sopenharmony_ci int sz = frames_to_bytes(rt, rt->buffer_size); 3718c2ecf20Sopenharmony_ci audio_buf[cdev->audio_in_buf_pos[stream]++] 3728c2ecf20Sopenharmony_ci = usb_buf[i]; 3738c2ecf20Sopenharmony_ci cdev->period_in_count[stream]++; 3748c2ecf20Sopenharmony_ci if (cdev->audio_in_buf_pos[stream] == sz) 3758c2ecf20Sopenharmony_ci cdev->audio_in_buf_pos[stream] = 0; 3768c2ecf20Sopenharmony_ci } 3778c2ecf20Sopenharmony_ci } 3788c2ecf20Sopenharmony_ci } 3798c2ecf20Sopenharmony_ci} 3808c2ecf20Sopenharmony_ci 3818c2ecf20Sopenharmony_cistatic void read_in_urb_mode2(struct snd_usb_caiaqdev *cdev, 3828c2ecf20Sopenharmony_ci const struct urb *urb, 3838c2ecf20Sopenharmony_ci const struct usb_iso_packet_descriptor *iso) 3848c2ecf20Sopenharmony_ci{ 3858c2ecf20Sopenharmony_ci unsigned char *usb_buf = urb->transfer_buffer + iso->offset; 3868c2ecf20Sopenharmony_ci unsigned char check_byte; 3878c2ecf20Sopenharmony_ci struct snd_pcm_substream *sub; 3888c2ecf20Sopenharmony_ci int stream, i; 3898c2ecf20Sopenharmony_ci 3908c2ecf20Sopenharmony_ci for (i = 0; i < iso->actual_length;) { 3918c2ecf20Sopenharmony_ci if (i % (cdev->n_streams * BYTES_PER_SAMPLE_USB) == 0) { 3928c2ecf20Sopenharmony_ci for (stream = 0; 3938c2ecf20Sopenharmony_ci stream < cdev->n_streams; 3948c2ecf20Sopenharmony_ci stream++, i++) { 3958c2ecf20Sopenharmony_ci if (cdev->first_packet) 3968c2ecf20Sopenharmony_ci continue; 3978c2ecf20Sopenharmony_ci 3988c2ecf20Sopenharmony_ci check_byte = MAKE_CHECKBYTE(cdev, stream, i); 3998c2ecf20Sopenharmony_ci 4008c2ecf20Sopenharmony_ci if ((usb_buf[i] & 0x3f) != check_byte) 4018c2ecf20Sopenharmony_ci cdev->input_panic = 1; 4028c2ecf20Sopenharmony_ci 4038c2ecf20Sopenharmony_ci if (usb_buf[i] & 0x80) 4048c2ecf20Sopenharmony_ci cdev->output_panic = 1; 4058c2ecf20Sopenharmony_ci } 4068c2ecf20Sopenharmony_ci } 4078c2ecf20Sopenharmony_ci cdev->first_packet = 0; 4088c2ecf20Sopenharmony_ci 4098c2ecf20Sopenharmony_ci for (stream = 0; stream < cdev->n_streams; stream++, i++) { 4108c2ecf20Sopenharmony_ci sub = cdev->sub_capture[stream]; 4118c2ecf20Sopenharmony_ci if (cdev->input_panic) 4128c2ecf20Sopenharmony_ci usb_buf[i] = 0; 4138c2ecf20Sopenharmony_ci 4148c2ecf20Sopenharmony_ci if (sub) { 4158c2ecf20Sopenharmony_ci struct snd_pcm_runtime *rt = sub->runtime; 4168c2ecf20Sopenharmony_ci char *audio_buf = rt->dma_area; 4178c2ecf20Sopenharmony_ci int sz = frames_to_bytes(rt, rt->buffer_size); 4188c2ecf20Sopenharmony_ci audio_buf[cdev->audio_in_buf_pos[stream]++] = 4198c2ecf20Sopenharmony_ci usb_buf[i]; 4208c2ecf20Sopenharmony_ci cdev->period_in_count[stream]++; 4218c2ecf20Sopenharmony_ci if (cdev->audio_in_buf_pos[stream] == sz) 4228c2ecf20Sopenharmony_ci cdev->audio_in_buf_pos[stream] = 0; 4238c2ecf20Sopenharmony_ci } 4248c2ecf20Sopenharmony_ci } 4258c2ecf20Sopenharmony_ci } 4268c2ecf20Sopenharmony_ci} 4278c2ecf20Sopenharmony_ci 4288c2ecf20Sopenharmony_cistatic void read_in_urb_mode3(struct snd_usb_caiaqdev *cdev, 4298c2ecf20Sopenharmony_ci const struct urb *urb, 4308c2ecf20Sopenharmony_ci const struct usb_iso_packet_descriptor *iso) 4318c2ecf20Sopenharmony_ci{ 4328c2ecf20Sopenharmony_ci unsigned char *usb_buf = urb->transfer_buffer + iso->offset; 4338c2ecf20Sopenharmony_ci struct device *dev = caiaqdev_to_dev(cdev); 4348c2ecf20Sopenharmony_ci int stream, i; 4358c2ecf20Sopenharmony_ci 4368c2ecf20Sopenharmony_ci /* paranoia check */ 4378c2ecf20Sopenharmony_ci if (iso->actual_length % (BYTES_PER_SAMPLE_USB * CHANNELS_PER_STREAM)) 4388c2ecf20Sopenharmony_ci return; 4398c2ecf20Sopenharmony_ci 4408c2ecf20Sopenharmony_ci for (i = 0; i < iso->actual_length;) { 4418c2ecf20Sopenharmony_ci for (stream = 0; stream < cdev->n_streams; stream++) { 4428c2ecf20Sopenharmony_ci struct snd_pcm_substream *sub = cdev->sub_capture[stream]; 4438c2ecf20Sopenharmony_ci char *audio_buf = NULL; 4448c2ecf20Sopenharmony_ci int c, n, sz = 0; 4458c2ecf20Sopenharmony_ci 4468c2ecf20Sopenharmony_ci if (sub && !cdev->input_panic) { 4478c2ecf20Sopenharmony_ci struct snd_pcm_runtime *rt = sub->runtime; 4488c2ecf20Sopenharmony_ci audio_buf = rt->dma_area; 4498c2ecf20Sopenharmony_ci sz = frames_to_bytes(rt, rt->buffer_size); 4508c2ecf20Sopenharmony_ci } 4518c2ecf20Sopenharmony_ci 4528c2ecf20Sopenharmony_ci for (c = 0; c < CHANNELS_PER_STREAM; c++) { 4538c2ecf20Sopenharmony_ci /* 3 audio data bytes, followed by 1 check byte */ 4548c2ecf20Sopenharmony_ci if (audio_buf) { 4558c2ecf20Sopenharmony_ci for (n = 0; n < BYTES_PER_SAMPLE; n++) { 4568c2ecf20Sopenharmony_ci audio_buf[cdev->audio_in_buf_pos[stream]++] = usb_buf[i+n]; 4578c2ecf20Sopenharmony_ci 4588c2ecf20Sopenharmony_ci if (cdev->audio_in_buf_pos[stream] == sz) 4598c2ecf20Sopenharmony_ci cdev->audio_in_buf_pos[stream] = 0; 4608c2ecf20Sopenharmony_ci } 4618c2ecf20Sopenharmony_ci 4628c2ecf20Sopenharmony_ci cdev->period_in_count[stream] += BYTES_PER_SAMPLE; 4638c2ecf20Sopenharmony_ci } 4648c2ecf20Sopenharmony_ci 4658c2ecf20Sopenharmony_ci i += BYTES_PER_SAMPLE; 4668c2ecf20Sopenharmony_ci 4678c2ecf20Sopenharmony_ci if (usb_buf[i] != ((stream << 1) | c) && 4688c2ecf20Sopenharmony_ci !cdev->first_packet) { 4698c2ecf20Sopenharmony_ci if (!cdev->input_panic) 4708c2ecf20Sopenharmony_ci dev_warn(dev, " EXPECTED: %02x got %02x, c %d, stream %d, i %d\n", 4718c2ecf20Sopenharmony_ci ((stream << 1) | c), usb_buf[i], c, stream, i); 4728c2ecf20Sopenharmony_ci cdev->input_panic = 1; 4738c2ecf20Sopenharmony_ci } 4748c2ecf20Sopenharmony_ci 4758c2ecf20Sopenharmony_ci i++; 4768c2ecf20Sopenharmony_ci } 4778c2ecf20Sopenharmony_ci } 4788c2ecf20Sopenharmony_ci } 4798c2ecf20Sopenharmony_ci 4808c2ecf20Sopenharmony_ci if (cdev->first_packet > 0) 4818c2ecf20Sopenharmony_ci cdev->first_packet--; 4828c2ecf20Sopenharmony_ci} 4838c2ecf20Sopenharmony_ci 4848c2ecf20Sopenharmony_cistatic void read_in_urb(struct snd_usb_caiaqdev *cdev, 4858c2ecf20Sopenharmony_ci const struct urb *urb, 4868c2ecf20Sopenharmony_ci const struct usb_iso_packet_descriptor *iso) 4878c2ecf20Sopenharmony_ci{ 4888c2ecf20Sopenharmony_ci struct device *dev = caiaqdev_to_dev(cdev); 4898c2ecf20Sopenharmony_ci 4908c2ecf20Sopenharmony_ci if (!cdev->streaming) 4918c2ecf20Sopenharmony_ci return; 4928c2ecf20Sopenharmony_ci 4938c2ecf20Sopenharmony_ci if (iso->actual_length < cdev->bpp) 4948c2ecf20Sopenharmony_ci return; 4958c2ecf20Sopenharmony_ci 4968c2ecf20Sopenharmony_ci switch (cdev->spec.data_alignment) { 4978c2ecf20Sopenharmony_ci case 0: 4988c2ecf20Sopenharmony_ci read_in_urb_mode0(cdev, urb, iso); 4998c2ecf20Sopenharmony_ci break; 5008c2ecf20Sopenharmony_ci case 2: 5018c2ecf20Sopenharmony_ci read_in_urb_mode2(cdev, urb, iso); 5028c2ecf20Sopenharmony_ci break; 5038c2ecf20Sopenharmony_ci case 3: 5048c2ecf20Sopenharmony_ci read_in_urb_mode3(cdev, urb, iso); 5058c2ecf20Sopenharmony_ci break; 5068c2ecf20Sopenharmony_ci } 5078c2ecf20Sopenharmony_ci 5088c2ecf20Sopenharmony_ci if ((cdev->input_panic || cdev->output_panic) && !cdev->warned) { 5098c2ecf20Sopenharmony_ci dev_warn(dev, "streaming error detected %s %s\n", 5108c2ecf20Sopenharmony_ci cdev->input_panic ? "(input)" : "", 5118c2ecf20Sopenharmony_ci cdev->output_panic ? "(output)" : ""); 5128c2ecf20Sopenharmony_ci cdev->warned = 1; 5138c2ecf20Sopenharmony_ci } 5148c2ecf20Sopenharmony_ci} 5158c2ecf20Sopenharmony_ci 5168c2ecf20Sopenharmony_cistatic void fill_out_urb_mode_0(struct snd_usb_caiaqdev *cdev, 5178c2ecf20Sopenharmony_ci struct urb *urb, 5188c2ecf20Sopenharmony_ci const struct usb_iso_packet_descriptor *iso) 5198c2ecf20Sopenharmony_ci{ 5208c2ecf20Sopenharmony_ci unsigned char *usb_buf = urb->transfer_buffer + iso->offset; 5218c2ecf20Sopenharmony_ci struct snd_pcm_substream *sub; 5228c2ecf20Sopenharmony_ci int stream, i; 5238c2ecf20Sopenharmony_ci 5248c2ecf20Sopenharmony_ci for (i = 0; i < iso->length;) { 5258c2ecf20Sopenharmony_ci for (stream = 0; stream < cdev->n_streams; stream++, i++) { 5268c2ecf20Sopenharmony_ci sub = cdev->sub_playback[stream]; 5278c2ecf20Sopenharmony_ci if (sub) { 5288c2ecf20Sopenharmony_ci struct snd_pcm_runtime *rt = sub->runtime; 5298c2ecf20Sopenharmony_ci char *audio_buf = rt->dma_area; 5308c2ecf20Sopenharmony_ci int sz = frames_to_bytes(rt, rt->buffer_size); 5318c2ecf20Sopenharmony_ci usb_buf[i] = 5328c2ecf20Sopenharmony_ci audio_buf[cdev->audio_out_buf_pos[stream]]; 5338c2ecf20Sopenharmony_ci cdev->period_out_count[stream]++; 5348c2ecf20Sopenharmony_ci cdev->audio_out_buf_pos[stream]++; 5358c2ecf20Sopenharmony_ci if (cdev->audio_out_buf_pos[stream] == sz) 5368c2ecf20Sopenharmony_ci cdev->audio_out_buf_pos[stream] = 0; 5378c2ecf20Sopenharmony_ci } else 5388c2ecf20Sopenharmony_ci usb_buf[i] = 0; 5398c2ecf20Sopenharmony_ci } 5408c2ecf20Sopenharmony_ci 5418c2ecf20Sopenharmony_ci /* fill in the check bytes */ 5428c2ecf20Sopenharmony_ci if (cdev->spec.data_alignment == 2 && 5438c2ecf20Sopenharmony_ci i % (cdev->n_streams * BYTES_PER_SAMPLE_USB) == 5448c2ecf20Sopenharmony_ci (cdev->n_streams * CHANNELS_PER_STREAM)) 5458c2ecf20Sopenharmony_ci for (stream = 0; stream < cdev->n_streams; stream++, i++) 5468c2ecf20Sopenharmony_ci usb_buf[i] = MAKE_CHECKBYTE(cdev, stream, i); 5478c2ecf20Sopenharmony_ci } 5488c2ecf20Sopenharmony_ci} 5498c2ecf20Sopenharmony_ci 5508c2ecf20Sopenharmony_cistatic void fill_out_urb_mode_3(struct snd_usb_caiaqdev *cdev, 5518c2ecf20Sopenharmony_ci struct urb *urb, 5528c2ecf20Sopenharmony_ci const struct usb_iso_packet_descriptor *iso) 5538c2ecf20Sopenharmony_ci{ 5548c2ecf20Sopenharmony_ci unsigned char *usb_buf = urb->transfer_buffer + iso->offset; 5558c2ecf20Sopenharmony_ci int stream, i; 5568c2ecf20Sopenharmony_ci 5578c2ecf20Sopenharmony_ci for (i = 0; i < iso->length;) { 5588c2ecf20Sopenharmony_ci for (stream = 0; stream < cdev->n_streams; stream++) { 5598c2ecf20Sopenharmony_ci struct snd_pcm_substream *sub = cdev->sub_playback[stream]; 5608c2ecf20Sopenharmony_ci char *audio_buf = NULL; 5618c2ecf20Sopenharmony_ci int c, n, sz = 0; 5628c2ecf20Sopenharmony_ci 5638c2ecf20Sopenharmony_ci if (sub) { 5648c2ecf20Sopenharmony_ci struct snd_pcm_runtime *rt = sub->runtime; 5658c2ecf20Sopenharmony_ci audio_buf = rt->dma_area; 5668c2ecf20Sopenharmony_ci sz = frames_to_bytes(rt, rt->buffer_size); 5678c2ecf20Sopenharmony_ci } 5688c2ecf20Sopenharmony_ci 5698c2ecf20Sopenharmony_ci for (c = 0; c < CHANNELS_PER_STREAM; c++) { 5708c2ecf20Sopenharmony_ci for (n = 0; n < BYTES_PER_SAMPLE; n++) { 5718c2ecf20Sopenharmony_ci if (audio_buf) { 5728c2ecf20Sopenharmony_ci usb_buf[i+n] = audio_buf[cdev->audio_out_buf_pos[stream]++]; 5738c2ecf20Sopenharmony_ci 5748c2ecf20Sopenharmony_ci if (cdev->audio_out_buf_pos[stream] == sz) 5758c2ecf20Sopenharmony_ci cdev->audio_out_buf_pos[stream] = 0; 5768c2ecf20Sopenharmony_ci } else { 5778c2ecf20Sopenharmony_ci usb_buf[i+n] = 0; 5788c2ecf20Sopenharmony_ci } 5798c2ecf20Sopenharmony_ci } 5808c2ecf20Sopenharmony_ci 5818c2ecf20Sopenharmony_ci if (audio_buf) 5828c2ecf20Sopenharmony_ci cdev->period_out_count[stream] += BYTES_PER_SAMPLE; 5838c2ecf20Sopenharmony_ci 5848c2ecf20Sopenharmony_ci i += BYTES_PER_SAMPLE; 5858c2ecf20Sopenharmony_ci 5868c2ecf20Sopenharmony_ci /* fill in the check byte pattern */ 5878c2ecf20Sopenharmony_ci usb_buf[i++] = (stream << 1) | c; 5888c2ecf20Sopenharmony_ci } 5898c2ecf20Sopenharmony_ci } 5908c2ecf20Sopenharmony_ci } 5918c2ecf20Sopenharmony_ci} 5928c2ecf20Sopenharmony_ci 5938c2ecf20Sopenharmony_cistatic inline void fill_out_urb(struct snd_usb_caiaqdev *cdev, 5948c2ecf20Sopenharmony_ci struct urb *urb, 5958c2ecf20Sopenharmony_ci const struct usb_iso_packet_descriptor *iso) 5968c2ecf20Sopenharmony_ci{ 5978c2ecf20Sopenharmony_ci switch (cdev->spec.data_alignment) { 5988c2ecf20Sopenharmony_ci case 0: 5998c2ecf20Sopenharmony_ci case 2: 6008c2ecf20Sopenharmony_ci fill_out_urb_mode_0(cdev, urb, iso); 6018c2ecf20Sopenharmony_ci break; 6028c2ecf20Sopenharmony_ci case 3: 6038c2ecf20Sopenharmony_ci fill_out_urb_mode_3(cdev, urb, iso); 6048c2ecf20Sopenharmony_ci break; 6058c2ecf20Sopenharmony_ci } 6068c2ecf20Sopenharmony_ci} 6078c2ecf20Sopenharmony_ci 6088c2ecf20Sopenharmony_cistatic void read_completed(struct urb *urb) 6098c2ecf20Sopenharmony_ci{ 6108c2ecf20Sopenharmony_ci struct snd_usb_caiaq_cb_info *info = urb->context; 6118c2ecf20Sopenharmony_ci struct snd_usb_caiaqdev *cdev; 6128c2ecf20Sopenharmony_ci struct device *dev; 6138c2ecf20Sopenharmony_ci struct urb *out = NULL; 6148c2ecf20Sopenharmony_ci int i, frame, len, send_it = 0, outframe = 0; 6158c2ecf20Sopenharmony_ci unsigned long flags; 6168c2ecf20Sopenharmony_ci size_t offset = 0; 6178c2ecf20Sopenharmony_ci 6188c2ecf20Sopenharmony_ci if (urb->status || !info) 6198c2ecf20Sopenharmony_ci return; 6208c2ecf20Sopenharmony_ci 6218c2ecf20Sopenharmony_ci cdev = info->cdev; 6228c2ecf20Sopenharmony_ci dev = caiaqdev_to_dev(cdev); 6238c2ecf20Sopenharmony_ci 6248c2ecf20Sopenharmony_ci if (!cdev->streaming) 6258c2ecf20Sopenharmony_ci return; 6268c2ecf20Sopenharmony_ci 6278c2ecf20Sopenharmony_ci /* find an unused output urb that is unused */ 6288c2ecf20Sopenharmony_ci for (i = 0; i < N_URBS; i++) 6298c2ecf20Sopenharmony_ci if (test_and_set_bit(i, &cdev->outurb_active_mask) == 0) { 6308c2ecf20Sopenharmony_ci out = cdev->data_urbs_out[i]; 6318c2ecf20Sopenharmony_ci break; 6328c2ecf20Sopenharmony_ci } 6338c2ecf20Sopenharmony_ci 6348c2ecf20Sopenharmony_ci if (!out) { 6358c2ecf20Sopenharmony_ci dev_err(dev, "Unable to find an output urb to use\n"); 6368c2ecf20Sopenharmony_ci goto requeue; 6378c2ecf20Sopenharmony_ci } 6388c2ecf20Sopenharmony_ci 6398c2ecf20Sopenharmony_ci /* read the recently received packet and send back one which has 6408c2ecf20Sopenharmony_ci * the same layout */ 6418c2ecf20Sopenharmony_ci for (frame = 0; frame < FRAMES_PER_URB; frame++) { 6428c2ecf20Sopenharmony_ci if (urb->iso_frame_desc[frame].status) 6438c2ecf20Sopenharmony_ci continue; 6448c2ecf20Sopenharmony_ci 6458c2ecf20Sopenharmony_ci len = urb->iso_frame_desc[outframe].actual_length; 6468c2ecf20Sopenharmony_ci out->iso_frame_desc[outframe].length = len; 6478c2ecf20Sopenharmony_ci out->iso_frame_desc[outframe].actual_length = 0; 6488c2ecf20Sopenharmony_ci out->iso_frame_desc[outframe].offset = offset; 6498c2ecf20Sopenharmony_ci offset += len; 6508c2ecf20Sopenharmony_ci 6518c2ecf20Sopenharmony_ci if (len > 0) { 6528c2ecf20Sopenharmony_ci spin_lock_irqsave(&cdev->spinlock, flags); 6538c2ecf20Sopenharmony_ci fill_out_urb(cdev, out, &out->iso_frame_desc[outframe]); 6548c2ecf20Sopenharmony_ci read_in_urb(cdev, urb, &urb->iso_frame_desc[frame]); 6558c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&cdev->spinlock, flags); 6568c2ecf20Sopenharmony_ci check_for_elapsed_periods(cdev, cdev->sub_playback); 6578c2ecf20Sopenharmony_ci check_for_elapsed_periods(cdev, cdev->sub_capture); 6588c2ecf20Sopenharmony_ci send_it = 1; 6598c2ecf20Sopenharmony_ci } 6608c2ecf20Sopenharmony_ci 6618c2ecf20Sopenharmony_ci outframe++; 6628c2ecf20Sopenharmony_ci } 6638c2ecf20Sopenharmony_ci 6648c2ecf20Sopenharmony_ci if (send_it) { 6658c2ecf20Sopenharmony_ci out->number_of_packets = outframe; 6668c2ecf20Sopenharmony_ci usb_submit_urb(out, GFP_ATOMIC); 6678c2ecf20Sopenharmony_ci } else { 6688c2ecf20Sopenharmony_ci struct snd_usb_caiaq_cb_info *oinfo = out->context; 6698c2ecf20Sopenharmony_ci clear_bit(oinfo->index, &cdev->outurb_active_mask); 6708c2ecf20Sopenharmony_ci } 6718c2ecf20Sopenharmony_ci 6728c2ecf20Sopenharmony_cirequeue: 6738c2ecf20Sopenharmony_ci /* re-submit inbound urb */ 6748c2ecf20Sopenharmony_ci for (frame = 0; frame < FRAMES_PER_URB; frame++) { 6758c2ecf20Sopenharmony_ci urb->iso_frame_desc[frame].offset = BYTES_PER_FRAME * frame; 6768c2ecf20Sopenharmony_ci urb->iso_frame_desc[frame].length = BYTES_PER_FRAME; 6778c2ecf20Sopenharmony_ci urb->iso_frame_desc[frame].actual_length = 0; 6788c2ecf20Sopenharmony_ci } 6798c2ecf20Sopenharmony_ci 6808c2ecf20Sopenharmony_ci urb->number_of_packets = FRAMES_PER_URB; 6818c2ecf20Sopenharmony_ci usb_submit_urb(urb, GFP_ATOMIC); 6828c2ecf20Sopenharmony_ci} 6838c2ecf20Sopenharmony_ci 6848c2ecf20Sopenharmony_cistatic void write_completed(struct urb *urb) 6858c2ecf20Sopenharmony_ci{ 6868c2ecf20Sopenharmony_ci struct snd_usb_caiaq_cb_info *info = urb->context; 6878c2ecf20Sopenharmony_ci struct snd_usb_caiaqdev *cdev = info->cdev; 6888c2ecf20Sopenharmony_ci 6898c2ecf20Sopenharmony_ci if (!cdev->output_running) { 6908c2ecf20Sopenharmony_ci cdev->output_running = 1; 6918c2ecf20Sopenharmony_ci wake_up(&cdev->prepare_wait_queue); 6928c2ecf20Sopenharmony_ci } 6938c2ecf20Sopenharmony_ci 6948c2ecf20Sopenharmony_ci clear_bit(info->index, &cdev->outurb_active_mask); 6958c2ecf20Sopenharmony_ci} 6968c2ecf20Sopenharmony_ci 6978c2ecf20Sopenharmony_cistatic struct urb **alloc_urbs(struct snd_usb_caiaqdev *cdev, int dir, int *ret) 6988c2ecf20Sopenharmony_ci{ 6998c2ecf20Sopenharmony_ci int i, frame; 7008c2ecf20Sopenharmony_ci struct urb **urbs; 7018c2ecf20Sopenharmony_ci struct usb_device *usb_dev = cdev->chip.dev; 7028c2ecf20Sopenharmony_ci unsigned int pipe; 7038c2ecf20Sopenharmony_ci 7048c2ecf20Sopenharmony_ci pipe = (dir == SNDRV_PCM_STREAM_PLAYBACK) ? 7058c2ecf20Sopenharmony_ci usb_sndisocpipe(usb_dev, ENDPOINT_PLAYBACK) : 7068c2ecf20Sopenharmony_ci usb_rcvisocpipe(usb_dev, ENDPOINT_CAPTURE); 7078c2ecf20Sopenharmony_ci 7088c2ecf20Sopenharmony_ci urbs = kmalloc_array(N_URBS, sizeof(*urbs), GFP_KERNEL); 7098c2ecf20Sopenharmony_ci if (!urbs) { 7108c2ecf20Sopenharmony_ci *ret = -ENOMEM; 7118c2ecf20Sopenharmony_ci return NULL; 7128c2ecf20Sopenharmony_ci } 7138c2ecf20Sopenharmony_ci 7148c2ecf20Sopenharmony_ci for (i = 0; i < N_URBS; i++) { 7158c2ecf20Sopenharmony_ci urbs[i] = usb_alloc_urb(FRAMES_PER_URB, GFP_KERNEL); 7168c2ecf20Sopenharmony_ci if (!urbs[i]) { 7178c2ecf20Sopenharmony_ci *ret = -ENOMEM; 7188c2ecf20Sopenharmony_ci return urbs; 7198c2ecf20Sopenharmony_ci } 7208c2ecf20Sopenharmony_ci 7218c2ecf20Sopenharmony_ci urbs[i]->transfer_buffer = 7228c2ecf20Sopenharmony_ci kmalloc_array(BYTES_PER_FRAME, FRAMES_PER_URB, 7238c2ecf20Sopenharmony_ci GFP_KERNEL); 7248c2ecf20Sopenharmony_ci if (!urbs[i]->transfer_buffer) { 7258c2ecf20Sopenharmony_ci *ret = -ENOMEM; 7268c2ecf20Sopenharmony_ci return urbs; 7278c2ecf20Sopenharmony_ci } 7288c2ecf20Sopenharmony_ci 7298c2ecf20Sopenharmony_ci for (frame = 0; frame < FRAMES_PER_URB; frame++) { 7308c2ecf20Sopenharmony_ci struct usb_iso_packet_descriptor *iso = 7318c2ecf20Sopenharmony_ci &urbs[i]->iso_frame_desc[frame]; 7328c2ecf20Sopenharmony_ci 7338c2ecf20Sopenharmony_ci iso->offset = BYTES_PER_FRAME * frame; 7348c2ecf20Sopenharmony_ci iso->length = BYTES_PER_FRAME; 7358c2ecf20Sopenharmony_ci } 7368c2ecf20Sopenharmony_ci 7378c2ecf20Sopenharmony_ci urbs[i]->dev = usb_dev; 7388c2ecf20Sopenharmony_ci urbs[i]->pipe = pipe; 7398c2ecf20Sopenharmony_ci urbs[i]->transfer_buffer_length = FRAMES_PER_URB 7408c2ecf20Sopenharmony_ci * BYTES_PER_FRAME; 7418c2ecf20Sopenharmony_ci urbs[i]->context = &cdev->data_cb_info[i]; 7428c2ecf20Sopenharmony_ci urbs[i]->interval = 1; 7438c2ecf20Sopenharmony_ci urbs[i]->number_of_packets = FRAMES_PER_URB; 7448c2ecf20Sopenharmony_ci urbs[i]->complete = (dir == SNDRV_PCM_STREAM_CAPTURE) ? 7458c2ecf20Sopenharmony_ci read_completed : write_completed; 7468c2ecf20Sopenharmony_ci } 7478c2ecf20Sopenharmony_ci 7488c2ecf20Sopenharmony_ci *ret = 0; 7498c2ecf20Sopenharmony_ci return urbs; 7508c2ecf20Sopenharmony_ci} 7518c2ecf20Sopenharmony_ci 7528c2ecf20Sopenharmony_cistatic void free_urbs(struct urb **urbs) 7538c2ecf20Sopenharmony_ci{ 7548c2ecf20Sopenharmony_ci int i; 7558c2ecf20Sopenharmony_ci 7568c2ecf20Sopenharmony_ci if (!urbs) 7578c2ecf20Sopenharmony_ci return; 7588c2ecf20Sopenharmony_ci 7598c2ecf20Sopenharmony_ci for (i = 0; i < N_URBS; i++) { 7608c2ecf20Sopenharmony_ci if (!urbs[i]) 7618c2ecf20Sopenharmony_ci continue; 7628c2ecf20Sopenharmony_ci 7638c2ecf20Sopenharmony_ci usb_kill_urb(urbs[i]); 7648c2ecf20Sopenharmony_ci kfree(urbs[i]->transfer_buffer); 7658c2ecf20Sopenharmony_ci usb_free_urb(urbs[i]); 7668c2ecf20Sopenharmony_ci } 7678c2ecf20Sopenharmony_ci 7688c2ecf20Sopenharmony_ci kfree(urbs); 7698c2ecf20Sopenharmony_ci} 7708c2ecf20Sopenharmony_ci 7718c2ecf20Sopenharmony_ciint snd_usb_caiaq_audio_init(struct snd_usb_caiaqdev *cdev) 7728c2ecf20Sopenharmony_ci{ 7738c2ecf20Sopenharmony_ci int i, ret; 7748c2ecf20Sopenharmony_ci struct device *dev = caiaqdev_to_dev(cdev); 7758c2ecf20Sopenharmony_ci 7768c2ecf20Sopenharmony_ci cdev->n_audio_in = max(cdev->spec.num_analog_audio_in, 7778c2ecf20Sopenharmony_ci cdev->spec.num_digital_audio_in) / 7788c2ecf20Sopenharmony_ci CHANNELS_PER_STREAM; 7798c2ecf20Sopenharmony_ci cdev->n_audio_out = max(cdev->spec.num_analog_audio_out, 7808c2ecf20Sopenharmony_ci cdev->spec.num_digital_audio_out) / 7818c2ecf20Sopenharmony_ci CHANNELS_PER_STREAM; 7828c2ecf20Sopenharmony_ci cdev->n_streams = max(cdev->n_audio_in, cdev->n_audio_out); 7838c2ecf20Sopenharmony_ci 7848c2ecf20Sopenharmony_ci dev_dbg(dev, "cdev->n_audio_in = %d\n", cdev->n_audio_in); 7858c2ecf20Sopenharmony_ci dev_dbg(dev, "cdev->n_audio_out = %d\n", cdev->n_audio_out); 7868c2ecf20Sopenharmony_ci dev_dbg(dev, "cdev->n_streams = %d\n", cdev->n_streams); 7878c2ecf20Sopenharmony_ci 7888c2ecf20Sopenharmony_ci if (cdev->n_streams > MAX_STREAMS) { 7898c2ecf20Sopenharmony_ci dev_err(dev, "unable to initialize device, too many streams.\n"); 7908c2ecf20Sopenharmony_ci return -EINVAL; 7918c2ecf20Sopenharmony_ci } 7928c2ecf20Sopenharmony_ci 7938c2ecf20Sopenharmony_ci if (cdev->n_streams < 1) { 7948c2ecf20Sopenharmony_ci dev_err(dev, "bogus number of streams: %d\n", cdev->n_streams); 7958c2ecf20Sopenharmony_ci return -EINVAL; 7968c2ecf20Sopenharmony_ci } 7978c2ecf20Sopenharmony_ci 7988c2ecf20Sopenharmony_ci ret = snd_pcm_new(cdev->chip.card, cdev->product_name, 0, 7998c2ecf20Sopenharmony_ci cdev->n_audio_out, cdev->n_audio_in, &cdev->pcm); 8008c2ecf20Sopenharmony_ci 8018c2ecf20Sopenharmony_ci if (ret < 0) { 8028c2ecf20Sopenharmony_ci dev_err(dev, "snd_pcm_new() returned %d\n", ret); 8038c2ecf20Sopenharmony_ci return ret; 8048c2ecf20Sopenharmony_ci } 8058c2ecf20Sopenharmony_ci 8068c2ecf20Sopenharmony_ci cdev->pcm->private_data = cdev; 8078c2ecf20Sopenharmony_ci strlcpy(cdev->pcm->name, cdev->product_name, sizeof(cdev->pcm->name)); 8088c2ecf20Sopenharmony_ci 8098c2ecf20Sopenharmony_ci memset(cdev->sub_playback, 0, sizeof(cdev->sub_playback)); 8108c2ecf20Sopenharmony_ci memset(cdev->sub_capture, 0, sizeof(cdev->sub_capture)); 8118c2ecf20Sopenharmony_ci 8128c2ecf20Sopenharmony_ci memcpy(&cdev->pcm_info, &snd_usb_caiaq_pcm_hardware, 8138c2ecf20Sopenharmony_ci sizeof(snd_usb_caiaq_pcm_hardware)); 8148c2ecf20Sopenharmony_ci 8158c2ecf20Sopenharmony_ci /* setup samplerates */ 8168c2ecf20Sopenharmony_ci cdev->samplerates = cdev->pcm_info.rates; 8178c2ecf20Sopenharmony_ci switch (cdev->chip.usb_id) { 8188c2ecf20Sopenharmony_ci case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_AK1): 8198c2ecf20Sopenharmony_ci case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_RIGKONTROL3): 8208c2ecf20Sopenharmony_ci case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_SESSIONIO): 8218c2ecf20Sopenharmony_ci case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_GUITARRIGMOBILE): 8228c2ecf20Sopenharmony_ci cdev->samplerates |= SNDRV_PCM_RATE_192000; 8238c2ecf20Sopenharmony_ci fallthrough; 8248c2ecf20Sopenharmony_ci case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_AUDIO2DJ): 8258c2ecf20Sopenharmony_ci case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_AUDIO4DJ): 8268c2ecf20Sopenharmony_ci case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_AUDIO8DJ): 8278c2ecf20Sopenharmony_ci case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_TRAKTORAUDIO2): 8288c2ecf20Sopenharmony_ci cdev->samplerates |= SNDRV_PCM_RATE_88200; 8298c2ecf20Sopenharmony_ci break; 8308c2ecf20Sopenharmony_ci } 8318c2ecf20Sopenharmony_ci 8328c2ecf20Sopenharmony_ci snd_pcm_set_ops(cdev->pcm, SNDRV_PCM_STREAM_PLAYBACK, 8338c2ecf20Sopenharmony_ci &snd_usb_caiaq_ops); 8348c2ecf20Sopenharmony_ci snd_pcm_set_ops(cdev->pcm, SNDRV_PCM_STREAM_CAPTURE, 8358c2ecf20Sopenharmony_ci &snd_usb_caiaq_ops); 8368c2ecf20Sopenharmony_ci snd_pcm_set_managed_buffer_all(cdev->pcm, SNDRV_DMA_TYPE_VMALLOC, 8378c2ecf20Sopenharmony_ci NULL, 0, 0); 8388c2ecf20Sopenharmony_ci 8398c2ecf20Sopenharmony_ci cdev->data_cb_info = 8408c2ecf20Sopenharmony_ci kmalloc_array(N_URBS, sizeof(struct snd_usb_caiaq_cb_info), 8418c2ecf20Sopenharmony_ci GFP_KERNEL); 8428c2ecf20Sopenharmony_ci 8438c2ecf20Sopenharmony_ci if (!cdev->data_cb_info) 8448c2ecf20Sopenharmony_ci return -ENOMEM; 8458c2ecf20Sopenharmony_ci 8468c2ecf20Sopenharmony_ci cdev->outurb_active_mask = 0; 8478c2ecf20Sopenharmony_ci BUILD_BUG_ON(N_URBS > (sizeof(cdev->outurb_active_mask) * 8)); 8488c2ecf20Sopenharmony_ci 8498c2ecf20Sopenharmony_ci for (i = 0; i < N_URBS; i++) { 8508c2ecf20Sopenharmony_ci cdev->data_cb_info[i].cdev = cdev; 8518c2ecf20Sopenharmony_ci cdev->data_cb_info[i].index = i; 8528c2ecf20Sopenharmony_ci } 8538c2ecf20Sopenharmony_ci 8548c2ecf20Sopenharmony_ci cdev->data_urbs_in = alloc_urbs(cdev, SNDRV_PCM_STREAM_CAPTURE, &ret); 8558c2ecf20Sopenharmony_ci if (ret < 0) { 8568c2ecf20Sopenharmony_ci kfree(cdev->data_cb_info); 8578c2ecf20Sopenharmony_ci free_urbs(cdev->data_urbs_in); 8588c2ecf20Sopenharmony_ci return ret; 8598c2ecf20Sopenharmony_ci } 8608c2ecf20Sopenharmony_ci 8618c2ecf20Sopenharmony_ci cdev->data_urbs_out = alloc_urbs(cdev, SNDRV_PCM_STREAM_PLAYBACK, &ret); 8628c2ecf20Sopenharmony_ci if (ret < 0) { 8638c2ecf20Sopenharmony_ci kfree(cdev->data_cb_info); 8648c2ecf20Sopenharmony_ci free_urbs(cdev->data_urbs_in); 8658c2ecf20Sopenharmony_ci free_urbs(cdev->data_urbs_out); 8668c2ecf20Sopenharmony_ci return ret; 8678c2ecf20Sopenharmony_ci } 8688c2ecf20Sopenharmony_ci 8698c2ecf20Sopenharmony_ci return 0; 8708c2ecf20Sopenharmony_ci} 8718c2ecf20Sopenharmony_ci 8728c2ecf20Sopenharmony_civoid snd_usb_caiaq_audio_free(struct snd_usb_caiaqdev *cdev) 8738c2ecf20Sopenharmony_ci{ 8748c2ecf20Sopenharmony_ci struct device *dev = caiaqdev_to_dev(cdev); 8758c2ecf20Sopenharmony_ci 8768c2ecf20Sopenharmony_ci dev_dbg(dev, "%s(%p)\n", __func__, cdev); 8778c2ecf20Sopenharmony_ci stream_stop(cdev); 8788c2ecf20Sopenharmony_ci free_urbs(cdev->data_urbs_in); 8798c2ecf20Sopenharmony_ci free_urbs(cdev->data_urbs_out); 8808c2ecf20Sopenharmony_ci kfree(cdev->data_cb_info); 8818c2ecf20Sopenharmony_ci} 8828c2ecf20Sopenharmony_ci 883