18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Copyright (c) by Jaroslav Kysela <perex@perex.cz> 48c2ecf20Sopenharmony_ci * Universal interface for Audio Codec '97 58c2ecf20Sopenharmony_ci * 68c2ecf20Sopenharmony_ci * For more details look to AC '97 component specification revision 2.2 78c2ecf20Sopenharmony_ci * by Intel Corporation (http://developer.intel.com) and to datasheets 88c2ecf20Sopenharmony_ci * for specific codecs. 98c2ecf20Sopenharmony_ci */ 108c2ecf20Sopenharmony_ci 118c2ecf20Sopenharmony_ci#include <linux/delay.h> 128c2ecf20Sopenharmony_ci#include <linux/init.h> 138c2ecf20Sopenharmony_ci#include <linux/slab.h> 148c2ecf20Sopenharmony_ci#include <linux/mutex.h> 158c2ecf20Sopenharmony_ci#include <linux/export.h> 168c2ecf20Sopenharmony_ci 178c2ecf20Sopenharmony_ci#include <sound/core.h> 188c2ecf20Sopenharmony_ci#include <sound/pcm.h> 198c2ecf20Sopenharmony_ci#include <sound/control.h> 208c2ecf20Sopenharmony_ci#include <sound/ac97_codec.h> 218c2ecf20Sopenharmony_ci#include <sound/asoundef.h> 228c2ecf20Sopenharmony_ci#include "ac97_id.h" 238c2ecf20Sopenharmony_ci#include "ac97_local.h" 248c2ecf20Sopenharmony_ci 258c2ecf20Sopenharmony_ci/* 268c2ecf20Sopenharmony_ci * PCM support 278c2ecf20Sopenharmony_ci */ 288c2ecf20Sopenharmony_ci 298c2ecf20Sopenharmony_cistatic const unsigned char rate_reg_tables[2][4][9] = { 308c2ecf20Sopenharmony_ci{ 318c2ecf20Sopenharmony_ci /* standard rates */ 328c2ecf20Sopenharmony_ci { 338c2ecf20Sopenharmony_ci /* 3&4 front, 7&8 rear, 6&9 center/lfe */ 348c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 3 */ 358c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 4 */ 368c2ecf20Sopenharmony_ci 0xff, /* slot 5 */ 378c2ecf20Sopenharmony_ci AC97_PCM_LFE_DAC_RATE, /* slot 6 */ 388c2ecf20Sopenharmony_ci AC97_PCM_SURR_DAC_RATE, /* slot 7 */ 398c2ecf20Sopenharmony_ci AC97_PCM_SURR_DAC_RATE, /* slot 8 */ 408c2ecf20Sopenharmony_ci AC97_PCM_LFE_DAC_RATE, /* slot 9 */ 418c2ecf20Sopenharmony_ci 0xff, /* slot 10 */ 428c2ecf20Sopenharmony_ci 0xff, /* slot 11 */ 438c2ecf20Sopenharmony_ci }, 448c2ecf20Sopenharmony_ci { 458c2ecf20Sopenharmony_ci /* 7&8 front, 6&9 rear, 10&11 center/lfe */ 468c2ecf20Sopenharmony_ci 0xff, /* slot 3 */ 478c2ecf20Sopenharmony_ci 0xff, /* slot 4 */ 488c2ecf20Sopenharmony_ci 0xff, /* slot 5 */ 498c2ecf20Sopenharmony_ci AC97_PCM_SURR_DAC_RATE, /* slot 6 */ 508c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 7 */ 518c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 8 */ 528c2ecf20Sopenharmony_ci AC97_PCM_SURR_DAC_RATE, /* slot 9 */ 538c2ecf20Sopenharmony_ci AC97_PCM_LFE_DAC_RATE, /* slot 10 */ 548c2ecf20Sopenharmony_ci AC97_PCM_LFE_DAC_RATE, /* slot 11 */ 558c2ecf20Sopenharmony_ci }, 568c2ecf20Sopenharmony_ci { 578c2ecf20Sopenharmony_ci /* 6&9 front, 10&11 rear, 3&4 center/lfe */ 588c2ecf20Sopenharmony_ci AC97_PCM_LFE_DAC_RATE, /* slot 3 */ 598c2ecf20Sopenharmony_ci AC97_PCM_LFE_DAC_RATE, /* slot 4 */ 608c2ecf20Sopenharmony_ci 0xff, /* slot 5 */ 618c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 6 */ 628c2ecf20Sopenharmony_ci 0xff, /* slot 7 */ 638c2ecf20Sopenharmony_ci 0xff, /* slot 8 */ 648c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 9 */ 658c2ecf20Sopenharmony_ci AC97_PCM_SURR_DAC_RATE, /* slot 10 */ 668c2ecf20Sopenharmony_ci AC97_PCM_SURR_DAC_RATE, /* slot 11 */ 678c2ecf20Sopenharmony_ci }, 688c2ecf20Sopenharmony_ci { 698c2ecf20Sopenharmony_ci /* 10&11 front, 3&4 rear, 7&8 center/lfe */ 708c2ecf20Sopenharmony_ci AC97_PCM_SURR_DAC_RATE, /* slot 3 */ 718c2ecf20Sopenharmony_ci AC97_PCM_SURR_DAC_RATE, /* slot 4 */ 728c2ecf20Sopenharmony_ci 0xff, /* slot 5 */ 738c2ecf20Sopenharmony_ci 0xff, /* slot 6 */ 748c2ecf20Sopenharmony_ci AC97_PCM_LFE_DAC_RATE, /* slot 7 */ 758c2ecf20Sopenharmony_ci AC97_PCM_LFE_DAC_RATE, /* slot 8 */ 768c2ecf20Sopenharmony_ci 0xff, /* slot 9 */ 778c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 10 */ 788c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 11 */ 798c2ecf20Sopenharmony_ci }, 808c2ecf20Sopenharmony_ci}, 818c2ecf20Sopenharmony_ci{ 828c2ecf20Sopenharmony_ci /* double rates */ 838c2ecf20Sopenharmony_ci { 848c2ecf20Sopenharmony_ci /* 3&4 front, 7&8 front (t+1) */ 858c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 3 */ 868c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 4 */ 878c2ecf20Sopenharmony_ci 0xff, /* slot 5 */ 888c2ecf20Sopenharmony_ci 0xff, /* slot 6 */ 898c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 7 */ 908c2ecf20Sopenharmony_ci AC97_PCM_FRONT_DAC_RATE, /* slot 8 */ 918c2ecf20Sopenharmony_ci 0xff, /* slot 9 */ 928c2ecf20Sopenharmony_ci 0xff, /* slot 10 */ 938c2ecf20Sopenharmony_ci 0xff, /* slot 11 */ 948c2ecf20Sopenharmony_ci }, 958c2ecf20Sopenharmony_ci { 968c2ecf20Sopenharmony_ci /* not specified in the specification */ 978c2ecf20Sopenharmony_ci 0xff, /* slot 3 */ 988c2ecf20Sopenharmony_ci 0xff, /* slot 4 */ 998c2ecf20Sopenharmony_ci 0xff, /* slot 5 */ 1008c2ecf20Sopenharmony_ci 0xff, /* slot 6 */ 1018c2ecf20Sopenharmony_ci 0xff, /* slot 7 */ 1028c2ecf20Sopenharmony_ci 0xff, /* slot 8 */ 1038c2ecf20Sopenharmony_ci 0xff, /* slot 9 */ 1048c2ecf20Sopenharmony_ci 0xff, /* slot 10 */ 1058c2ecf20Sopenharmony_ci 0xff, /* slot 11 */ 1068c2ecf20Sopenharmony_ci }, 1078c2ecf20Sopenharmony_ci { 1088c2ecf20Sopenharmony_ci 0xff, /* slot 3 */ 1098c2ecf20Sopenharmony_ci 0xff, /* slot 4 */ 1108c2ecf20Sopenharmony_ci 0xff, /* slot 5 */ 1118c2ecf20Sopenharmony_ci 0xff, /* slot 6 */ 1128c2ecf20Sopenharmony_ci 0xff, /* slot 7 */ 1138c2ecf20Sopenharmony_ci 0xff, /* slot 8 */ 1148c2ecf20Sopenharmony_ci 0xff, /* slot 9 */ 1158c2ecf20Sopenharmony_ci 0xff, /* slot 10 */ 1168c2ecf20Sopenharmony_ci 0xff, /* slot 11 */ 1178c2ecf20Sopenharmony_ci }, 1188c2ecf20Sopenharmony_ci { 1198c2ecf20Sopenharmony_ci 0xff, /* slot 3 */ 1208c2ecf20Sopenharmony_ci 0xff, /* slot 4 */ 1218c2ecf20Sopenharmony_ci 0xff, /* slot 5 */ 1228c2ecf20Sopenharmony_ci 0xff, /* slot 6 */ 1238c2ecf20Sopenharmony_ci 0xff, /* slot 7 */ 1248c2ecf20Sopenharmony_ci 0xff, /* slot 8 */ 1258c2ecf20Sopenharmony_ci 0xff, /* slot 9 */ 1268c2ecf20Sopenharmony_ci 0xff, /* slot 10 */ 1278c2ecf20Sopenharmony_ci 0xff, /* slot 11 */ 1288c2ecf20Sopenharmony_ci } 1298c2ecf20Sopenharmony_ci}}; 1308c2ecf20Sopenharmony_ci 1318c2ecf20Sopenharmony_ci/* FIXME: more various mappings for ADC? */ 1328c2ecf20Sopenharmony_cistatic const unsigned char rate_cregs[9] = { 1338c2ecf20Sopenharmony_ci AC97_PCM_LR_ADC_RATE, /* 3 */ 1348c2ecf20Sopenharmony_ci AC97_PCM_LR_ADC_RATE, /* 4 */ 1358c2ecf20Sopenharmony_ci 0xff, /* 5 */ 1368c2ecf20Sopenharmony_ci AC97_PCM_MIC_ADC_RATE, /* 6 */ 1378c2ecf20Sopenharmony_ci 0xff, /* 7 */ 1388c2ecf20Sopenharmony_ci 0xff, /* 8 */ 1398c2ecf20Sopenharmony_ci 0xff, /* 9 */ 1408c2ecf20Sopenharmony_ci 0xff, /* 10 */ 1418c2ecf20Sopenharmony_ci 0xff, /* 11 */ 1428c2ecf20Sopenharmony_ci}; 1438c2ecf20Sopenharmony_ci 1448c2ecf20Sopenharmony_cistatic unsigned char get_slot_reg(struct ac97_pcm *pcm, unsigned short cidx, 1458c2ecf20Sopenharmony_ci unsigned short slot, int dbl) 1468c2ecf20Sopenharmony_ci{ 1478c2ecf20Sopenharmony_ci if (slot < 3) 1488c2ecf20Sopenharmony_ci return 0xff; 1498c2ecf20Sopenharmony_ci if (slot > 11) 1508c2ecf20Sopenharmony_ci return 0xff; 1518c2ecf20Sopenharmony_ci if (pcm->spdif) 1528c2ecf20Sopenharmony_ci return AC97_SPDIF; /* pseudo register */ 1538c2ecf20Sopenharmony_ci if (pcm->stream == SNDRV_PCM_STREAM_PLAYBACK) 1548c2ecf20Sopenharmony_ci return rate_reg_tables[dbl][pcm->r[dbl].rate_table[cidx]][slot - 3]; 1558c2ecf20Sopenharmony_ci else 1568c2ecf20Sopenharmony_ci return rate_cregs[slot - 3]; 1578c2ecf20Sopenharmony_ci} 1588c2ecf20Sopenharmony_ci 1598c2ecf20Sopenharmony_cistatic int set_spdif_rate(struct snd_ac97 *ac97, unsigned short rate) 1608c2ecf20Sopenharmony_ci{ 1618c2ecf20Sopenharmony_ci unsigned short old, bits, reg, mask; 1628c2ecf20Sopenharmony_ci unsigned int sbits; 1638c2ecf20Sopenharmony_ci 1648c2ecf20Sopenharmony_ci if (! (ac97->ext_id & AC97_EI_SPDIF)) 1658c2ecf20Sopenharmony_ci return -ENODEV; 1668c2ecf20Sopenharmony_ci 1678c2ecf20Sopenharmony_ci /* TODO: double rate support */ 1688c2ecf20Sopenharmony_ci if (ac97->flags & AC97_CS_SPDIF) { 1698c2ecf20Sopenharmony_ci switch (rate) { 1708c2ecf20Sopenharmony_ci case 48000: bits = 0; break; 1718c2ecf20Sopenharmony_ci case 44100: bits = 1 << AC97_SC_SPSR_SHIFT; break; 1728c2ecf20Sopenharmony_ci default: /* invalid - disable output */ 1738c2ecf20Sopenharmony_ci snd_ac97_update_bits(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, 0); 1748c2ecf20Sopenharmony_ci return -EINVAL; 1758c2ecf20Sopenharmony_ci } 1768c2ecf20Sopenharmony_ci reg = AC97_CSR_SPDIF; 1778c2ecf20Sopenharmony_ci mask = 1 << AC97_SC_SPSR_SHIFT; 1788c2ecf20Sopenharmony_ci } else { 1798c2ecf20Sopenharmony_ci if (ac97->id == AC97_ID_CM9739 && rate != 48000) { 1808c2ecf20Sopenharmony_ci snd_ac97_update_bits(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, 0); 1818c2ecf20Sopenharmony_ci return -EINVAL; 1828c2ecf20Sopenharmony_ci } 1838c2ecf20Sopenharmony_ci switch (rate) { 1848c2ecf20Sopenharmony_ci case 44100: bits = AC97_SC_SPSR_44K; break; 1858c2ecf20Sopenharmony_ci case 48000: bits = AC97_SC_SPSR_48K; break; 1868c2ecf20Sopenharmony_ci case 32000: bits = AC97_SC_SPSR_32K; break; 1878c2ecf20Sopenharmony_ci default: /* invalid - disable output */ 1888c2ecf20Sopenharmony_ci snd_ac97_update_bits(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, 0); 1898c2ecf20Sopenharmony_ci return -EINVAL; 1908c2ecf20Sopenharmony_ci } 1918c2ecf20Sopenharmony_ci reg = AC97_SPDIF; 1928c2ecf20Sopenharmony_ci mask = AC97_SC_SPSR_MASK; 1938c2ecf20Sopenharmony_ci } 1948c2ecf20Sopenharmony_ci 1958c2ecf20Sopenharmony_ci mutex_lock(&ac97->reg_mutex); 1968c2ecf20Sopenharmony_ci old = snd_ac97_read(ac97, reg) & mask; 1978c2ecf20Sopenharmony_ci if (old != bits) { 1988c2ecf20Sopenharmony_ci snd_ac97_update_bits_nolock(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, 0); 1998c2ecf20Sopenharmony_ci snd_ac97_update_bits_nolock(ac97, reg, mask, bits); 2008c2ecf20Sopenharmony_ci /* update the internal spdif bits */ 2018c2ecf20Sopenharmony_ci sbits = ac97->spdif_status; 2028c2ecf20Sopenharmony_ci if (sbits & IEC958_AES0_PROFESSIONAL) { 2038c2ecf20Sopenharmony_ci sbits &= ~IEC958_AES0_PRO_FS; 2048c2ecf20Sopenharmony_ci switch (rate) { 2058c2ecf20Sopenharmony_ci case 44100: sbits |= IEC958_AES0_PRO_FS_44100; break; 2068c2ecf20Sopenharmony_ci case 48000: sbits |= IEC958_AES0_PRO_FS_48000; break; 2078c2ecf20Sopenharmony_ci case 32000: sbits |= IEC958_AES0_PRO_FS_32000; break; 2088c2ecf20Sopenharmony_ci } 2098c2ecf20Sopenharmony_ci } else { 2108c2ecf20Sopenharmony_ci sbits &= ~(IEC958_AES3_CON_FS << 24); 2118c2ecf20Sopenharmony_ci switch (rate) { 2128c2ecf20Sopenharmony_ci case 44100: sbits |= IEC958_AES3_CON_FS_44100<<24; break; 2138c2ecf20Sopenharmony_ci case 48000: sbits |= IEC958_AES3_CON_FS_48000<<24; break; 2148c2ecf20Sopenharmony_ci case 32000: sbits |= IEC958_AES3_CON_FS_32000<<24; break; 2158c2ecf20Sopenharmony_ci } 2168c2ecf20Sopenharmony_ci } 2178c2ecf20Sopenharmony_ci ac97->spdif_status = sbits; 2188c2ecf20Sopenharmony_ci } 2198c2ecf20Sopenharmony_ci snd_ac97_update_bits_nolock(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, AC97_EA_SPDIF); 2208c2ecf20Sopenharmony_ci mutex_unlock(&ac97->reg_mutex); 2218c2ecf20Sopenharmony_ci return 0; 2228c2ecf20Sopenharmony_ci} 2238c2ecf20Sopenharmony_ci 2248c2ecf20Sopenharmony_ci/** 2258c2ecf20Sopenharmony_ci * snd_ac97_set_rate - change the rate of the given input/output. 2268c2ecf20Sopenharmony_ci * @ac97: the ac97 instance 2278c2ecf20Sopenharmony_ci * @reg: the register to change 2288c2ecf20Sopenharmony_ci * @rate: the sample rate to set 2298c2ecf20Sopenharmony_ci * 2308c2ecf20Sopenharmony_ci * Changes the rate of the given input/output on the codec. 2318c2ecf20Sopenharmony_ci * If the codec doesn't support VAR, the rate must be 48000 (except 2328c2ecf20Sopenharmony_ci * for SPDIF). 2338c2ecf20Sopenharmony_ci * 2348c2ecf20Sopenharmony_ci * The valid registers are AC97_PMC_MIC_ADC_RATE, 2358c2ecf20Sopenharmony_ci * AC97_PCM_FRONT_DAC_RATE, AC97_PCM_LR_ADC_RATE. 2368c2ecf20Sopenharmony_ci * AC97_PCM_SURR_DAC_RATE and AC97_PCM_LFE_DAC_RATE are accepted 2378c2ecf20Sopenharmony_ci * if the codec supports them. 2388c2ecf20Sopenharmony_ci * AC97_SPDIF is accepted as a pseudo register to modify the SPDIF 2398c2ecf20Sopenharmony_ci * status bits. 2408c2ecf20Sopenharmony_ci * 2418c2ecf20Sopenharmony_ci * Return: Zero if successful, or a negative error code on failure. 2428c2ecf20Sopenharmony_ci */ 2438c2ecf20Sopenharmony_ciint snd_ac97_set_rate(struct snd_ac97 *ac97, int reg, unsigned int rate) 2448c2ecf20Sopenharmony_ci{ 2458c2ecf20Sopenharmony_ci int dbl; 2468c2ecf20Sopenharmony_ci unsigned int tmp; 2478c2ecf20Sopenharmony_ci 2488c2ecf20Sopenharmony_ci dbl = rate > 48000; 2498c2ecf20Sopenharmony_ci if (dbl) { 2508c2ecf20Sopenharmony_ci if (!(ac97->flags & AC97_DOUBLE_RATE)) 2518c2ecf20Sopenharmony_ci return -EINVAL; 2528c2ecf20Sopenharmony_ci if (reg != AC97_PCM_FRONT_DAC_RATE) 2538c2ecf20Sopenharmony_ci return -EINVAL; 2548c2ecf20Sopenharmony_ci } 2558c2ecf20Sopenharmony_ci 2568c2ecf20Sopenharmony_ci snd_ac97_update_power(ac97, reg, 1); 2578c2ecf20Sopenharmony_ci switch (reg) { 2588c2ecf20Sopenharmony_ci case AC97_PCM_MIC_ADC_RATE: 2598c2ecf20Sopenharmony_ci if ((ac97->regs[AC97_EXTENDED_STATUS] & AC97_EA_VRM) == 0) /* MIC VRA */ 2608c2ecf20Sopenharmony_ci if (rate != 48000) 2618c2ecf20Sopenharmony_ci return -EINVAL; 2628c2ecf20Sopenharmony_ci break; 2638c2ecf20Sopenharmony_ci case AC97_PCM_FRONT_DAC_RATE: 2648c2ecf20Sopenharmony_ci case AC97_PCM_LR_ADC_RATE: 2658c2ecf20Sopenharmony_ci if ((ac97->regs[AC97_EXTENDED_STATUS] & AC97_EA_VRA) == 0) /* VRA */ 2668c2ecf20Sopenharmony_ci if (rate != 48000 && rate != 96000) 2678c2ecf20Sopenharmony_ci return -EINVAL; 2688c2ecf20Sopenharmony_ci break; 2698c2ecf20Sopenharmony_ci case AC97_PCM_SURR_DAC_RATE: 2708c2ecf20Sopenharmony_ci if (! (ac97->scaps & AC97_SCAP_SURROUND_DAC)) 2718c2ecf20Sopenharmony_ci return -EINVAL; 2728c2ecf20Sopenharmony_ci break; 2738c2ecf20Sopenharmony_ci case AC97_PCM_LFE_DAC_RATE: 2748c2ecf20Sopenharmony_ci if (! (ac97->scaps & AC97_SCAP_CENTER_LFE_DAC)) 2758c2ecf20Sopenharmony_ci return -EINVAL; 2768c2ecf20Sopenharmony_ci break; 2778c2ecf20Sopenharmony_ci case AC97_SPDIF: 2788c2ecf20Sopenharmony_ci /* special case */ 2798c2ecf20Sopenharmony_ci return set_spdif_rate(ac97, rate); 2808c2ecf20Sopenharmony_ci default: 2818c2ecf20Sopenharmony_ci return -EINVAL; 2828c2ecf20Sopenharmony_ci } 2838c2ecf20Sopenharmony_ci if (dbl) 2848c2ecf20Sopenharmony_ci rate /= 2; 2858c2ecf20Sopenharmony_ci tmp = (rate * ac97->bus->clock) / 48000; 2868c2ecf20Sopenharmony_ci if (tmp > 65535) 2878c2ecf20Sopenharmony_ci return -EINVAL; 2888c2ecf20Sopenharmony_ci if ((ac97->ext_id & AC97_EI_DRA) && reg == AC97_PCM_FRONT_DAC_RATE) 2898c2ecf20Sopenharmony_ci snd_ac97_update_bits(ac97, AC97_EXTENDED_STATUS, 2908c2ecf20Sopenharmony_ci AC97_EA_DRA, dbl ? AC97_EA_DRA : 0); 2918c2ecf20Sopenharmony_ci snd_ac97_update(ac97, reg, tmp & 0xffff); 2928c2ecf20Sopenharmony_ci snd_ac97_read(ac97, reg); 2938c2ecf20Sopenharmony_ci if ((ac97->ext_id & AC97_EI_DRA) && reg == AC97_PCM_FRONT_DAC_RATE) { 2948c2ecf20Sopenharmony_ci /* Intel controllers require double rate data to be put in 2958c2ecf20Sopenharmony_ci * slots 7+8 2968c2ecf20Sopenharmony_ci */ 2978c2ecf20Sopenharmony_ci snd_ac97_update_bits(ac97, AC97_GENERAL_PURPOSE, 2988c2ecf20Sopenharmony_ci AC97_GP_DRSS_MASK, 2998c2ecf20Sopenharmony_ci dbl ? AC97_GP_DRSS_78 : 0); 3008c2ecf20Sopenharmony_ci snd_ac97_read(ac97, AC97_GENERAL_PURPOSE); 3018c2ecf20Sopenharmony_ci } 3028c2ecf20Sopenharmony_ci return 0; 3038c2ecf20Sopenharmony_ci} 3048c2ecf20Sopenharmony_ci 3058c2ecf20Sopenharmony_ciEXPORT_SYMBOL(snd_ac97_set_rate); 3068c2ecf20Sopenharmony_ci 3078c2ecf20Sopenharmony_cistatic unsigned short get_pslots(struct snd_ac97 *ac97, unsigned char *rate_table, unsigned short *spdif_slots) 3088c2ecf20Sopenharmony_ci{ 3098c2ecf20Sopenharmony_ci if (!ac97_is_audio(ac97)) 3108c2ecf20Sopenharmony_ci return 0; 3118c2ecf20Sopenharmony_ci if (ac97_is_rev22(ac97) || ac97_can_amap(ac97)) { 3128c2ecf20Sopenharmony_ci unsigned short slots = 0; 3138c2ecf20Sopenharmony_ci if (ac97_is_rev22(ac97)) { 3148c2ecf20Sopenharmony_ci /* Note: it's simply emulation of AMAP behaviour */ 3158c2ecf20Sopenharmony_ci u16 es; 3168c2ecf20Sopenharmony_ci es = ac97->regs[AC97_EXTENDED_ID] &= ~AC97_EI_DACS_SLOT_MASK; 3178c2ecf20Sopenharmony_ci switch (ac97->addr) { 3188c2ecf20Sopenharmony_ci case 1: 3198c2ecf20Sopenharmony_ci case 2: es |= (1<<AC97_EI_DACS_SLOT_SHIFT); break; 3208c2ecf20Sopenharmony_ci case 3: es |= (2<<AC97_EI_DACS_SLOT_SHIFT); break; 3218c2ecf20Sopenharmony_ci } 3228c2ecf20Sopenharmony_ci snd_ac97_write_cache(ac97, AC97_EXTENDED_ID, es); 3238c2ecf20Sopenharmony_ci } 3248c2ecf20Sopenharmony_ci switch (ac97->addr) { 3258c2ecf20Sopenharmony_ci case 0: 3268c2ecf20Sopenharmony_ci slots |= (1<<AC97_SLOT_PCM_LEFT)|(1<<AC97_SLOT_PCM_RIGHT); 3278c2ecf20Sopenharmony_ci if (ac97->scaps & AC97_SCAP_SURROUND_DAC) 3288c2ecf20Sopenharmony_ci slots |= (1<<AC97_SLOT_PCM_SLEFT)|(1<<AC97_SLOT_PCM_SRIGHT); 3298c2ecf20Sopenharmony_ci if (ac97->scaps & AC97_SCAP_CENTER_LFE_DAC) 3308c2ecf20Sopenharmony_ci slots |= (1<<AC97_SLOT_PCM_CENTER)|(1<<AC97_SLOT_LFE); 3318c2ecf20Sopenharmony_ci if (ac97->ext_id & AC97_EI_SPDIF) { 3328c2ecf20Sopenharmony_ci if (!(ac97->scaps & AC97_SCAP_SURROUND_DAC)) 3338c2ecf20Sopenharmony_ci *spdif_slots = (1<<AC97_SLOT_SPDIF_LEFT)|(1<<AC97_SLOT_SPDIF_RIGHT); 3348c2ecf20Sopenharmony_ci else if (!(ac97->scaps & AC97_SCAP_CENTER_LFE_DAC)) 3358c2ecf20Sopenharmony_ci *spdif_slots = (1<<AC97_SLOT_SPDIF_LEFT1)|(1<<AC97_SLOT_SPDIF_RIGHT1); 3368c2ecf20Sopenharmony_ci else 3378c2ecf20Sopenharmony_ci *spdif_slots = (1<<AC97_SLOT_SPDIF_LEFT2)|(1<<AC97_SLOT_SPDIF_RIGHT2); 3388c2ecf20Sopenharmony_ci } 3398c2ecf20Sopenharmony_ci *rate_table = 0; 3408c2ecf20Sopenharmony_ci break; 3418c2ecf20Sopenharmony_ci case 1: 3428c2ecf20Sopenharmony_ci case 2: 3438c2ecf20Sopenharmony_ci slots |= (1<<AC97_SLOT_PCM_SLEFT)|(1<<AC97_SLOT_PCM_SRIGHT); 3448c2ecf20Sopenharmony_ci if (ac97->scaps & AC97_SCAP_SURROUND_DAC) 3458c2ecf20Sopenharmony_ci slots |= (1<<AC97_SLOT_PCM_CENTER)|(1<<AC97_SLOT_LFE); 3468c2ecf20Sopenharmony_ci if (ac97->ext_id & AC97_EI_SPDIF) { 3478c2ecf20Sopenharmony_ci if (!(ac97->scaps & AC97_SCAP_SURROUND_DAC)) 3488c2ecf20Sopenharmony_ci *spdif_slots = (1<<AC97_SLOT_SPDIF_LEFT1)|(1<<AC97_SLOT_SPDIF_RIGHT1); 3498c2ecf20Sopenharmony_ci else 3508c2ecf20Sopenharmony_ci *spdif_slots = (1<<AC97_SLOT_SPDIF_LEFT2)|(1<<AC97_SLOT_SPDIF_RIGHT2); 3518c2ecf20Sopenharmony_ci } 3528c2ecf20Sopenharmony_ci *rate_table = 1; 3538c2ecf20Sopenharmony_ci break; 3548c2ecf20Sopenharmony_ci case 3: 3558c2ecf20Sopenharmony_ci slots |= (1<<AC97_SLOT_PCM_CENTER)|(1<<AC97_SLOT_LFE); 3568c2ecf20Sopenharmony_ci if (ac97->ext_id & AC97_EI_SPDIF) 3578c2ecf20Sopenharmony_ci *spdif_slots = (1<<AC97_SLOT_SPDIF_LEFT2)|(1<<AC97_SLOT_SPDIF_RIGHT2); 3588c2ecf20Sopenharmony_ci *rate_table = 2; 3598c2ecf20Sopenharmony_ci break; 3608c2ecf20Sopenharmony_ci } 3618c2ecf20Sopenharmony_ci return slots; 3628c2ecf20Sopenharmony_ci } else { 3638c2ecf20Sopenharmony_ci unsigned short slots; 3648c2ecf20Sopenharmony_ci slots = (1<<AC97_SLOT_PCM_LEFT)|(1<<AC97_SLOT_PCM_RIGHT); 3658c2ecf20Sopenharmony_ci if (ac97->scaps & AC97_SCAP_SURROUND_DAC) 3668c2ecf20Sopenharmony_ci slots |= (1<<AC97_SLOT_PCM_SLEFT)|(1<<AC97_SLOT_PCM_SRIGHT); 3678c2ecf20Sopenharmony_ci if (ac97->scaps & AC97_SCAP_CENTER_LFE_DAC) 3688c2ecf20Sopenharmony_ci slots |= (1<<AC97_SLOT_PCM_CENTER)|(1<<AC97_SLOT_LFE); 3698c2ecf20Sopenharmony_ci if (ac97->ext_id & AC97_EI_SPDIF) { 3708c2ecf20Sopenharmony_ci if (!(ac97->scaps & AC97_SCAP_SURROUND_DAC)) 3718c2ecf20Sopenharmony_ci *spdif_slots = (1<<AC97_SLOT_SPDIF_LEFT)|(1<<AC97_SLOT_SPDIF_RIGHT); 3728c2ecf20Sopenharmony_ci else if (!(ac97->scaps & AC97_SCAP_CENTER_LFE_DAC)) 3738c2ecf20Sopenharmony_ci *spdif_slots = (1<<AC97_SLOT_SPDIF_LEFT1)|(1<<AC97_SLOT_SPDIF_RIGHT1); 3748c2ecf20Sopenharmony_ci else 3758c2ecf20Sopenharmony_ci *spdif_slots = (1<<AC97_SLOT_SPDIF_LEFT2)|(1<<AC97_SLOT_SPDIF_RIGHT2); 3768c2ecf20Sopenharmony_ci } 3778c2ecf20Sopenharmony_ci *rate_table = 0; 3788c2ecf20Sopenharmony_ci return slots; 3798c2ecf20Sopenharmony_ci } 3808c2ecf20Sopenharmony_ci} 3818c2ecf20Sopenharmony_ci 3828c2ecf20Sopenharmony_cistatic unsigned short get_cslots(struct snd_ac97 *ac97) 3838c2ecf20Sopenharmony_ci{ 3848c2ecf20Sopenharmony_ci unsigned short slots; 3858c2ecf20Sopenharmony_ci 3868c2ecf20Sopenharmony_ci if (!ac97_is_audio(ac97)) 3878c2ecf20Sopenharmony_ci return 0; 3888c2ecf20Sopenharmony_ci slots = (1<<AC97_SLOT_PCM_LEFT)|(1<<AC97_SLOT_PCM_RIGHT); 3898c2ecf20Sopenharmony_ci slots |= (1<<AC97_SLOT_MIC); 3908c2ecf20Sopenharmony_ci return slots; 3918c2ecf20Sopenharmony_ci} 3928c2ecf20Sopenharmony_ci 3938c2ecf20Sopenharmony_cistatic unsigned int get_rates(struct ac97_pcm *pcm, unsigned int cidx, unsigned short slots, int dbl) 3948c2ecf20Sopenharmony_ci{ 3958c2ecf20Sopenharmony_ci int i, idx; 3968c2ecf20Sopenharmony_ci unsigned int rates = ~0; 3978c2ecf20Sopenharmony_ci unsigned char reg; 3988c2ecf20Sopenharmony_ci 3998c2ecf20Sopenharmony_ci for (i = 3; i < 12; i++) { 4008c2ecf20Sopenharmony_ci if (!(slots & (1 << i))) 4018c2ecf20Sopenharmony_ci continue; 4028c2ecf20Sopenharmony_ci reg = get_slot_reg(pcm, cidx, i, dbl); 4038c2ecf20Sopenharmony_ci switch (reg) { 4048c2ecf20Sopenharmony_ci case AC97_PCM_FRONT_DAC_RATE: idx = AC97_RATES_FRONT_DAC; break; 4058c2ecf20Sopenharmony_ci case AC97_PCM_SURR_DAC_RATE: idx = AC97_RATES_SURR_DAC; break; 4068c2ecf20Sopenharmony_ci case AC97_PCM_LFE_DAC_RATE: idx = AC97_RATES_LFE_DAC; break; 4078c2ecf20Sopenharmony_ci case AC97_PCM_LR_ADC_RATE: idx = AC97_RATES_ADC; break; 4088c2ecf20Sopenharmony_ci case AC97_PCM_MIC_ADC_RATE: idx = AC97_RATES_MIC_ADC; break; 4098c2ecf20Sopenharmony_ci default: idx = AC97_RATES_SPDIF; break; 4108c2ecf20Sopenharmony_ci } 4118c2ecf20Sopenharmony_ci rates &= pcm->r[dbl].codec[cidx]->rates[idx]; 4128c2ecf20Sopenharmony_ci } 4138c2ecf20Sopenharmony_ci if (!dbl) 4148c2ecf20Sopenharmony_ci rates &= ~(SNDRV_PCM_RATE_64000 | SNDRV_PCM_RATE_88200 | 4158c2ecf20Sopenharmony_ci SNDRV_PCM_RATE_96000); 4168c2ecf20Sopenharmony_ci return rates; 4178c2ecf20Sopenharmony_ci} 4188c2ecf20Sopenharmony_ci 4198c2ecf20Sopenharmony_ci/** 4208c2ecf20Sopenharmony_ci * snd_ac97_pcm_assign - assign AC97 slots to given PCM streams 4218c2ecf20Sopenharmony_ci * @bus: the ac97 bus instance 4228c2ecf20Sopenharmony_ci * @pcms_count: count of PCMs to be assigned 4238c2ecf20Sopenharmony_ci * @pcms: PCMs to be assigned 4248c2ecf20Sopenharmony_ci * 4258c2ecf20Sopenharmony_ci * It assigns available AC97 slots for given PCMs. If none or only 4268c2ecf20Sopenharmony_ci * some slots are available, pcm->xxx.slots and pcm->xxx.rslots[] members 4278c2ecf20Sopenharmony_ci * are reduced and might be zero. 4288c2ecf20Sopenharmony_ci * 4298c2ecf20Sopenharmony_ci * Return: Zero if successful, or a negative error code on failure. 4308c2ecf20Sopenharmony_ci */ 4318c2ecf20Sopenharmony_ciint snd_ac97_pcm_assign(struct snd_ac97_bus *bus, 4328c2ecf20Sopenharmony_ci unsigned short pcms_count, 4338c2ecf20Sopenharmony_ci const struct ac97_pcm *pcms) 4348c2ecf20Sopenharmony_ci{ 4358c2ecf20Sopenharmony_ci int i, j, k; 4368c2ecf20Sopenharmony_ci const struct ac97_pcm *pcm; 4378c2ecf20Sopenharmony_ci struct ac97_pcm *rpcms, *rpcm; 4388c2ecf20Sopenharmony_ci unsigned short avail_slots[2][4]; 4398c2ecf20Sopenharmony_ci unsigned char rate_table[2][4]; 4408c2ecf20Sopenharmony_ci unsigned short tmp, slots; 4418c2ecf20Sopenharmony_ci unsigned short spdif_slots[4]; 4428c2ecf20Sopenharmony_ci unsigned int rates; 4438c2ecf20Sopenharmony_ci struct snd_ac97 *codec; 4448c2ecf20Sopenharmony_ci 4458c2ecf20Sopenharmony_ci rpcms = kcalloc(pcms_count, sizeof(struct ac97_pcm), GFP_KERNEL); 4468c2ecf20Sopenharmony_ci if (rpcms == NULL) 4478c2ecf20Sopenharmony_ci return -ENOMEM; 4488c2ecf20Sopenharmony_ci memset(avail_slots, 0, sizeof(avail_slots)); 4498c2ecf20Sopenharmony_ci memset(rate_table, 0, sizeof(rate_table)); 4508c2ecf20Sopenharmony_ci memset(spdif_slots, 0, sizeof(spdif_slots)); 4518c2ecf20Sopenharmony_ci for (i = 0; i < 4; i++) { 4528c2ecf20Sopenharmony_ci codec = bus->codec[i]; 4538c2ecf20Sopenharmony_ci if (!codec) 4548c2ecf20Sopenharmony_ci continue; 4558c2ecf20Sopenharmony_ci avail_slots[0][i] = get_pslots(codec, &rate_table[0][i], &spdif_slots[i]); 4568c2ecf20Sopenharmony_ci avail_slots[1][i] = get_cslots(codec); 4578c2ecf20Sopenharmony_ci if (!(codec->scaps & AC97_SCAP_INDEP_SDIN)) { 4588c2ecf20Sopenharmony_ci for (j = 0; j < i; j++) { 4598c2ecf20Sopenharmony_ci if (bus->codec[j]) 4608c2ecf20Sopenharmony_ci avail_slots[1][i] &= ~avail_slots[1][j]; 4618c2ecf20Sopenharmony_ci } 4628c2ecf20Sopenharmony_ci } 4638c2ecf20Sopenharmony_ci } 4648c2ecf20Sopenharmony_ci /* first step - exclusive devices */ 4658c2ecf20Sopenharmony_ci for (i = 0; i < pcms_count; i++) { 4668c2ecf20Sopenharmony_ci pcm = &pcms[i]; 4678c2ecf20Sopenharmony_ci rpcm = &rpcms[i]; 4688c2ecf20Sopenharmony_ci /* low-level driver thinks that it's more clever */ 4698c2ecf20Sopenharmony_ci if (pcm->copy_flag) { 4708c2ecf20Sopenharmony_ci *rpcm = *pcm; 4718c2ecf20Sopenharmony_ci continue; 4728c2ecf20Sopenharmony_ci } 4738c2ecf20Sopenharmony_ci rpcm->stream = pcm->stream; 4748c2ecf20Sopenharmony_ci rpcm->exclusive = pcm->exclusive; 4758c2ecf20Sopenharmony_ci rpcm->spdif = pcm->spdif; 4768c2ecf20Sopenharmony_ci rpcm->private_value = pcm->private_value; 4778c2ecf20Sopenharmony_ci rpcm->bus = bus; 4788c2ecf20Sopenharmony_ci rpcm->rates = ~0; 4798c2ecf20Sopenharmony_ci slots = pcm->r[0].slots; 4808c2ecf20Sopenharmony_ci for (j = 0; j < 4 && slots; j++) { 4818c2ecf20Sopenharmony_ci if (!bus->codec[j]) 4828c2ecf20Sopenharmony_ci continue; 4838c2ecf20Sopenharmony_ci rates = ~0; 4848c2ecf20Sopenharmony_ci if (pcm->spdif && pcm->stream == 0) 4858c2ecf20Sopenharmony_ci tmp = spdif_slots[j]; 4868c2ecf20Sopenharmony_ci else 4878c2ecf20Sopenharmony_ci tmp = avail_slots[pcm->stream][j]; 4888c2ecf20Sopenharmony_ci if (pcm->exclusive) { 4898c2ecf20Sopenharmony_ci /* exclusive access */ 4908c2ecf20Sopenharmony_ci tmp &= slots; 4918c2ecf20Sopenharmony_ci for (k = 0; k < i; k++) { 4928c2ecf20Sopenharmony_ci if (rpcm->stream == rpcms[k].stream) 4938c2ecf20Sopenharmony_ci tmp &= ~rpcms[k].r[0].rslots[j]; 4948c2ecf20Sopenharmony_ci } 4958c2ecf20Sopenharmony_ci } else { 4968c2ecf20Sopenharmony_ci /* non-exclusive access */ 4978c2ecf20Sopenharmony_ci tmp &= pcm->r[0].slots; 4988c2ecf20Sopenharmony_ci } 4998c2ecf20Sopenharmony_ci if (tmp) { 5008c2ecf20Sopenharmony_ci rpcm->r[0].rslots[j] = tmp; 5018c2ecf20Sopenharmony_ci rpcm->r[0].codec[j] = bus->codec[j]; 5028c2ecf20Sopenharmony_ci rpcm->r[0].rate_table[j] = rate_table[pcm->stream][j]; 5038c2ecf20Sopenharmony_ci if (bus->no_vra) 5048c2ecf20Sopenharmony_ci rates = SNDRV_PCM_RATE_48000; 5058c2ecf20Sopenharmony_ci else 5068c2ecf20Sopenharmony_ci rates = get_rates(rpcm, j, tmp, 0); 5078c2ecf20Sopenharmony_ci if (pcm->exclusive) 5088c2ecf20Sopenharmony_ci avail_slots[pcm->stream][j] &= ~tmp; 5098c2ecf20Sopenharmony_ci } 5108c2ecf20Sopenharmony_ci slots &= ~tmp; 5118c2ecf20Sopenharmony_ci rpcm->r[0].slots |= tmp; 5128c2ecf20Sopenharmony_ci rpcm->rates &= rates; 5138c2ecf20Sopenharmony_ci } 5148c2ecf20Sopenharmony_ci /* for double rate, we check the first codec only */ 5158c2ecf20Sopenharmony_ci if (pcm->stream == SNDRV_PCM_STREAM_PLAYBACK && 5168c2ecf20Sopenharmony_ci bus->codec[0] && (bus->codec[0]->flags & AC97_DOUBLE_RATE) && 5178c2ecf20Sopenharmony_ci rate_table[pcm->stream][0] == 0) { 5188c2ecf20Sopenharmony_ci tmp = (1<<AC97_SLOT_PCM_LEFT) | (1<<AC97_SLOT_PCM_RIGHT) | 5198c2ecf20Sopenharmony_ci (1<<AC97_SLOT_PCM_LEFT_0) | (1<<AC97_SLOT_PCM_RIGHT_0); 5208c2ecf20Sopenharmony_ci if ((tmp & pcm->r[1].slots) == tmp) { 5218c2ecf20Sopenharmony_ci rpcm->r[1].slots = tmp; 5228c2ecf20Sopenharmony_ci rpcm->r[1].rslots[0] = tmp; 5238c2ecf20Sopenharmony_ci rpcm->r[1].rate_table[0] = 0; 5248c2ecf20Sopenharmony_ci rpcm->r[1].codec[0] = bus->codec[0]; 5258c2ecf20Sopenharmony_ci if (pcm->exclusive) 5268c2ecf20Sopenharmony_ci avail_slots[pcm->stream][0] &= ~tmp; 5278c2ecf20Sopenharmony_ci if (bus->no_vra) 5288c2ecf20Sopenharmony_ci rates = SNDRV_PCM_RATE_96000; 5298c2ecf20Sopenharmony_ci else 5308c2ecf20Sopenharmony_ci rates = get_rates(rpcm, 0, tmp, 1); 5318c2ecf20Sopenharmony_ci rpcm->rates |= rates; 5328c2ecf20Sopenharmony_ci } 5338c2ecf20Sopenharmony_ci } 5348c2ecf20Sopenharmony_ci if (rpcm->rates == ~0) 5358c2ecf20Sopenharmony_ci rpcm->rates = 0; /* not used */ 5368c2ecf20Sopenharmony_ci } 5378c2ecf20Sopenharmony_ci bus->pcms_count = pcms_count; 5388c2ecf20Sopenharmony_ci bus->pcms = rpcms; 5398c2ecf20Sopenharmony_ci return 0; 5408c2ecf20Sopenharmony_ci} 5418c2ecf20Sopenharmony_ci 5428c2ecf20Sopenharmony_ciEXPORT_SYMBOL(snd_ac97_pcm_assign); 5438c2ecf20Sopenharmony_ci 5448c2ecf20Sopenharmony_ci/** 5458c2ecf20Sopenharmony_ci * snd_ac97_pcm_open - opens the given AC97 pcm 5468c2ecf20Sopenharmony_ci * @pcm: the ac97 pcm instance 5478c2ecf20Sopenharmony_ci * @rate: rate in Hz, if codec does not support VRA, this value must be 48000Hz 5488c2ecf20Sopenharmony_ci * @cfg: output stream characteristics 5498c2ecf20Sopenharmony_ci * @slots: a subset of allocated slots (snd_ac97_pcm_assign) for this pcm 5508c2ecf20Sopenharmony_ci * 5518c2ecf20Sopenharmony_ci * It locks the specified slots and sets the given rate to AC97 registers. 5528c2ecf20Sopenharmony_ci * 5538c2ecf20Sopenharmony_ci * Return: Zero if successful, or a negative error code on failure. 5548c2ecf20Sopenharmony_ci */ 5558c2ecf20Sopenharmony_ciint snd_ac97_pcm_open(struct ac97_pcm *pcm, unsigned int rate, 5568c2ecf20Sopenharmony_ci enum ac97_pcm_cfg cfg, unsigned short slots) 5578c2ecf20Sopenharmony_ci{ 5588c2ecf20Sopenharmony_ci struct snd_ac97_bus *bus; 5598c2ecf20Sopenharmony_ci int i, cidx, r, ok_flag; 5608c2ecf20Sopenharmony_ci unsigned int reg_ok[4] = {0,0,0,0}; 5618c2ecf20Sopenharmony_ci unsigned char reg; 5628c2ecf20Sopenharmony_ci int err = 0; 5638c2ecf20Sopenharmony_ci 5648c2ecf20Sopenharmony_ci r = rate > 48000; 5658c2ecf20Sopenharmony_ci bus = pcm->bus; 5668c2ecf20Sopenharmony_ci if (cfg == AC97_PCM_CFG_SPDIF) { 5678c2ecf20Sopenharmony_ci for (cidx = 0; cidx < 4; cidx++) 5688c2ecf20Sopenharmony_ci if (bus->codec[cidx] && (bus->codec[cidx]->ext_id & AC97_EI_SPDIF)) { 5698c2ecf20Sopenharmony_ci err = set_spdif_rate(bus->codec[cidx], rate); 5708c2ecf20Sopenharmony_ci if (err < 0) 5718c2ecf20Sopenharmony_ci return err; 5728c2ecf20Sopenharmony_ci } 5738c2ecf20Sopenharmony_ci } 5748c2ecf20Sopenharmony_ci spin_lock_irq(&pcm->bus->bus_lock); 5758c2ecf20Sopenharmony_ci for (i = 3; i < 12; i++) { 5768c2ecf20Sopenharmony_ci if (!(slots & (1 << i))) 5778c2ecf20Sopenharmony_ci continue; 5788c2ecf20Sopenharmony_ci ok_flag = 0; 5798c2ecf20Sopenharmony_ci for (cidx = 0; cidx < 4; cidx++) { 5808c2ecf20Sopenharmony_ci if (bus->used_slots[pcm->stream][cidx] & (1 << i)) { 5818c2ecf20Sopenharmony_ci spin_unlock_irq(&pcm->bus->bus_lock); 5828c2ecf20Sopenharmony_ci err = -EBUSY; 5838c2ecf20Sopenharmony_ci goto error; 5848c2ecf20Sopenharmony_ci } 5858c2ecf20Sopenharmony_ci if (pcm->r[r].rslots[cidx] & (1 << i)) { 5868c2ecf20Sopenharmony_ci bus->used_slots[pcm->stream][cidx] |= (1 << i); 5878c2ecf20Sopenharmony_ci ok_flag++; 5888c2ecf20Sopenharmony_ci } 5898c2ecf20Sopenharmony_ci } 5908c2ecf20Sopenharmony_ci if (!ok_flag) { 5918c2ecf20Sopenharmony_ci spin_unlock_irq(&pcm->bus->bus_lock); 5928c2ecf20Sopenharmony_ci dev_err(bus->card->dev, 5938c2ecf20Sopenharmony_ci "cannot find configuration for AC97 slot %i\n", 5948c2ecf20Sopenharmony_ci i); 5958c2ecf20Sopenharmony_ci err = -EAGAIN; 5968c2ecf20Sopenharmony_ci goto error; 5978c2ecf20Sopenharmony_ci } 5988c2ecf20Sopenharmony_ci } 5998c2ecf20Sopenharmony_ci pcm->cur_dbl = r; 6008c2ecf20Sopenharmony_ci spin_unlock_irq(&pcm->bus->bus_lock); 6018c2ecf20Sopenharmony_ci for (i = 3; i < 12; i++) { 6028c2ecf20Sopenharmony_ci if (!(slots & (1 << i))) 6038c2ecf20Sopenharmony_ci continue; 6048c2ecf20Sopenharmony_ci for (cidx = 0; cidx < 4; cidx++) { 6058c2ecf20Sopenharmony_ci if (pcm->r[r].rslots[cidx] & (1 << i)) { 6068c2ecf20Sopenharmony_ci reg = get_slot_reg(pcm, cidx, i, r); 6078c2ecf20Sopenharmony_ci if (reg == 0xff) { 6088c2ecf20Sopenharmony_ci dev_err(bus->card->dev, 6098c2ecf20Sopenharmony_ci "invalid AC97 slot %i?\n", i); 6108c2ecf20Sopenharmony_ci continue; 6118c2ecf20Sopenharmony_ci } 6128c2ecf20Sopenharmony_ci if (reg_ok[cidx] & (1 << (reg - AC97_PCM_FRONT_DAC_RATE))) 6138c2ecf20Sopenharmony_ci continue; 6148c2ecf20Sopenharmony_ci dev_dbg(bus->card->dev, 6158c2ecf20Sopenharmony_ci "setting ac97 reg 0x%x to rate %d\n", 6168c2ecf20Sopenharmony_ci reg, rate); 6178c2ecf20Sopenharmony_ci err = snd_ac97_set_rate(pcm->r[r].codec[cidx], reg, rate); 6188c2ecf20Sopenharmony_ci if (err < 0) 6198c2ecf20Sopenharmony_ci dev_err(bus->card->dev, 6208c2ecf20Sopenharmony_ci "error in snd_ac97_set_rate: cidx=%d, reg=0x%x, rate=%d, err=%d\n", 6218c2ecf20Sopenharmony_ci cidx, reg, rate, err); 6228c2ecf20Sopenharmony_ci else 6238c2ecf20Sopenharmony_ci reg_ok[cidx] |= (1 << (reg - AC97_PCM_FRONT_DAC_RATE)); 6248c2ecf20Sopenharmony_ci } 6258c2ecf20Sopenharmony_ci } 6268c2ecf20Sopenharmony_ci } 6278c2ecf20Sopenharmony_ci pcm->aslots = slots; 6288c2ecf20Sopenharmony_ci return 0; 6298c2ecf20Sopenharmony_ci 6308c2ecf20Sopenharmony_ci error: 6318c2ecf20Sopenharmony_ci pcm->aslots = slots; 6328c2ecf20Sopenharmony_ci snd_ac97_pcm_close(pcm); 6338c2ecf20Sopenharmony_ci return err; 6348c2ecf20Sopenharmony_ci} 6358c2ecf20Sopenharmony_ci 6368c2ecf20Sopenharmony_ciEXPORT_SYMBOL(snd_ac97_pcm_open); 6378c2ecf20Sopenharmony_ci 6388c2ecf20Sopenharmony_ci/** 6398c2ecf20Sopenharmony_ci * snd_ac97_pcm_close - closes the given AC97 pcm 6408c2ecf20Sopenharmony_ci * @pcm: the ac97 pcm instance 6418c2ecf20Sopenharmony_ci * 6428c2ecf20Sopenharmony_ci * It frees the locked AC97 slots. 6438c2ecf20Sopenharmony_ci * 6448c2ecf20Sopenharmony_ci * Return: Zero. 6458c2ecf20Sopenharmony_ci */ 6468c2ecf20Sopenharmony_ciint snd_ac97_pcm_close(struct ac97_pcm *pcm) 6478c2ecf20Sopenharmony_ci{ 6488c2ecf20Sopenharmony_ci struct snd_ac97_bus *bus; 6498c2ecf20Sopenharmony_ci unsigned short slots = pcm->aslots; 6508c2ecf20Sopenharmony_ci int i, cidx; 6518c2ecf20Sopenharmony_ci 6528c2ecf20Sopenharmony_ci#ifdef CONFIG_SND_AC97_POWER_SAVE 6538c2ecf20Sopenharmony_ci int r = pcm->cur_dbl; 6548c2ecf20Sopenharmony_ci for (i = 3; i < 12; i++) { 6558c2ecf20Sopenharmony_ci if (!(slots & (1 << i))) 6568c2ecf20Sopenharmony_ci continue; 6578c2ecf20Sopenharmony_ci for (cidx = 0; cidx < 4; cidx++) { 6588c2ecf20Sopenharmony_ci if (pcm->r[r].rslots[cidx] & (1 << i)) { 6598c2ecf20Sopenharmony_ci int reg = get_slot_reg(pcm, cidx, i, r); 6608c2ecf20Sopenharmony_ci snd_ac97_update_power(pcm->r[r].codec[cidx], 6618c2ecf20Sopenharmony_ci reg, 0); 6628c2ecf20Sopenharmony_ci } 6638c2ecf20Sopenharmony_ci } 6648c2ecf20Sopenharmony_ci } 6658c2ecf20Sopenharmony_ci#endif 6668c2ecf20Sopenharmony_ci 6678c2ecf20Sopenharmony_ci bus = pcm->bus; 6688c2ecf20Sopenharmony_ci spin_lock_irq(&pcm->bus->bus_lock); 6698c2ecf20Sopenharmony_ci for (i = 3; i < 12; i++) { 6708c2ecf20Sopenharmony_ci if (!(slots & (1 << i))) 6718c2ecf20Sopenharmony_ci continue; 6728c2ecf20Sopenharmony_ci for (cidx = 0; cidx < 4; cidx++) 6738c2ecf20Sopenharmony_ci bus->used_slots[pcm->stream][cidx] &= ~(1 << i); 6748c2ecf20Sopenharmony_ci } 6758c2ecf20Sopenharmony_ci pcm->aslots = 0; 6768c2ecf20Sopenharmony_ci pcm->cur_dbl = 0; 6778c2ecf20Sopenharmony_ci spin_unlock_irq(&pcm->bus->bus_lock); 6788c2ecf20Sopenharmony_ci return 0; 6798c2ecf20Sopenharmony_ci} 6808c2ecf20Sopenharmony_ci 6818c2ecf20Sopenharmony_ciEXPORT_SYMBOL(snd_ac97_pcm_close); 6828c2ecf20Sopenharmony_ci 6838c2ecf20Sopenharmony_cistatic int double_rate_hw_constraint_rate(struct snd_pcm_hw_params *params, 6848c2ecf20Sopenharmony_ci struct snd_pcm_hw_rule *rule) 6858c2ecf20Sopenharmony_ci{ 6868c2ecf20Sopenharmony_ci struct snd_interval *channels = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); 6878c2ecf20Sopenharmony_ci if (channels->min > 2) { 6888c2ecf20Sopenharmony_ci static const struct snd_interval single_rates = { 6898c2ecf20Sopenharmony_ci .min = 1, 6908c2ecf20Sopenharmony_ci .max = 48000, 6918c2ecf20Sopenharmony_ci }; 6928c2ecf20Sopenharmony_ci struct snd_interval *rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); 6938c2ecf20Sopenharmony_ci return snd_interval_refine(rate, &single_rates); 6948c2ecf20Sopenharmony_ci } 6958c2ecf20Sopenharmony_ci return 0; 6968c2ecf20Sopenharmony_ci} 6978c2ecf20Sopenharmony_ci 6988c2ecf20Sopenharmony_cistatic int double_rate_hw_constraint_channels(struct snd_pcm_hw_params *params, 6998c2ecf20Sopenharmony_ci struct snd_pcm_hw_rule *rule) 7008c2ecf20Sopenharmony_ci{ 7018c2ecf20Sopenharmony_ci struct snd_interval *rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); 7028c2ecf20Sopenharmony_ci if (rate->min > 48000) { 7038c2ecf20Sopenharmony_ci static const struct snd_interval double_rate_channels = { 7048c2ecf20Sopenharmony_ci .min = 2, 7058c2ecf20Sopenharmony_ci .max = 2, 7068c2ecf20Sopenharmony_ci }; 7078c2ecf20Sopenharmony_ci struct snd_interval *channels = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); 7088c2ecf20Sopenharmony_ci return snd_interval_refine(channels, &double_rate_channels); 7098c2ecf20Sopenharmony_ci } 7108c2ecf20Sopenharmony_ci return 0; 7118c2ecf20Sopenharmony_ci} 7128c2ecf20Sopenharmony_ci 7138c2ecf20Sopenharmony_ci/** 7148c2ecf20Sopenharmony_ci * snd_ac97_pcm_double_rate_rules - set double rate constraints 7158c2ecf20Sopenharmony_ci * @runtime: the runtime of the ac97 front playback pcm 7168c2ecf20Sopenharmony_ci * 7178c2ecf20Sopenharmony_ci * Installs the hardware constraint rules to prevent using double rates and 7188c2ecf20Sopenharmony_ci * more than two channels at the same time. 7198c2ecf20Sopenharmony_ci * 7208c2ecf20Sopenharmony_ci * Return: Zero if successful, or a negative error code on failure. 7218c2ecf20Sopenharmony_ci */ 7228c2ecf20Sopenharmony_ciint snd_ac97_pcm_double_rate_rules(struct snd_pcm_runtime *runtime) 7238c2ecf20Sopenharmony_ci{ 7248c2ecf20Sopenharmony_ci int err; 7258c2ecf20Sopenharmony_ci 7268c2ecf20Sopenharmony_ci err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, 7278c2ecf20Sopenharmony_ci double_rate_hw_constraint_rate, NULL, 7288c2ecf20Sopenharmony_ci SNDRV_PCM_HW_PARAM_CHANNELS, -1); 7298c2ecf20Sopenharmony_ci if (err < 0) 7308c2ecf20Sopenharmony_ci return err; 7318c2ecf20Sopenharmony_ci err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS, 7328c2ecf20Sopenharmony_ci double_rate_hw_constraint_channels, NULL, 7338c2ecf20Sopenharmony_ci SNDRV_PCM_HW_PARAM_RATE, -1); 7348c2ecf20Sopenharmony_ci return err; 7358c2ecf20Sopenharmony_ci} 7368c2ecf20Sopenharmony_ci 7378c2ecf20Sopenharmony_ciEXPORT_SYMBOL(snd_ac97_pcm_double_rate_rules); 738