18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * i2sbus driver -- pcm routines 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Copyright 2006 Johannes Berg <johannes@sipsolutions.net> 68c2ecf20Sopenharmony_ci */ 78c2ecf20Sopenharmony_ci 88c2ecf20Sopenharmony_ci#include <linux/io.h> 98c2ecf20Sopenharmony_ci#include <linux/delay.h> 108c2ecf20Sopenharmony_ci#include <linux/slab.h> 118c2ecf20Sopenharmony_ci#include <sound/core.h> 128c2ecf20Sopenharmony_ci#include <asm/macio.h> 138c2ecf20Sopenharmony_ci#include <linux/pci.h> 148c2ecf20Sopenharmony_ci#include <linux/module.h> 158c2ecf20Sopenharmony_ci#include "../soundbus.h" 168c2ecf20Sopenharmony_ci#include "i2sbus.h" 178c2ecf20Sopenharmony_ci 188c2ecf20Sopenharmony_cistatic inline void get_pcm_info(struct i2sbus_dev *i2sdev, int in, 198c2ecf20Sopenharmony_ci struct pcm_info **pi, struct pcm_info **other) 208c2ecf20Sopenharmony_ci{ 218c2ecf20Sopenharmony_ci if (in) { 228c2ecf20Sopenharmony_ci if (pi) 238c2ecf20Sopenharmony_ci *pi = &i2sdev->in; 248c2ecf20Sopenharmony_ci if (other) 258c2ecf20Sopenharmony_ci *other = &i2sdev->out; 268c2ecf20Sopenharmony_ci } else { 278c2ecf20Sopenharmony_ci if (pi) 288c2ecf20Sopenharmony_ci *pi = &i2sdev->out; 298c2ecf20Sopenharmony_ci if (other) 308c2ecf20Sopenharmony_ci *other = &i2sdev->in; 318c2ecf20Sopenharmony_ci } 328c2ecf20Sopenharmony_ci} 338c2ecf20Sopenharmony_ci 348c2ecf20Sopenharmony_cistatic int clock_and_divisors(int mclk, int sclk, int rate, int *out) 358c2ecf20Sopenharmony_ci{ 368c2ecf20Sopenharmony_ci /* sclk must be derived from mclk! */ 378c2ecf20Sopenharmony_ci if (mclk % sclk) 388c2ecf20Sopenharmony_ci return -1; 398c2ecf20Sopenharmony_ci /* derive sclk register value */ 408c2ecf20Sopenharmony_ci if (i2s_sf_sclkdiv(mclk / sclk, out)) 418c2ecf20Sopenharmony_ci return -1; 428c2ecf20Sopenharmony_ci 438c2ecf20Sopenharmony_ci if (I2S_CLOCK_SPEED_18MHz % (rate * mclk) == 0) { 448c2ecf20Sopenharmony_ci if (!i2s_sf_mclkdiv(I2S_CLOCK_SPEED_18MHz / (rate * mclk), out)) { 458c2ecf20Sopenharmony_ci *out |= I2S_SF_CLOCK_SOURCE_18MHz; 468c2ecf20Sopenharmony_ci return 0; 478c2ecf20Sopenharmony_ci } 488c2ecf20Sopenharmony_ci } 498c2ecf20Sopenharmony_ci if (I2S_CLOCK_SPEED_45MHz % (rate * mclk) == 0) { 508c2ecf20Sopenharmony_ci if (!i2s_sf_mclkdiv(I2S_CLOCK_SPEED_45MHz / (rate * mclk), out)) { 518c2ecf20Sopenharmony_ci *out |= I2S_SF_CLOCK_SOURCE_45MHz; 528c2ecf20Sopenharmony_ci return 0; 538c2ecf20Sopenharmony_ci } 548c2ecf20Sopenharmony_ci } 558c2ecf20Sopenharmony_ci if (I2S_CLOCK_SPEED_49MHz % (rate * mclk) == 0) { 568c2ecf20Sopenharmony_ci if (!i2s_sf_mclkdiv(I2S_CLOCK_SPEED_49MHz / (rate * mclk), out)) { 578c2ecf20Sopenharmony_ci *out |= I2S_SF_CLOCK_SOURCE_49MHz; 588c2ecf20Sopenharmony_ci return 0; 598c2ecf20Sopenharmony_ci } 608c2ecf20Sopenharmony_ci } 618c2ecf20Sopenharmony_ci return -1; 628c2ecf20Sopenharmony_ci} 638c2ecf20Sopenharmony_ci 648c2ecf20Sopenharmony_ci#define CHECK_RATE(rate) \ 658c2ecf20Sopenharmony_ci do { if (rates & SNDRV_PCM_RATE_ ##rate) { \ 668c2ecf20Sopenharmony_ci int dummy; \ 678c2ecf20Sopenharmony_ci if (clock_and_divisors(sysclock_factor, \ 688c2ecf20Sopenharmony_ci bus_factor, rate, &dummy)) \ 698c2ecf20Sopenharmony_ci rates &= ~SNDRV_PCM_RATE_ ##rate; \ 708c2ecf20Sopenharmony_ci } } while (0) 718c2ecf20Sopenharmony_ci 728c2ecf20Sopenharmony_cistatic int i2sbus_pcm_open(struct i2sbus_dev *i2sdev, int in) 738c2ecf20Sopenharmony_ci{ 748c2ecf20Sopenharmony_ci struct pcm_info *pi, *other; 758c2ecf20Sopenharmony_ci struct soundbus_dev *sdev; 768c2ecf20Sopenharmony_ci int masks_inited = 0, err; 778c2ecf20Sopenharmony_ci struct codec_info_item *cii, *rev; 788c2ecf20Sopenharmony_ci struct snd_pcm_hardware *hw; 798c2ecf20Sopenharmony_ci u64 formats = 0; 808c2ecf20Sopenharmony_ci unsigned int rates = 0; 818c2ecf20Sopenharmony_ci struct transfer_info v; 828c2ecf20Sopenharmony_ci int result = 0; 838c2ecf20Sopenharmony_ci int bus_factor = 0, sysclock_factor = 0; 848c2ecf20Sopenharmony_ci int found_this; 858c2ecf20Sopenharmony_ci 868c2ecf20Sopenharmony_ci mutex_lock(&i2sdev->lock); 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_ci get_pcm_info(i2sdev, in, &pi, &other); 898c2ecf20Sopenharmony_ci 908c2ecf20Sopenharmony_ci hw = &pi->substream->runtime->hw; 918c2ecf20Sopenharmony_ci sdev = &i2sdev->sound; 928c2ecf20Sopenharmony_ci 938c2ecf20Sopenharmony_ci if (pi->active) { 948c2ecf20Sopenharmony_ci /* alsa messed up */ 958c2ecf20Sopenharmony_ci result = -EBUSY; 968c2ecf20Sopenharmony_ci goto out_unlock; 978c2ecf20Sopenharmony_ci } 988c2ecf20Sopenharmony_ci 998c2ecf20Sopenharmony_ci /* we now need to assign the hw */ 1008c2ecf20Sopenharmony_ci list_for_each_entry(cii, &sdev->codec_list, list) { 1018c2ecf20Sopenharmony_ci struct transfer_info *ti = cii->codec->transfers; 1028c2ecf20Sopenharmony_ci bus_factor = cii->codec->bus_factor; 1038c2ecf20Sopenharmony_ci sysclock_factor = cii->codec->sysclock_factor; 1048c2ecf20Sopenharmony_ci while (ti->formats && ti->rates) { 1058c2ecf20Sopenharmony_ci v = *ti; 1068c2ecf20Sopenharmony_ci if (ti->transfer_in == in 1078c2ecf20Sopenharmony_ci && cii->codec->usable(cii, ti, &v)) { 1088c2ecf20Sopenharmony_ci if (masks_inited) { 1098c2ecf20Sopenharmony_ci formats &= v.formats; 1108c2ecf20Sopenharmony_ci rates &= v.rates; 1118c2ecf20Sopenharmony_ci } else { 1128c2ecf20Sopenharmony_ci formats = v.formats; 1138c2ecf20Sopenharmony_ci rates = v.rates; 1148c2ecf20Sopenharmony_ci masks_inited = 1; 1158c2ecf20Sopenharmony_ci } 1168c2ecf20Sopenharmony_ci } 1178c2ecf20Sopenharmony_ci ti++; 1188c2ecf20Sopenharmony_ci } 1198c2ecf20Sopenharmony_ci } 1208c2ecf20Sopenharmony_ci if (!masks_inited || !bus_factor || !sysclock_factor) { 1218c2ecf20Sopenharmony_ci result = -ENODEV; 1228c2ecf20Sopenharmony_ci goto out_unlock; 1238c2ecf20Sopenharmony_ci } 1248c2ecf20Sopenharmony_ci /* bus dependent stuff */ 1258c2ecf20Sopenharmony_ci hw->info = SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID | 1268c2ecf20Sopenharmony_ci SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_RESUME | 1278c2ecf20Sopenharmony_ci SNDRV_PCM_INFO_JOINT_DUPLEX; 1288c2ecf20Sopenharmony_ci 1298c2ecf20Sopenharmony_ci CHECK_RATE(5512); 1308c2ecf20Sopenharmony_ci CHECK_RATE(8000); 1318c2ecf20Sopenharmony_ci CHECK_RATE(11025); 1328c2ecf20Sopenharmony_ci CHECK_RATE(16000); 1338c2ecf20Sopenharmony_ci CHECK_RATE(22050); 1348c2ecf20Sopenharmony_ci CHECK_RATE(32000); 1358c2ecf20Sopenharmony_ci CHECK_RATE(44100); 1368c2ecf20Sopenharmony_ci CHECK_RATE(48000); 1378c2ecf20Sopenharmony_ci CHECK_RATE(64000); 1388c2ecf20Sopenharmony_ci CHECK_RATE(88200); 1398c2ecf20Sopenharmony_ci CHECK_RATE(96000); 1408c2ecf20Sopenharmony_ci CHECK_RATE(176400); 1418c2ecf20Sopenharmony_ci CHECK_RATE(192000); 1428c2ecf20Sopenharmony_ci hw->rates = rates; 1438c2ecf20Sopenharmony_ci 1448c2ecf20Sopenharmony_ci /* well. the codec might want 24 bits only, and we'll 1458c2ecf20Sopenharmony_ci * ever only transfer 24 bits, but they are top-aligned! 1468c2ecf20Sopenharmony_ci * So for alsa, we claim that we're doing full 32 bit 1478c2ecf20Sopenharmony_ci * while in reality we'll ignore the lower 8 bits of 1488c2ecf20Sopenharmony_ci * that when doing playback (they're transferred as 0 1498c2ecf20Sopenharmony_ci * as far as I know, no codecs we have are 32-bit capable 1508c2ecf20Sopenharmony_ci * so I can't really test) and when doing recording we'll 1518c2ecf20Sopenharmony_ci * always have those lower 8 bits recorded as 0 */ 1528c2ecf20Sopenharmony_ci if (formats & SNDRV_PCM_FMTBIT_S24_BE) 1538c2ecf20Sopenharmony_ci formats |= SNDRV_PCM_FMTBIT_S32_BE; 1548c2ecf20Sopenharmony_ci if (formats & SNDRV_PCM_FMTBIT_U24_BE) 1558c2ecf20Sopenharmony_ci formats |= SNDRV_PCM_FMTBIT_U32_BE; 1568c2ecf20Sopenharmony_ci /* now mask off what we can support. I suppose we could 1578c2ecf20Sopenharmony_ci * also support S24_3LE and some similar formats, but I 1588c2ecf20Sopenharmony_ci * doubt there's a codec that would be able to use that, 1598c2ecf20Sopenharmony_ci * so we don't support it here. */ 1608c2ecf20Sopenharmony_ci hw->formats = formats & (SNDRV_PCM_FMTBIT_S16_BE | 1618c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_U16_BE | 1628c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_S32_BE | 1638c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_U32_BE); 1648c2ecf20Sopenharmony_ci 1658c2ecf20Sopenharmony_ci /* we need to set the highest and lowest rate possible. 1668c2ecf20Sopenharmony_ci * These are the highest and lowest rates alsa can 1678c2ecf20Sopenharmony_ci * support properly in its bitfield. 1688c2ecf20Sopenharmony_ci * Below, we'll use that to restrict to the rate 1698c2ecf20Sopenharmony_ci * currently in use (if any). */ 1708c2ecf20Sopenharmony_ci hw->rate_min = 5512; 1718c2ecf20Sopenharmony_ci hw->rate_max = 192000; 1728c2ecf20Sopenharmony_ci /* if the other stream is active, then we can only 1738c2ecf20Sopenharmony_ci * support what it is currently using. 1748c2ecf20Sopenharmony_ci * FIXME: I lied. This comment is wrong. We can support 1758c2ecf20Sopenharmony_ci * anything that works with the same serial format, ie. 1768c2ecf20Sopenharmony_ci * when recording 24 bit sound we can well play 16 bit 1778c2ecf20Sopenharmony_ci * sound at the same time iff using the same transfer mode. 1788c2ecf20Sopenharmony_ci */ 1798c2ecf20Sopenharmony_ci if (other->active) { 1808c2ecf20Sopenharmony_ci /* FIXME: is this guaranteed by the alsa api? */ 1818c2ecf20Sopenharmony_ci hw->formats &= pcm_format_to_bits(i2sdev->format); 1828c2ecf20Sopenharmony_ci /* see above, restrict rates to the one we already have */ 1838c2ecf20Sopenharmony_ci hw->rate_min = i2sdev->rate; 1848c2ecf20Sopenharmony_ci hw->rate_max = i2sdev->rate; 1858c2ecf20Sopenharmony_ci } 1868c2ecf20Sopenharmony_ci 1878c2ecf20Sopenharmony_ci hw->channels_min = 2; 1888c2ecf20Sopenharmony_ci hw->channels_max = 2; 1898c2ecf20Sopenharmony_ci /* these are somewhat arbitrary */ 1908c2ecf20Sopenharmony_ci hw->buffer_bytes_max = 131072; 1918c2ecf20Sopenharmony_ci hw->period_bytes_min = 256; 1928c2ecf20Sopenharmony_ci hw->period_bytes_max = 16384; 1938c2ecf20Sopenharmony_ci hw->periods_min = 3; 1948c2ecf20Sopenharmony_ci hw->periods_max = MAX_DBDMA_COMMANDS; 1958c2ecf20Sopenharmony_ci err = snd_pcm_hw_constraint_integer(pi->substream->runtime, 1968c2ecf20Sopenharmony_ci SNDRV_PCM_HW_PARAM_PERIODS); 1978c2ecf20Sopenharmony_ci if (err < 0) { 1988c2ecf20Sopenharmony_ci result = err; 1998c2ecf20Sopenharmony_ci goto out_unlock; 2008c2ecf20Sopenharmony_ci } 2018c2ecf20Sopenharmony_ci list_for_each_entry(cii, &sdev->codec_list, list) { 2028c2ecf20Sopenharmony_ci if (cii->codec->open) { 2038c2ecf20Sopenharmony_ci err = cii->codec->open(cii, pi->substream); 2048c2ecf20Sopenharmony_ci if (err) { 2058c2ecf20Sopenharmony_ci result = err; 2068c2ecf20Sopenharmony_ci /* unwind */ 2078c2ecf20Sopenharmony_ci found_this = 0; 2088c2ecf20Sopenharmony_ci list_for_each_entry_reverse(rev, 2098c2ecf20Sopenharmony_ci &sdev->codec_list, list) { 2108c2ecf20Sopenharmony_ci if (found_this && rev->codec->close) { 2118c2ecf20Sopenharmony_ci rev->codec->close(rev, 2128c2ecf20Sopenharmony_ci pi->substream); 2138c2ecf20Sopenharmony_ci } 2148c2ecf20Sopenharmony_ci if (rev == cii) 2158c2ecf20Sopenharmony_ci found_this = 1; 2168c2ecf20Sopenharmony_ci } 2178c2ecf20Sopenharmony_ci goto out_unlock; 2188c2ecf20Sopenharmony_ci } 2198c2ecf20Sopenharmony_ci } 2208c2ecf20Sopenharmony_ci } 2218c2ecf20Sopenharmony_ci 2228c2ecf20Sopenharmony_ci out_unlock: 2238c2ecf20Sopenharmony_ci mutex_unlock(&i2sdev->lock); 2248c2ecf20Sopenharmony_ci return result; 2258c2ecf20Sopenharmony_ci} 2268c2ecf20Sopenharmony_ci 2278c2ecf20Sopenharmony_ci#undef CHECK_RATE 2288c2ecf20Sopenharmony_ci 2298c2ecf20Sopenharmony_cistatic int i2sbus_pcm_close(struct i2sbus_dev *i2sdev, int in) 2308c2ecf20Sopenharmony_ci{ 2318c2ecf20Sopenharmony_ci struct codec_info_item *cii; 2328c2ecf20Sopenharmony_ci struct pcm_info *pi; 2338c2ecf20Sopenharmony_ci int err = 0, tmp; 2348c2ecf20Sopenharmony_ci 2358c2ecf20Sopenharmony_ci mutex_lock(&i2sdev->lock); 2368c2ecf20Sopenharmony_ci 2378c2ecf20Sopenharmony_ci get_pcm_info(i2sdev, in, &pi, NULL); 2388c2ecf20Sopenharmony_ci 2398c2ecf20Sopenharmony_ci list_for_each_entry(cii, &i2sdev->sound.codec_list, list) { 2408c2ecf20Sopenharmony_ci if (cii->codec->close) { 2418c2ecf20Sopenharmony_ci tmp = cii->codec->close(cii, pi->substream); 2428c2ecf20Sopenharmony_ci if (tmp) 2438c2ecf20Sopenharmony_ci err = tmp; 2448c2ecf20Sopenharmony_ci } 2458c2ecf20Sopenharmony_ci } 2468c2ecf20Sopenharmony_ci 2478c2ecf20Sopenharmony_ci pi->substream = NULL; 2488c2ecf20Sopenharmony_ci pi->active = 0; 2498c2ecf20Sopenharmony_ci mutex_unlock(&i2sdev->lock); 2508c2ecf20Sopenharmony_ci return err; 2518c2ecf20Sopenharmony_ci} 2528c2ecf20Sopenharmony_ci 2538c2ecf20Sopenharmony_cistatic void i2sbus_wait_for_stop(struct i2sbus_dev *i2sdev, 2548c2ecf20Sopenharmony_ci struct pcm_info *pi) 2558c2ecf20Sopenharmony_ci{ 2568c2ecf20Sopenharmony_ci unsigned long flags; 2578c2ecf20Sopenharmony_ci DECLARE_COMPLETION_ONSTACK(done); 2588c2ecf20Sopenharmony_ci long timeout; 2598c2ecf20Sopenharmony_ci 2608c2ecf20Sopenharmony_ci spin_lock_irqsave(&i2sdev->low_lock, flags); 2618c2ecf20Sopenharmony_ci if (pi->dbdma_ring.stopping) { 2628c2ecf20Sopenharmony_ci pi->stop_completion = &done; 2638c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&i2sdev->low_lock, flags); 2648c2ecf20Sopenharmony_ci timeout = wait_for_completion_timeout(&done, HZ); 2658c2ecf20Sopenharmony_ci spin_lock_irqsave(&i2sdev->low_lock, flags); 2668c2ecf20Sopenharmony_ci pi->stop_completion = NULL; 2678c2ecf20Sopenharmony_ci if (timeout == 0) { 2688c2ecf20Sopenharmony_ci /* timeout expired, stop dbdma forcefully */ 2698c2ecf20Sopenharmony_ci printk(KERN_ERR "i2sbus_wait_for_stop: timed out\n"); 2708c2ecf20Sopenharmony_ci /* make sure RUN, PAUSE and S0 bits are cleared */ 2718c2ecf20Sopenharmony_ci out_le32(&pi->dbdma->control, (RUN | PAUSE | 1) << 16); 2728c2ecf20Sopenharmony_ci pi->dbdma_ring.stopping = 0; 2738c2ecf20Sopenharmony_ci timeout = 10; 2748c2ecf20Sopenharmony_ci while (in_le32(&pi->dbdma->status) & ACTIVE) { 2758c2ecf20Sopenharmony_ci if (--timeout <= 0) 2768c2ecf20Sopenharmony_ci break; 2778c2ecf20Sopenharmony_ci udelay(1); 2788c2ecf20Sopenharmony_ci } 2798c2ecf20Sopenharmony_ci } 2808c2ecf20Sopenharmony_ci } 2818c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&i2sdev->low_lock, flags); 2828c2ecf20Sopenharmony_ci} 2838c2ecf20Sopenharmony_ci 2848c2ecf20Sopenharmony_ci#ifdef CONFIG_PM 2858c2ecf20Sopenharmony_civoid i2sbus_wait_for_stop_both(struct i2sbus_dev *i2sdev) 2868c2ecf20Sopenharmony_ci{ 2878c2ecf20Sopenharmony_ci struct pcm_info *pi; 2888c2ecf20Sopenharmony_ci 2898c2ecf20Sopenharmony_ci get_pcm_info(i2sdev, 0, &pi, NULL); 2908c2ecf20Sopenharmony_ci i2sbus_wait_for_stop(i2sdev, pi); 2918c2ecf20Sopenharmony_ci get_pcm_info(i2sdev, 1, &pi, NULL); 2928c2ecf20Sopenharmony_ci i2sbus_wait_for_stop(i2sdev, pi); 2938c2ecf20Sopenharmony_ci} 2948c2ecf20Sopenharmony_ci#endif 2958c2ecf20Sopenharmony_ci 2968c2ecf20Sopenharmony_cistatic inline int i2sbus_hw_free(struct snd_pcm_substream *substream, int in) 2978c2ecf20Sopenharmony_ci{ 2988c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 2998c2ecf20Sopenharmony_ci struct pcm_info *pi; 3008c2ecf20Sopenharmony_ci 3018c2ecf20Sopenharmony_ci get_pcm_info(i2sdev, in, &pi, NULL); 3028c2ecf20Sopenharmony_ci if (pi->dbdma_ring.stopping) 3038c2ecf20Sopenharmony_ci i2sbus_wait_for_stop(i2sdev, pi); 3048c2ecf20Sopenharmony_ci return 0; 3058c2ecf20Sopenharmony_ci} 3068c2ecf20Sopenharmony_ci 3078c2ecf20Sopenharmony_cistatic int i2sbus_playback_hw_free(struct snd_pcm_substream *substream) 3088c2ecf20Sopenharmony_ci{ 3098c2ecf20Sopenharmony_ci return i2sbus_hw_free(substream, 0); 3108c2ecf20Sopenharmony_ci} 3118c2ecf20Sopenharmony_ci 3128c2ecf20Sopenharmony_cistatic int i2sbus_record_hw_free(struct snd_pcm_substream *substream) 3138c2ecf20Sopenharmony_ci{ 3148c2ecf20Sopenharmony_ci return i2sbus_hw_free(substream, 1); 3158c2ecf20Sopenharmony_ci} 3168c2ecf20Sopenharmony_ci 3178c2ecf20Sopenharmony_cistatic int i2sbus_pcm_prepare(struct i2sbus_dev *i2sdev, int in) 3188c2ecf20Sopenharmony_ci{ 3198c2ecf20Sopenharmony_ci /* whee. Hard work now. The user has selected a bitrate 3208c2ecf20Sopenharmony_ci * and bit format, so now we have to program our 3218c2ecf20Sopenharmony_ci * I2S controller appropriately. */ 3228c2ecf20Sopenharmony_ci struct snd_pcm_runtime *runtime; 3238c2ecf20Sopenharmony_ci struct dbdma_cmd *command; 3248c2ecf20Sopenharmony_ci int i, periodsize, nperiods; 3258c2ecf20Sopenharmony_ci dma_addr_t offset; 3268c2ecf20Sopenharmony_ci struct bus_info bi; 3278c2ecf20Sopenharmony_ci struct codec_info_item *cii; 3288c2ecf20Sopenharmony_ci int sfr = 0; /* serial format register */ 3298c2ecf20Sopenharmony_ci int dws = 0; /* data word sizes reg */ 3308c2ecf20Sopenharmony_ci int input_16bit; 3318c2ecf20Sopenharmony_ci struct pcm_info *pi, *other; 3328c2ecf20Sopenharmony_ci int cnt; 3338c2ecf20Sopenharmony_ci int result = 0; 3348c2ecf20Sopenharmony_ci unsigned int cmd, stopaddr; 3358c2ecf20Sopenharmony_ci 3368c2ecf20Sopenharmony_ci mutex_lock(&i2sdev->lock); 3378c2ecf20Sopenharmony_ci 3388c2ecf20Sopenharmony_ci get_pcm_info(i2sdev, in, &pi, &other); 3398c2ecf20Sopenharmony_ci 3408c2ecf20Sopenharmony_ci if (pi->dbdma_ring.running) { 3418c2ecf20Sopenharmony_ci result = -EBUSY; 3428c2ecf20Sopenharmony_ci goto out_unlock; 3438c2ecf20Sopenharmony_ci } 3448c2ecf20Sopenharmony_ci if (pi->dbdma_ring.stopping) 3458c2ecf20Sopenharmony_ci i2sbus_wait_for_stop(i2sdev, pi); 3468c2ecf20Sopenharmony_ci 3478c2ecf20Sopenharmony_ci if (!pi->substream || !pi->substream->runtime) { 3488c2ecf20Sopenharmony_ci result = -EINVAL; 3498c2ecf20Sopenharmony_ci goto out_unlock; 3508c2ecf20Sopenharmony_ci } 3518c2ecf20Sopenharmony_ci 3528c2ecf20Sopenharmony_ci runtime = pi->substream->runtime; 3538c2ecf20Sopenharmony_ci pi->active = 1; 3548c2ecf20Sopenharmony_ci if (other->active && 3558c2ecf20Sopenharmony_ci ((i2sdev->format != runtime->format) 3568c2ecf20Sopenharmony_ci || (i2sdev->rate != runtime->rate))) { 3578c2ecf20Sopenharmony_ci result = -EINVAL; 3588c2ecf20Sopenharmony_ci goto out_unlock; 3598c2ecf20Sopenharmony_ci } 3608c2ecf20Sopenharmony_ci 3618c2ecf20Sopenharmony_ci i2sdev->format = runtime->format; 3628c2ecf20Sopenharmony_ci i2sdev->rate = runtime->rate; 3638c2ecf20Sopenharmony_ci 3648c2ecf20Sopenharmony_ci periodsize = snd_pcm_lib_period_bytes(pi->substream); 3658c2ecf20Sopenharmony_ci nperiods = pi->substream->runtime->periods; 3668c2ecf20Sopenharmony_ci pi->current_period = 0; 3678c2ecf20Sopenharmony_ci 3688c2ecf20Sopenharmony_ci /* generate dbdma command ring first */ 3698c2ecf20Sopenharmony_ci command = pi->dbdma_ring.cmds; 3708c2ecf20Sopenharmony_ci memset(command, 0, (nperiods + 2) * sizeof(struct dbdma_cmd)); 3718c2ecf20Sopenharmony_ci 3728c2ecf20Sopenharmony_ci /* commands to DMA to/from the ring */ 3738c2ecf20Sopenharmony_ci /* 3748c2ecf20Sopenharmony_ci * For input, we need to do a graceful stop; if we abort 3758c2ecf20Sopenharmony_ci * the DMA, we end up with leftover bytes that corrupt 3768c2ecf20Sopenharmony_ci * the next recording. To do this we set the S0 status 3778c2ecf20Sopenharmony_ci * bit and wait for the DMA controller to stop. Each 3788c2ecf20Sopenharmony_ci * command has a branch condition to 3798c2ecf20Sopenharmony_ci * make it branch to a stop command if S0 is set. 3808c2ecf20Sopenharmony_ci * On input we also need to wait for the S7 bit to be 3818c2ecf20Sopenharmony_ci * set before turning off the DMA controller. 3828c2ecf20Sopenharmony_ci * In fact we do the graceful stop for output as well. 3838c2ecf20Sopenharmony_ci */ 3848c2ecf20Sopenharmony_ci offset = runtime->dma_addr; 3858c2ecf20Sopenharmony_ci cmd = (in? INPUT_MORE: OUTPUT_MORE) | BR_IFSET | INTR_ALWAYS; 3868c2ecf20Sopenharmony_ci stopaddr = pi->dbdma_ring.bus_cmd_start + 3878c2ecf20Sopenharmony_ci (nperiods + 1) * sizeof(struct dbdma_cmd); 3888c2ecf20Sopenharmony_ci for (i = 0; i < nperiods; i++, command++, offset += periodsize) { 3898c2ecf20Sopenharmony_ci command->command = cpu_to_le16(cmd); 3908c2ecf20Sopenharmony_ci command->cmd_dep = cpu_to_le32(stopaddr); 3918c2ecf20Sopenharmony_ci command->phy_addr = cpu_to_le32(offset); 3928c2ecf20Sopenharmony_ci command->req_count = cpu_to_le16(periodsize); 3938c2ecf20Sopenharmony_ci } 3948c2ecf20Sopenharmony_ci 3958c2ecf20Sopenharmony_ci /* branch back to beginning of ring */ 3968c2ecf20Sopenharmony_ci command->command = cpu_to_le16(DBDMA_NOP | BR_ALWAYS); 3978c2ecf20Sopenharmony_ci command->cmd_dep = cpu_to_le32(pi->dbdma_ring.bus_cmd_start); 3988c2ecf20Sopenharmony_ci command++; 3998c2ecf20Sopenharmony_ci 4008c2ecf20Sopenharmony_ci /* set stop command */ 4018c2ecf20Sopenharmony_ci command->command = cpu_to_le16(DBDMA_STOP); 4028c2ecf20Sopenharmony_ci 4038c2ecf20Sopenharmony_ci /* ok, let's set the serial format and stuff */ 4048c2ecf20Sopenharmony_ci switch (runtime->format) { 4058c2ecf20Sopenharmony_ci /* 16 bit formats */ 4068c2ecf20Sopenharmony_ci case SNDRV_PCM_FORMAT_S16_BE: 4078c2ecf20Sopenharmony_ci case SNDRV_PCM_FORMAT_U16_BE: 4088c2ecf20Sopenharmony_ci /* FIXME: if we add different bus factors we need to 4098c2ecf20Sopenharmony_ci * do more here!! */ 4108c2ecf20Sopenharmony_ci bi.bus_factor = 0; 4118c2ecf20Sopenharmony_ci list_for_each_entry(cii, &i2sdev->sound.codec_list, list) { 4128c2ecf20Sopenharmony_ci bi.bus_factor = cii->codec->bus_factor; 4138c2ecf20Sopenharmony_ci break; 4148c2ecf20Sopenharmony_ci } 4158c2ecf20Sopenharmony_ci if (!bi.bus_factor) { 4168c2ecf20Sopenharmony_ci result = -ENODEV; 4178c2ecf20Sopenharmony_ci goto out_unlock; 4188c2ecf20Sopenharmony_ci } 4198c2ecf20Sopenharmony_ci input_16bit = 1; 4208c2ecf20Sopenharmony_ci break; 4218c2ecf20Sopenharmony_ci case SNDRV_PCM_FORMAT_S32_BE: 4228c2ecf20Sopenharmony_ci case SNDRV_PCM_FORMAT_U32_BE: 4238c2ecf20Sopenharmony_ci /* force 64x bus speed, otherwise the data cannot be 4248c2ecf20Sopenharmony_ci * transferred quickly enough! */ 4258c2ecf20Sopenharmony_ci bi.bus_factor = 64; 4268c2ecf20Sopenharmony_ci input_16bit = 0; 4278c2ecf20Sopenharmony_ci break; 4288c2ecf20Sopenharmony_ci default: 4298c2ecf20Sopenharmony_ci result = -EINVAL; 4308c2ecf20Sopenharmony_ci goto out_unlock; 4318c2ecf20Sopenharmony_ci } 4328c2ecf20Sopenharmony_ci /* we assume all sysclocks are the same! */ 4338c2ecf20Sopenharmony_ci list_for_each_entry(cii, &i2sdev->sound.codec_list, list) { 4348c2ecf20Sopenharmony_ci bi.sysclock_factor = cii->codec->sysclock_factor; 4358c2ecf20Sopenharmony_ci break; 4368c2ecf20Sopenharmony_ci } 4378c2ecf20Sopenharmony_ci 4388c2ecf20Sopenharmony_ci if (clock_and_divisors(bi.sysclock_factor, 4398c2ecf20Sopenharmony_ci bi.bus_factor, 4408c2ecf20Sopenharmony_ci runtime->rate, 4418c2ecf20Sopenharmony_ci &sfr) < 0) { 4428c2ecf20Sopenharmony_ci result = -EINVAL; 4438c2ecf20Sopenharmony_ci goto out_unlock; 4448c2ecf20Sopenharmony_ci } 4458c2ecf20Sopenharmony_ci switch (bi.bus_factor) { 4468c2ecf20Sopenharmony_ci case 32: 4478c2ecf20Sopenharmony_ci sfr |= I2S_SF_SERIAL_FORMAT_I2S_32X; 4488c2ecf20Sopenharmony_ci break; 4498c2ecf20Sopenharmony_ci case 64: 4508c2ecf20Sopenharmony_ci sfr |= I2S_SF_SERIAL_FORMAT_I2S_64X; 4518c2ecf20Sopenharmony_ci break; 4528c2ecf20Sopenharmony_ci } 4538c2ecf20Sopenharmony_ci /* FIXME: THIS ASSUMES MASTER ALL THE TIME */ 4548c2ecf20Sopenharmony_ci sfr |= I2S_SF_SCLK_MASTER; 4558c2ecf20Sopenharmony_ci 4568c2ecf20Sopenharmony_ci list_for_each_entry(cii, &i2sdev->sound.codec_list, list) { 4578c2ecf20Sopenharmony_ci int err = 0; 4588c2ecf20Sopenharmony_ci if (cii->codec->prepare) 4598c2ecf20Sopenharmony_ci err = cii->codec->prepare(cii, &bi, pi->substream); 4608c2ecf20Sopenharmony_ci if (err) { 4618c2ecf20Sopenharmony_ci result = err; 4628c2ecf20Sopenharmony_ci goto out_unlock; 4638c2ecf20Sopenharmony_ci } 4648c2ecf20Sopenharmony_ci } 4658c2ecf20Sopenharmony_ci /* codecs are fine with it, so set our clocks */ 4668c2ecf20Sopenharmony_ci if (input_16bit) 4678c2ecf20Sopenharmony_ci dws = (2 << I2S_DWS_NUM_CHANNELS_IN_SHIFT) | 4688c2ecf20Sopenharmony_ci (2 << I2S_DWS_NUM_CHANNELS_OUT_SHIFT) | 4698c2ecf20Sopenharmony_ci I2S_DWS_DATA_IN_16BIT | I2S_DWS_DATA_OUT_16BIT; 4708c2ecf20Sopenharmony_ci else 4718c2ecf20Sopenharmony_ci dws = (2 << I2S_DWS_NUM_CHANNELS_IN_SHIFT) | 4728c2ecf20Sopenharmony_ci (2 << I2S_DWS_NUM_CHANNELS_OUT_SHIFT) | 4738c2ecf20Sopenharmony_ci I2S_DWS_DATA_IN_24BIT | I2S_DWS_DATA_OUT_24BIT; 4748c2ecf20Sopenharmony_ci 4758c2ecf20Sopenharmony_ci /* early exit if already programmed correctly */ 4768c2ecf20Sopenharmony_ci /* not locking these is fine since we touch them only in this function */ 4778c2ecf20Sopenharmony_ci if (in_le32(&i2sdev->intfregs->serial_format) == sfr 4788c2ecf20Sopenharmony_ci && in_le32(&i2sdev->intfregs->data_word_sizes) == dws) 4798c2ecf20Sopenharmony_ci goto out_unlock; 4808c2ecf20Sopenharmony_ci 4818c2ecf20Sopenharmony_ci /* let's notify the codecs about clocks going away. 4828c2ecf20Sopenharmony_ci * For now we only do mastering on the i2s cell... */ 4838c2ecf20Sopenharmony_ci list_for_each_entry(cii, &i2sdev->sound.codec_list, list) 4848c2ecf20Sopenharmony_ci if (cii->codec->switch_clock) 4858c2ecf20Sopenharmony_ci cii->codec->switch_clock(cii, CLOCK_SWITCH_PREPARE_SLAVE); 4868c2ecf20Sopenharmony_ci 4878c2ecf20Sopenharmony_ci i2sbus_control_enable(i2sdev->control, i2sdev); 4888c2ecf20Sopenharmony_ci i2sbus_control_cell(i2sdev->control, i2sdev, 1); 4898c2ecf20Sopenharmony_ci 4908c2ecf20Sopenharmony_ci out_le32(&i2sdev->intfregs->intr_ctl, I2S_PENDING_CLOCKS_STOPPED); 4918c2ecf20Sopenharmony_ci 4928c2ecf20Sopenharmony_ci i2sbus_control_clock(i2sdev->control, i2sdev, 0); 4938c2ecf20Sopenharmony_ci 4948c2ecf20Sopenharmony_ci msleep(1); 4958c2ecf20Sopenharmony_ci 4968c2ecf20Sopenharmony_ci /* wait for clock stopped. This can apparently take a while... */ 4978c2ecf20Sopenharmony_ci cnt = 100; 4988c2ecf20Sopenharmony_ci while (cnt-- && 4998c2ecf20Sopenharmony_ci !(in_le32(&i2sdev->intfregs->intr_ctl) & I2S_PENDING_CLOCKS_STOPPED)) { 5008c2ecf20Sopenharmony_ci msleep(5); 5018c2ecf20Sopenharmony_ci } 5028c2ecf20Sopenharmony_ci out_le32(&i2sdev->intfregs->intr_ctl, I2S_PENDING_CLOCKS_STOPPED); 5038c2ecf20Sopenharmony_ci 5048c2ecf20Sopenharmony_ci /* not locking these is fine since we touch them only in this function */ 5058c2ecf20Sopenharmony_ci out_le32(&i2sdev->intfregs->serial_format, sfr); 5068c2ecf20Sopenharmony_ci out_le32(&i2sdev->intfregs->data_word_sizes, dws); 5078c2ecf20Sopenharmony_ci 5088c2ecf20Sopenharmony_ci i2sbus_control_enable(i2sdev->control, i2sdev); 5098c2ecf20Sopenharmony_ci i2sbus_control_cell(i2sdev->control, i2sdev, 1); 5108c2ecf20Sopenharmony_ci i2sbus_control_clock(i2sdev->control, i2sdev, 1); 5118c2ecf20Sopenharmony_ci msleep(1); 5128c2ecf20Sopenharmony_ci 5138c2ecf20Sopenharmony_ci list_for_each_entry(cii, &i2sdev->sound.codec_list, list) 5148c2ecf20Sopenharmony_ci if (cii->codec->switch_clock) 5158c2ecf20Sopenharmony_ci cii->codec->switch_clock(cii, CLOCK_SWITCH_SLAVE); 5168c2ecf20Sopenharmony_ci 5178c2ecf20Sopenharmony_ci out_unlock: 5188c2ecf20Sopenharmony_ci mutex_unlock(&i2sdev->lock); 5198c2ecf20Sopenharmony_ci return result; 5208c2ecf20Sopenharmony_ci} 5218c2ecf20Sopenharmony_ci 5228c2ecf20Sopenharmony_ci#ifdef CONFIG_PM 5238c2ecf20Sopenharmony_civoid i2sbus_pcm_prepare_both(struct i2sbus_dev *i2sdev) 5248c2ecf20Sopenharmony_ci{ 5258c2ecf20Sopenharmony_ci i2sbus_pcm_prepare(i2sdev, 0); 5268c2ecf20Sopenharmony_ci i2sbus_pcm_prepare(i2sdev, 1); 5278c2ecf20Sopenharmony_ci} 5288c2ecf20Sopenharmony_ci#endif 5298c2ecf20Sopenharmony_ci 5308c2ecf20Sopenharmony_cistatic int i2sbus_pcm_trigger(struct i2sbus_dev *i2sdev, int in, int cmd) 5318c2ecf20Sopenharmony_ci{ 5328c2ecf20Sopenharmony_ci struct codec_info_item *cii; 5338c2ecf20Sopenharmony_ci struct pcm_info *pi; 5348c2ecf20Sopenharmony_ci int result = 0; 5358c2ecf20Sopenharmony_ci unsigned long flags; 5368c2ecf20Sopenharmony_ci 5378c2ecf20Sopenharmony_ci spin_lock_irqsave(&i2sdev->low_lock, flags); 5388c2ecf20Sopenharmony_ci 5398c2ecf20Sopenharmony_ci get_pcm_info(i2sdev, in, &pi, NULL); 5408c2ecf20Sopenharmony_ci 5418c2ecf20Sopenharmony_ci switch (cmd) { 5428c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_START: 5438c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_RESUME: 5448c2ecf20Sopenharmony_ci if (pi->dbdma_ring.running) { 5458c2ecf20Sopenharmony_ci result = -EALREADY; 5468c2ecf20Sopenharmony_ci goto out_unlock; 5478c2ecf20Sopenharmony_ci } 5488c2ecf20Sopenharmony_ci list_for_each_entry(cii, &i2sdev->sound.codec_list, list) 5498c2ecf20Sopenharmony_ci if (cii->codec->start) 5508c2ecf20Sopenharmony_ci cii->codec->start(cii, pi->substream); 5518c2ecf20Sopenharmony_ci pi->dbdma_ring.running = 1; 5528c2ecf20Sopenharmony_ci 5538c2ecf20Sopenharmony_ci if (pi->dbdma_ring.stopping) { 5548c2ecf20Sopenharmony_ci /* Clear the S0 bit, then see if we stopped yet */ 5558c2ecf20Sopenharmony_ci out_le32(&pi->dbdma->control, 1 << 16); 5568c2ecf20Sopenharmony_ci if (in_le32(&pi->dbdma->status) & ACTIVE) { 5578c2ecf20Sopenharmony_ci /* possible race here? */ 5588c2ecf20Sopenharmony_ci udelay(10); 5598c2ecf20Sopenharmony_ci if (in_le32(&pi->dbdma->status) & ACTIVE) { 5608c2ecf20Sopenharmony_ci pi->dbdma_ring.stopping = 0; 5618c2ecf20Sopenharmony_ci goto out_unlock; /* keep running */ 5628c2ecf20Sopenharmony_ci } 5638c2ecf20Sopenharmony_ci } 5648c2ecf20Sopenharmony_ci } 5658c2ecf20Sopenharmony_ci 5668c2ecf20Sopenharmony_ci /* make sure RUN, PAUSE and S0 bits are cleared */ 5678c2ecf20Sopenharmony_ci out_le32(&pi->dbdma->control, (RUN | PAUSE | 1) << 16); 5688c2ecf20Sopenharmony_ci 5698c2ecf20Sopenharmony_ci /* set branch condition select register */ 5708c2ecf20Sopenharmony_ci out_le32(&pi->dbdma->br_sel, (1 << 16) | 1); 5718c2ecf20Sopenharmony_ci 5728c2ecf20Sopenharmony_ci /* write dma command buffer address to the dbdma chip */ 5738c2ecf20Sopenharmony_ci out_le32(&pi->dbdma->cmdptr, pi->dbdma_ring.bus_cmd_start); 5748c2ecf20Sopenharmony_ci 5758c2ecf20Sopenharmony_ci /* initialize the frame count and current period */ 5768c2ecf20Sopenharmony_ci pi->current_period = 0; 5778c2ecf20Sopenharmony_ci pi->frame_count = in_le32(&i2sdev->intfregs->frame_count); 5788c2ecf20Sopenharmony_ci 5798c2ecf20Sopenharmony_ci /* set the DMA controller running */ 5808c2ecf20Sopenharmony_ci out_le32(&pi->dbdma->control, (RUN << 16) | RUN); 5818c2ecf20Sopenharmony_ci 5828c2ecf20Sopenharmony_ci /* off you go! */ 5838c2ecf20Sopenharmony_ci break; 5848c2ecf20Sopenharmony_ci 5858c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_STOP: 5868c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_SUSPEND: 5878c2ecf20Sopenharmony_ci if (!pi->dbdma_ring.running) { 5888c2ecf20Sopenharmony_ci result = -EALREADY; 5898c2ecf20Sopenharmony_ci goto out_unlock; 5908c2ecf20Sopenharmony_ci } 5918c2ecf20Sopenharmony_ci pi->dbdma_ring.running = 0; 5928c2ecf20Sopenharmony_ci 5938c2ecf20Sopenharmony_ci /* Set the S0 bit to make the DMA branch to the stop cmd */ 5948c2ecf20Sopenharmony_ci out_le32(&pi->dbdma->control, (1 << 16) | 1); 5958c2ecf20Sopenharmony_ci pi->dbdma_ring.stopping = 1; 5968c2ecf20Sopenharmony_ci 5978c2ecf20Sopenharmony_ci list_for_each_entry(cii, &i2sdev->sound.codec_list, list) 5988c2ecf20Sopenharmony_ci if (cii->codec->stop) 5998c2ecf20Sopenharmony_ci cii->codec->stop(cii, pi->substream); 6008c2ecf20Sopenharmony_ci break; 6018c2ecf20Sopenharmony_ci default: 6028c2ecf20Sopenharmony_ci result = -EINVAL; 6038c2ecf20Sopenharmony_ci goto out_unlock; 6048c2ecf20Sopenharmony_ci } 6058c2ecf20Sopenharmony_ci 6068c2ecf20Sopenharmony_ci out_unlock: 6078c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&i2sdev->low_lock, flags); 6088c2ecf20Sopenharmony_ci return result; 6098c2ecf20Sopenharmony_ci} 6108c2ecf20Sopenharmony_ci 6118c2ecf20Sopenharmony_cistatic snd_pcm_uframes_t i2sbus_pcm_pointer(struct i2sbus_dev *i2sdev, int in) 6128c2ecf20Sopenharmony_ci{ 6138c2ecf20Sopenharmony_ci struct pcm_info *pi; 6148c2ecf20Sopenharmony_ci u32 fc; 6158c2ecf20Sopenharmony_ci 6168c2ecf20Sopenharmony_ci get_pcm_info(i2sdev, in, &pi, NULL); 6178c2ecf20Sopenharmony_ci 6188c2ecf20Sopenharmony_ci fc = in_le32(&i2sdev->intfregs->frame_count); 6198c2ecf20Sopenharmony_ci fc = fc - pi->frame_count; 6208c2ecf20Sopenharmony_ci 6218c2ecf20Sopenharmony_ci if (fc >= pi->substream->runtime->buffer_size) 6228c2ecf20Sopenharmony_ci fc %= pi->substream->runtime->buffer_size; 6238c2ecf20Sopenharmony_ci return fc; 6248c2ecf20Sopenharmony_ci} 6258c2ecf20Sopenharmony_ci 6268c2ecf20Sopenharmony_cistatic inline void handle_interrupt(struct i2sbus_dev *i2sdev, int in) 6278c2ecf20Sopenharmony_ci{ 6288c2ecf20Sopenharmony_ci struct pcm_info *pi; 6298c2ecf20Sopenharmony_ci u32 fc, nframes; 6308c2ecf20Sopenharmony_ci u32 status; 6318c2ecf20Sopenharmony_ci int timeout, i; 6328c2ecf20Sopenharmony_ci int dma_stopped = 0; 6338c2ecf20Sopenharmony_ci struct snd_pcm_runtime *runtime; 6348c2ecf20Sopenharmony_ci 6358c2ecf20Sopenharmony_ci spin_lock(&i2sdev->low_lock); 6368c2ecf20Sopenharmony_ci get_pcm_info(i2sdev, in, &pi, NULL); 6378c2ecf20Sopenharmony_ci if (!pi->dbdma_ring.running && !pi->dbdma_ring.stopping) 6388c2ecf20Sopenharmony_ci goto out_unlock; 6398c2ecf20Sopenharmony_ci 6408c2ecf20Sopenharmony_ci i = pi->current_period; 6418c2ecf20Sopenharmony_ci runtime = pi->substream->runtime; 6428c2ecf20Sopenharmony_ci while (pi->dbdma_ring.cmds[i].xfer_status) { 6438c2ecf20Sopenharmony_ci if (le16_to_cpu(pi->dbdma_ring.cmds[i].xfer_status) & BT) 6448c2ecf20Sopenharmony_ci /* 6458c2ecf20Sopenharmony_ci * BT is the branch taken bit. If it took a branch 6468c2ecf20Sopenharmony_ci * it is because we set the S0 bit to make it 6478c2ecf20Sopenharmony_ci * branch to the stop command. 6488c2ecf20Sopenharmony_ci */ 6498c2ecf20Sopenharmony_ci dma_stopped = 1; 6508c2ecf20Sopenharmony_ci pi->dbdma_ring.cmds[i].xfer_status = 0; 6518c2ecf20Sopenharmony_ci 6528c2ecf20Sopenharmony_ci if (++i >= runtime->periods) { 6538c2ecf20Sopenharmony_ci i = 0; 6548c2ecf20Sopenharmony_ci pi->frame_count += runtime->buffer_size; 6558c2ecf20Sopenharmony_ci } 6568c2ecf20Sopenharmony_ci pi->current_period = i; 6578c2ecf20Sopenharmony_ci 6588c2ecf20Sopenharmony_ci /* 6598c2ecf20Sopenharmony_ci * Check the frame count. The DMA tends to get a bit 6608c2ecf20Sopenharmony_ci * ahead of the frame counter, which confuses the core. 6618c2ecf20Sopenharmony_ci */ 6628c2ecf20Sopenharmony_ci fc = in_le32(&i2sdev->intfregs->frame_count); 6638c2ecf20Sopenharmony_ci nframes = i * runtime->period_size; 6648c2ecf20Sopenharmony_ci if (fc < pi->frame_count + nframes) 6658c2ecf20Sopenharmony_ci pi->frame_count = fc - nframes; 6668c2ecf20Sopenharmony_ci } 6678c2ecf20Sopenharmony_ci 6688c2ecf20Sopenharmony_ci if (dma_stopped) { 6698c2ecf20Sopenharmony_ci timeout = 1000; 6708c2ecf20Sopenharmony_ci for (;;) { 6718c2ecf20Sopenharmony_ci status = in_le32(&pi->dbdma->status); 6728c2ecf20Sopenharmony_ci if (!(status & ACTIVE) && (!in || (status & 0x80))) 6738c2ecf20Sopenharmony_ci break; 6748c2ecf20Sopenharmony_ci if (--timeout <= 0) { 6758c2ecf20Sopenharmony_ci printk(KERN_ERR "i2sbus: timed out " 6768c2ecf20Sopenharmony_ci "waiting for DMA to stop!\n"); 6778c2ecf20Sopenharmony_ci break; 6788c2ecf20Sopenharmony_ci } 6798c2ecf20Sopenharmony_ci udelay(1); 6808c2ecf20Sopenharmony_ci } 6818c2ecf20Sopenharmony_ci 6828c2ecf20Sopenharmony_ci /* Turn off DMA controller, clear S0 bit */ 6838c2ecf20Sopenharmony_ci out_le32(&pi->dbdma->control, (RUN | PAUSE | 1) << 16); 6848c2ecf20Sopenharmony_ci 6858c2ecf20Sopenharmony_ci pi->dbdma_ring.stopping = 0; 6868c2ecf20Sopenharmony_ci if (pi->stop_completion) 6878c2ecf20Sopenharmony_ci complete(pi->stop_completion); 6888c2ecf20Sopenharmony_ci } 6898c2ecf20Sopenharmony_ci 6908c2ecf20Sopenharmony_ci if (!pi->dbdma_ring.running) 6918c2ecf20Sopenharmony_ci goto out_unlock; 6928c2ecf20Sopenharmony_ci spin_unlock(&i2sdev->low_lock); 6938c2ecf20Sopenharmony_ci /* may call _trigger again, hence needs to be unlocked */ 6948c2ecf20Sopenharmony_ci snd_pcm_period_elapsed(pi->substream); 6958c2ecf20Sopenharmony_ci return; 6968c2ecf20Sopenharmony_ci 6978c2ecf20Sopenharmony_ci out_unlock: 6988c2ecf20Sopenharmony_ci spin_unlock(&i2sdev->low_lock); 6998c2ecf20Sopenharmony_ci} 7008c2ecf20Sopenharmony_ci 7018c2ecf20Sopenharmony_ciirqreturn_t i2sbus_tx_intr(int irq, void *devid) 7028c2ecf20Sopenharmony_ci{ 7038c2ecf20Sopenharmony_ci handle_interrupt((struct i2sbus_dev *)devid, 0); 7048c2ecf20Sopenharmony_ci return IRQ_HANDLED; 7058c2ecf20Sopenharmony_ci} 7068c2ecf20Sopenharmony_ci 7078c2ecf20Sopenharmony_ciirqreturn_t i2sbus_rx_intr(int irq, void *devid) 7088c2ecf20Sopenharmony_ci{ 7098c2ecf20Sopenharmony_ci handle_interrupt((struct i2sbus_dev *)devid, 1); 7108c2ecf20Sopenharmony_ci return IRQ_HANDLED; 7118c2ecf20Sopenharmony_ci} 7128c2ecf20Sopenharmony_ci 7138c2ecf20Sopenharmony_cistatic int i2sbus_playback_open(struct snd_pcm_substream *substream) 7148c2ecf20Sopenharmony_ci{ 7158c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 7168c2ecf20Sopenharmony_ci 7178c2ecf20Sopenharmony_ci if (!i2sdev) 7188c2ecf20Sopenharmony_ci return -EINVAL; 7198c2ecf20Sopenharmony_ci i2sdev->out.substream = substream; 7208c2ecf20Sopenharmony_ci return i2sbus_pcm_open(i2sdev, 0); 7218c2ecf20Sopenharmony_ci} 7228c2ecf20Sopenharmony_ci 7238c2ecf20Sopenharmony_cistatic int i2sbus_playback_close(struct snd_pcm_substream *substream) 7248c2ecf20Sopenharmony_ci{ 7258c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 7268c2ecf20Sopenharmony_ci int err; 7278c2ecf20Sopenharmony_ci 7288c2ecf20Sopenharmony_ci if (!i2sdev) 7298c2ecf20Sopenharmony_ci return -EINVAL; 7308c2ecf20Sopenharmony_ci if (i2sdev->out.substream != substream) 7318c2ecf20Sopenharmony_ci return -EINVAL; 7328c2ecf20Sopenharmony_ci err = i2sbus_pcm_close(i2sdev, 0); 7338c2ecf20Sopenharmony_ci if (!err) 7348c2ecf20Sopenharmony_ci i2sdev->out.substream = NULL; 7358c2ecf20Sopenharmony_ci return err; 7368c2ecf20Sopenharmony_ci} 7378c2ecf20Sopenharmony_ci 7388c2ecf20Sopenharmony_cistatic int i2sbus_playback_prepare(struct snd_pcm_substream *substream) 7398c2ecf20Sopenharmony_ci{ 7408c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 7418c2ecf20Sopenharmony_ci 7428c2ecf20Sopenharmony_ci if (!i2sdev) 7438c2ecf20Sopenharmony_ci return -EINVAL; 7448c2ecf20Sopenharmony_ci if (i2sdev->out.substream != substream) 7458c2ecf20Sopenharmony_ci return -EINVAL; 7468c2ecf20Sopenharmony_ci return i2sbus_pcm_prepare(i2sdev, 0); 7478c2ecf20Sopenharmony_ci} 7488c2ecf20Sopenharmony_ci 7498c2ecf20Sopenharmony_cistatic int i2sbus_playback_trigger(struct snd_pcm_substream *substream, int cmd) 7508c2ecf20Sopenharmony_ci{ 7518c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 7528c2ecf20Sopenharmony_ci 7538c2ecf20Sopenharmony_ci if (!i2sdev) 7548c2ecf20Sopenharmony_ci return -EINVAL; 7558c2ecf20Sopenharmony_ci if (i2sdev->out.substream != substream) 7568c2ecf20Sopenharmony_ci return -EINVAL; 7578c2ecf20Sopenharmony_ci return i2sbus_pcm_trigger(i2sdev, 0, cmd); 7588c2ecf20Sopenharmony_ci} 7598c2ecf20Sopenharmony_ci 7608c2ecf20Sopenharmony_cistatic snd_pcm_uframes_t i2sbus_playback_pointer(struct snd_pcm_substream 7618c2ecf20Sopenharmony_ci *substream) 7628c2ecf20Sopenharmony_ci{ 7638c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 7648c2ecf20Sopenharmony_ci 7658c2ecf20Sopenharmony_ci if (!i2sdev) 7668c2ecf20Sopenharmony_ci return -EINVAL; 7678c2ecf20Sopenharmony_ci if (i2sdev->out.substream != substream) 7688c2ecf20Sopenharmony_ci return 0; 7698c2ecf20Sopenharmony_ci return i2sbus_pcm_pointer(i2sdev, 0); 7708c2ecf20Sopenharmony_ci} 7718c2ecf20Sopenharmony_ci 7728c2ecf20Sopenharmony_cistatic const struct snd_pcm_ops i2sbus_playback_ops = { 7738c2ecf20Sopenharmony_ci .open = i2sbus_playback_open, 7748c2ecf20Sopenharmony_ci .close = i2sbus_playback_close, 7758c2ecf20Sopenharmony_ci .hw_free = i2sbus_playback_hw_free, 7768c2ecf20Sopenharmony_ci .prepare = i2sbus_playback_prepare, 7778c2ecf20Sopenharmony_ci .trigger = i2sbus_playback_trigger, 7788c2ecf20Sopenharmony_ci .pointer = i2sbus_playback_pointer, 7798c2ecf20Sopenharmony_ci}; 7808c2ecf20Sopenharmony_ci 7818c2ecf20Sopenharmony_cistatic int i2sbus_record_open(struct snd_pcm_substream *substream) 7828c2ecf20Sopenharmony_ci{ 7838c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 7848c2ecf20Sopenharmony_ci 7858c2ecf20Sopenharmony_ci if (!i2sdev) 7868c2ecf20Sopenharmony_ci return -EINVAL; 7878c2ecf20Sopenharmony_ci i2sdev->in.substream = substream; 7888c2ecf20Sopenharmony_ci return i2sbus_pcm_open(i2sdev, 1); 7898c2ecf20Sopenharmony_ci} 7908c2ecf20Sopenharmony_ci 7918c2ecf20Sopenharmony_cistatic int i2sbus_record_close(struct snd_pcm_substream *substream) 7928c2ecf20Sopenharmony_ci{ 7938c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 7948c2ecf20Sopenharmony_ci int err; 7958c2ecf20Sopenharmony_ci 7968c2ecf20Sopenharmony_ci if (!i2sdev) 7978c2ecf20Sopenharmony_ci return -EINVAL; 7988c2ecf20Sopenharmony_ci if (i2sdev->in.substream != substream) 7998c2ecf20Sopenharmony_ci return -EINVAL; 8008c2ecf20Sopenharmony_ci err = i2sbus_pcm_close(i2sdev, 1); 8018c2ecf20Sopenharmony_ci if (!err) 8028c2ecf20Sopenharmony_ci i2sdev->in.substream = NULL; 8038c2ecf20Sopenharmony_ci return err; 8048c2ecf20Sopenharmony_ci} 8058c2ecf20Sopenharmony_ci 8068c2ecf20Sopenharmony_cistatic int i2sbus_record_prepare(struct snd_pcm_substream *substream) 8078c2ecf20Sopenharmony_ci{ 8088c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 8098c2ecf20Sopenharmony_ci 8108c2ecf20Sopenharmony_ci if (!i2sdev) 8118c2ecf20Sopenharmony_ci return -EINVAL; 8128c2ecf20Sopenharmony_ci if (i2sdev->in.substream != substream) 8138c2ecf20Sopenharmony_ci return -EINVAL; 8148c2ecf20Sopenharmony_ci return i2sbus_pcm_prepare(i2sdev, 1); 8158c2ecf20Sopenharmony_ci} 8168c2ecf20Sopenharmony_ci 8178c2ecf20Sopenharmony_cistatic int i2sbus_record_trigger(struct snd_pcm_substream *substream, int cmd) 8188c2ecf20Sopenharmony_ci{ 8198c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 8208c2ecf20Sopenharmony_ci 8218c2ecf20Sopenharmony_ci if (!i2sdev) 8228c2ecf20Sopenharmony_ci return -EINVAL; 8238c2ecf20Sopenharmony_ci if (i2sdev->in.substream != substream) 8248c2ecf20Sopenharmony_ci return -EINVAL; 8258c2ecf20Sopenharmony_ci return i2sbus_pcm_trigger(i2sdev, 1, cmd); 8268c2ecf20Sopenharmony_ci} 8278c2ecf20Sopenharmony_ci 8288c2ecf20Sopenharmony_cistatic snd_pcm_uframes_t i2sbus_record_pointer(struct snd_pcm_substream 8298c2ecf20Sopenharmony_ci *substream) 8308c2ecf20Sopenharmony_ci{ 8318c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_substream_chip(substream); 8328c2ecf20Sopenharmony_ci 8338c2ecf20Sopenharmony_ci if (!i2sdev) 8348c2ecf20Sopenharmony_ci return -EINVAL; 8358c2ecf20Sopenharmony_ci if (i2sdev->in.substream != substream) 8368c2ecf20Sopenharmony_ci return 0; 8378c2ecf20Sopenharmony_ci return i2sbus_pcm_pointer(i2sdev, 1); 8388c2ecf20Sopenharmony_ci} 8398c2ecf20Sopenharmony_ci 8408c2ecf20Sopenharmony_cistatic const struct snd_pcm_ops i2sbus_record_ops = { 8418c2ecf20Sopenharmony_ci .open = i2sbus_record_open, 8428c2ecf20Sopenharmony_ci .close = i2sbus_record_close, 8438c2ecf20Sopenharmony_ci .hw_free = i2sbus_record_hw_free, 8448c2ecf20Sopenharmony_ci .prepare = i2sbus_record_prepare, 8458c2ecf20Sopenharmony_ci .trigger = i2sbus_record_trigger, 8468c2ecf20Sopenharmony_ci .pointer = i2sbus_record_pointer, 8478c2ecf20Sopenharmony_ci}; 8488c2ecf20Sopenharmony_ci 8498c2ecf20Sopenharmony_cistatic void i2sbus_private_free(struct snd_pcm *pcm) 8508c2ecf20Sopenharmony_ci{ 8518c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = snd_pcm_chip(pcm); 8528c2ecf20Sopenharmony_ci struct codec_info_item *p, *tmp; 8538c2ecf20Sopenharmony_ci 8548c2ecf20Sopenharmony_ci i2sdev->sound.pcm = NULL; 8558c2ecf20Sopenharmony_ci i2sdev->out.created = 0; 8568c2ecf20Sopenharmony_ci i2sdev->in.created = 0; 8578c2ecf20Sopenharmony_ci list_for_each_entry_safe(p, tmp, &i2sdev->sound.codec_list, list) { 8588c2ecf20Sopenharmony_ci printk(KERN_ERR "i2sbus: a codec didn't unregister!\n"); 8598c2ecf20Sopenharmony_ci list_del(&p->list); 8608c2ecf20Sopenharmony_ci module_put(p->codec->owner); 8618c2ecf20Sopenharmony_ci kfree(p); 8628c2ecf20Sopenharmony_ci } 8638c2ecf20Sopenharmony_ci soundbus_dev_put(&i2sdev->sound); 8648c2ecf20Sopenharmony_ci module_put(THIS_MODULE); 8658c2ecf20Sopenharmony_ci} 8668c2ecf20Sopenharmony_ci 8678c2ecf20Sopenharmony_ciint 8688c2ecf20Sopenharmony_cii2sbus_attach_codec(struct soundbus_dev *dev, struct snd_card *card, 8698c2ecf20Sopenharmony_ci struct codec_info *ci, void *data) 8708c2ecf20Sopenharmony_ci{ 8718c2ecf20Sopenharmony_ci int err, in = 0, out = 0; 8728c2ecf20Sopenharmony_ci struct transfer_info *tmp; 8738c2ecf20Sopenharmony_ci struct i2sbus_dev *i2sdev = soundbus_dev_to_i2sbus_dev(dev); 8748c2ecf20Sopenharmony_ci struct codec_info_item *cii; 8758c2ecf20Sopenharmony_ci 8768c2ecf20Sopenharmony_ci if (!dev->pcmname || dev->pcmid == -1) { 8778c2ecf20Sopenharmony_ci printk(KERN_ERR "i2sbus: pcm name and id must be set!\n"); 8788c2ecf20Sopenharmony_ci return -EINVAL; 8798c2ecf20Sopenharmony_ci } 8808c2ecf20Sopenharmony_ci 8818c2ecf20Sopenharmony_ci list_for_each_entry(cii, &dev->codec_list, list) { 8828c2ecf20Sopenharmony_ci if (cii->codec_data == data) 8838c2ecf20Sopenharmony_ci return -EALREADY; 8848c2ecf20Sopenharmony_ci } 8858c2ecf20Sopenharmony_ci 8868c2ecf20Sopenharmony_ci if (!ci->transfers || !ci->transfers->formats 8878c2ecf20Sopenharmony_ci || !ci->transfers->rates || !ci->usable) 8888c2ecf20Sopenharmony_ci return -EINVAL; 8898c2ecf20Sopenharmony_ci 8908c2ecf20Sopenharmony_ci /* we currently code the i2s transfer on the clock, and support only 8918c2ecf20Sopenharmony_ci * 32 and 64 */ 8928c2ecf20Sopenharmony_ci if (ci->bus_factor != 32 && ci->bus_factor != 64) 8938c2ecf20Sopenharmony_ci return -EINVAL; 8948c2ecf20Sopenharmony_ci 8958c2ecf20Sopenharmony_ci /* If you want to fix this, you need to keep track of what transport infos 8968c2ecf20Sopenharmony_ci * are to be used, which codecs they belong to, and then fix all the 8978c2ecf20Sopenharmony_ci * sysclock/busclock stuff above to depend on which is usable */ 8988c2ecf20Sopenharmony_ci list_for_each_entry(cii, &dev->codec_list, list) { 8998c2ecf20Sopenharmony_ci if (cii->codec->sysclock_factor != ci->sysclock_factor) { 9008c2ecf20Sopenharmony_ci printk(KERN_DEBUG 9018c2ecf20Sopenharmony_ci "cannot yet handle multiple different sysclocks!\n"); 9028c2ecf20Sopenharmony_ci return -EINVAL; 9038c2ecf20Sopenharmony_ci } 9048c2ecf20Sopenharmony_ci if (cii->codec->bus_factor != ci->bus_factor) { 9058c2ecf20Sopenharmony_ci printk(KERN_DEBUG 9068c2ecf20Sopenharmony_ci "cannot yet handle multiple different bus clocks!\n"); 9078c2ecf20Sopenharmony_ci return -EINVAL; 9088c2ecf20Sopenharmony_ci } 9098c2ecf20Sopenharmony_ci } 9108c2ecf20Sopenharmony_ci 9118c2ecf20Sopenharmony_ci tmp = ci->transfers; 9128c2ecf20Sopenharmony_ci while (tmp->formats && tmp->rates) { 9138c2ecf20Sopenharmony_ci if (tmp->transfer_in) 9148c2ecf20Sopenharmony_ci in = 1; 9158c2ecf20Sopenharmony_ci else 9168c2ecf20Sopenharmony_ci out = 1; 9178c2ecf20Sopenharmony_ci tmp++; 9188c2ecf20Sopenharmony_ci } 9198c2ecf20Sopenharmony_ci 9208c2ecf20Sopenharmony_ci cii = kzalloc(sizeof(struct codec_info_item), GFP_KERNEL); 9218c2ecf20Sopenharmony_ci if (!cii) { 9228c2ecf20Sopenharmony_ci printk(KERN_DEBUG "i2sbus: failed to allocate cii\n"); 9238c2ecf20Sopenharmony_ci return -ENOMEM; 9248c2ecf20Sopenharmony_ci } 9258c2ecf20Sopenharmony_ci 9268c2ecf20Sopenharmony_ci /* use the private data to point to the codec info */ 9278c2ecf20Sopenharmony_ci cii->sdev = soundbus_dev_get(dev); 9288c2ecf20Sopenharmony_ci cii->codec = ci; 9298c2ecf20Sopenharmony_ci cii->codec_data = data; 9308c2ecf20Sopenharmony_ci 9318c2ecf20Sopenharmony_ci if (!cii->sdev) { 9328c2ecf20Sopenharmony_ci printk(KERN_DEBUG 9338c2ecf20Sopenharmony_ci "i2sbus: failed to get soundbus dev reference\n"); 9348c2ecf20Sopenharmony_ci err = -ENODEV; 9358c2ecf20Sopenharmony_ci goto out_free_cii; 9368c2ecf20Sopenharmony_ci } 9378c2ecf20Sopenharmony_ci 9388c2ecf20Sopenharmony_ci if (!try_module_get(THIS_MODULE)) { 9398c2ecf20Sopenharmony_ci printk(KERN_DEBUG "i2sbus: failed to get module reference!\n"); 9408c2ecf20Sopenharmony_ci err = -EBUSY; 9418c2ecf20Sopenharmony_ci goto out_put_sdev; 9428c2ecf20Sopenharmony_ci } 9438c2ecf20Sopenharmony_ci 9448c2ecf20Sopenharmony_ci if (!try_module_get(ci->owner)) { 9458c2ecf20Sopenharmony_ci printk(KERN_DEBUG 9468c2ecf20Sopenharmony_ci "i2sbus: failed to get module reference to codec owner!\n"); 9478c2ecf20Sopenharmony_ci err = -EBUSY; 9488c2ecf20Sopenharmony_ci goto out_put_this_module; 9498c2ecf20Sopenharmony_ci } 9508c2ecf20Sopenharmony_ci 9518c2ecf20Sopenharmony_ci if (!dev->pcm) { 9528c2ecf20Sopenharmony_ci err = snd_pcm_new(card, dev->pcmname, dev->pcmid, 0, 0, 9538c2ecf20Sopenharmony_ci &dev->pcm); 9548c2ecf20Sopenharmony_ci if (err) { 9558c2ecf20Sopenharmony_ci printk(KERN_DEBUG "i2sbus: failed to create pcm\n"); 9568c2ecf20Sopenharmony_ci goto out_put_ci_module; 9578c2ecf20Sopenharmony_ci } 9588c2ecf20Sopenharmony_ci } 9598c2ecf20Sopenharmony_ci 9608c2ecf20Sopenharmony_ci /* ALSA yet again sucks. 9618c2ecf20Sopenharmony_ci * If it is ever fixed, remove this line. See below. */ 9628c2ecf20Sopenharmony_ci out = in = 1; 9638c2ecf20Sopenharmony_ci 9648c2ecf20Sopenharmony_ci if (!i2sdev->out.created && out) { 9658c2ecf20Sopenharmony_ci if (dev->pcm->card != card) { 9668c2ecf20Sopenharmony_ci /* eh? */ 9678c2ecf20Sopenharmony_ci printk(KERN_ERR 9688c2ecf20Sopenharmony_ci "Can't attach same bus to different cards!\n"); 9698c2ecf20Sopenharmony_ci err = -EINVAL; 9708c2ecf20Sopenharmony_ci goto out_put_ci_module; 9718c2ecf20Sopenharmony_ci } 9728c2ecf20Sopenharmony_ci err = snd_pcm_new_stream(dev->pcm, SNDRV_PCM_STREAM_PLAYBACK, 1); 9738c2ecf20Sopenharmony_ci if (err) 9748c2ecf20Sopenharmony_ci goto out_put_ci_module; 9758c2ecf20Sopenharmony_ci snd_pcm_set_ops(dev->pcm, SNDRV_PCM_STREAM_PLAYBACK, 9768c2ecf20Sopenharmony_ci &i2sbus_playback_ops); 9778c2ecf20Sopenharmony_ci dev->pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].dev.parent = 9788c2ecf20Sopenharmony_ci &dev->ofdev.dev; 9798c2ecf20Sopenharmony_ci i2sdev->out.created = 1; 9808c2ecf20Sopenharmony_ci } 9818c2ecf20Sopenharmony_ci 9828c2ecf20Sopenharmony_ci if (!i2sdev->in.created && in) { 9838c2ecf20Sopenharmony_ci if (dev->pcm->card != card) { 9848c2ecf20Sopenharmony_ci printk(KERN_ERR 9858c2ecf20Sopenharmony_ci "Can't attach same bus to different cards!\n"); 9868c2ecf20Sopenharmony_ci err = -EINVAL; 9878c2ecf20Sopenharmony_ci goto out_put_ci_module; 9888c2ecf20Sopenharmony_ci } 9898c2ecf20Sopenharmony_ci err = snd_pcm_new_stream(dev->pcm, SNDRV_PCM_STREAM_CAPTURE, 1); 9908c2ecf20Sopenharmony_ci if (err) 9918c2ecf20Sopenharmony_ci goto out_put_ci_module; 9928c2ecf20Sopenharmony_ci snd_pcm_set_ops(dev->pcm, SNDRV_PCM_STREAM_CAPTURE, 9938c2ecf20Sopenharmony_ci &i2sbus_record_ops); 9948c2ecf20Sopenharmony_ci dev->pcm->streams[SNDRV_PCM_STREAM_CAPTURE].dev.parent = 9958c2ecf20Sopenharmony_ci &dev->ofdev.dev; 9968c2ecf20Sopenharmony_ci i2sdev->in.created = 1; 9978c2ecf20Sopenharmony_ci } 9988c2ecf20Sopenharmony_ci 9998c2ecf20Sopenharmony_ci /* so we have to register the pcm after adding any substream 10008c2ecf20Sopenharmony_ci * to it because alsa doesn't create the devices for the 10018c2ecf20Sopenharmony_ci * substreams when we add them later. 10028c2ecf20Sopenharmony_ci * Therefore, force in and out on both busses (above) and 10038c2ecf20Sopenharmony_ci * register the pcm now instead of just after creating it. 10048c2ecf20Sopenharmony_ci */ 10058c2ecf20Sopenharmony_ci err = snd_device_register(card, dev->pcm); 10068c2ecf20Sopenharmony_ci if (err) { 10078c2ecf20Sopenharmony_ci printk(KERN_ERR "i2sbus: error registering new pcm\n"); 10088c2ecf20Sopenharmony_ci goto out_put_ci_module; 10098c2ecf20Sopenharmony_ci } 10108c2ecf20Sopenharmony_ci /* no errors any more, so let's add this to our list */ 10118c2ecf20Sopenharmony_ci list_add(&cii->list, &dev->codec_list); 10128c2ecf20Sopenharmony_ci 10138c2ecf20Sopenharmony_ci dev->pcm->private_data = i2sdev; 10148c2ecf20Sopenharmony_ci dev->pcm->private_free = i2sbus_private_free; 10158c2ecf20Sopenharmony_ci 10168c2ecf20Sopenharmony_ci /* well, we really should support scatter/gather DMA */ 10178c2ecf20Sopenharmony_ci snd_pcm_set_managed_buffer_all( 10188c2ecf20Sopenharmony_ci dev->pcm, SNDRV_DMA_TYPE_DEV, 10198c2ecf20Sopenharmony_ci &macio_get_pci_dev(i2sdev->macio)->dev, 10208c2ecf20Sopenharmony_ci 64 * 1024, 64 * 1024); 10218c2ecf20Sopenharmony_ci 10228c2ecf20Sopenharmony_ci return 0; 10238c2ecf20Sopenharmony_ci out_put_ci_module: 10248c2ecf20Sopenharmony_ci module_put(ci->owner); 10258c2ecf20Sopenharmony_ci out_put_this_module: 10268c2ecf20Sopenharmony_ci module_put(THIS_MODULE); 10278c2ecf20Sopenharmony_ci out_put_sdev: 10288c2ecf20Sopenharmony_ci soundbus_dev_put(dev); 10298c2ecf20Sopenharmony_ci out_free_cii: 10308c2ecf20Sopenharmony_ci kfree(cii); 10318c2ecf20Sopenharmony_ci return err; 10328c2ecf20Sopenharmony_ci} 10338c2ecf20Sopenharmony_ci 10348c2ecf20Sopenharmony_civoid i2sbus_detach_codec(struct soundbus_dev *dev, void *data) 10358c2ecf20Sopenharmony_ci{ 10368c2ecf20Sopenharmony_ci struct codec_info_item *cii = NULL, *i; 10378c2ecf20Sopenharmony_ci 10388c2ecf20Sopenharmony_ci list_for_each_entry(i, &dev->codec_list, list) { 10398c2ecf20Sopenharmony_ci if (i->codec_data == data) { 10408c2ecf20Sopenharmony_ci cii = i; 10418c2ecf20Sopenharmony_ci break; 10428c2ecf20Sopenharmony_ci } 10438c2ecf20Sopenharmony_ci } 10448c2ecf20Sopenharmony_ci if (cii) { 10458c2ecf20Sopenharmony_ci list_del(&cii->list); 10468c2ecf20Sopenharmony_ci module_put(cii->codec->owner); 10478c2ecf20Sopenharmony_ci kfree(cii); 10488c2ecf20Sopenharmony_ci } 10498c2ecf20Sopenharmony_ci /* no more codecs, but still a pcm? */ 10508c2ecf20Sopenharmony_ci if (list_empty(&dev->codec_list) && dev->pcm) { 10518c2ecf20Sopenharmony_ci /* the actual cleanup is done by the callback above! */ 10528c2ecf20Sopenharmony_ci snd_device_free(dev->pcm->card, dev->pcm); 10538c2ecf20Sopenharmony_ci } 10548c2ecf20Sopenharmony_ci} 1055