mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-27 11:19:37 +00:00
![Pan Bian](/assets/img/avatar_default.png)
When the second call to load_asic_generic() fails in function load_asic(), "false" is returned. The real value of "false" is 0, which indicates success in the context. As a result, the execution status and the return value may be inconsistent. This patch fixes the bug. Bugzilla: https://bugzilla.kernel.org/show_bug.cgi?id=188761 Signed-off-by: Pan Bian <bianpan2016@163.com> Signed-off-by: Takashi Iwai <tiwai@suse.de>
394 lines
10 KiB
C
394 lines
10 KiB
C
/****************************************************************************
|
|
|
|
Copyright Echo Digital Audio Corporation (c) 1998 - 2004
|
|
All rights reserved
|
|
www.echoaudio.com
|
|
|
|
This file is part of Echo Digital Audio's generic driver library.
|
|
|
|
Echo Digital Audio's generic driver library is free software;
|
|
you can redistribute it and/or modify it under the terms of
|
|
the GNU General Public License as published by the Free Software Foundation.
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with this program; if not, write to the Free Software
|
|
Foundation, Inc., 59 Temple Place - Suite 330, Boston,
|
|
MA 02111-1307, USA.
|
|
|
|
*************************************************************************
|
|
|
|
Translation from C++ and adaptation for use in ALSA-Driver
|
|
were made by Giuliano Pochini <pochini@shiny.it>
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
static int write_control_reg(struct echoaudio *chip, u32 value, char force);
|
|
static int set_input_clock(struct echoaudio *chip, u16 clock);
|
|
static int set_professional_spdif(struct echoaudio *chip, char prof);
|
|
static int set_digital_mode(struct echoaudio *chip, u8 mode);
|
|
static int load_asic_generic(struct echoaudio *chip, u32 cmd, short asic);
|
|
static int check_asic_status(struct echoaudio *chip);
|
|
|
|
|
|
static int init_hw(struct echoaudio *chip, u16 device_id, u16 subdevice_id)
|
|
{
|
|
int err;
|
|
|
|
if (snd_BUG_ON((subdevice_id & 0xfff0) != LAYLA24))
|
|
return -ENODEV;
|
|
|
|
if ((err = init_dsp_comm_page(chip))) {
|
|
dev_err(chip->card->dev,
|
|
"init_hw - could not initialize DSP comm page\n");
|
|
return err;
|
|
}
|
|
|
|
chip->device_id = device_id;
|
|
chip->subdevice_id = subdevice_id;
|
|
chip->bad_board = true;
|
|
chip->has_midi = true;
|
|
chip->dsp_code_to_load = FW_LAYLA24_DSP;
|
|
chip->input_clock_types =
|
|
ECHO_CLOCK_BIT_INTERNAL | ECHO_CLOCK_BIT_SPDIF |
|
|
ECHO_CLOCK_BIT_WORD | ECHO_CLOCK_BIT_ADAT;
|
|
chip->digital_modes =
|
|
ECHOCAPS_HAS_DIGITAL_MODE_SPDIF_RCA |
|
|
ECHOCAPS_HAS_DIGITAL_MODE_SPDIF_OPTICAL |
|
|
ECHOCAPS_HAS_DIGITAL_MODE_ADAT;
|
|
|
|
if ((err = load_firmware(chip)) < 0)
|
|
return err;
|
|
chip->bad_board = false;
|
|
|
|
if ((err = init_line_levels(chip)) < 0)
|
|
return err;
|
|
|
|
return err;
|
|
}
|
|
|
|
|
|
|
|
static int set_mixer_defaults(struct echoaudio *chip)
|
|
{
|
|
chip->digital_mode = DIGITAL_MODE_SPDIF_RCA;
|
|
chip->professional_spdif = false;
|
|
chip->digital_in_automute = true;
|
|
return init_line_levels(chip);
|
|
}
|
|
|
|
|
|
|
|
static u32 detect_input_clocks(const struct echoaudio *chip)
|
|
{
|
|
u32 clocks_from_dsp, clock_bits;
|
|
|
|
/* Map the DSP clock detect bits to the generic driver clock detect bits */
|
|
clocks_from_dsp = le32_to_cpu(chip->comm_page->status_clocks);
|
|
|
|
clock_bits = ECHO_CLOCK_BIT_INTERNAL;
|
|
|
|
if (clocks_from_dsp & GML_CLOCK_DETECT_BIT_SPDIF)
|
|
clock_bits |= ECHO_CLOCK_BIT_SPDIF;
|
|
|
|
if (clocks_from_dsp & GML_CLOCK_DETECT_BIT_ADAT)
|
|
clock_bits |= ECHO_CLOCK_BIT_ADAT;
|
|
|
|
if (clocks_from_dsp & GML_CLOCK_DETECT_BIT_WORD)
|
|
clock_bits |= ECHO_CLOCK_BIT_WORD;
|
|
|
|
return clock_bits;
|
|
}
|
|
|
|
|
|
|
|
/* Layla24 has an ASIC on the PCI card and another ASIC in the external box;
|
|
both need to be loaded. */
|
|
static int load_asic(struct echoaudio *chip)
|
|
{
|
|
int err;
|
|
|
|
if (chip->asic_loaded)
|
|
return 1;
|
|
|
|
|
|
/* Give the DSP a few milliseconds to settle down */
|
|
mdelay(10);
|
|
|
|
/* Load the ASIC for the PCI card */
|
|
err = load_asic_generic(chip, DSP_FNC_LOAD_LAYLA24_PCI_CARD_ASIC,
|
|
FW_LAYLA24_1_ASIC);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
chip->asic_code = FW_LAYLA24_2S_ASIC;
|
|
|
|
/* Now give the new ASIC a little time to set up */
|
|
mdelay(10);
|
|
|
|
/* Do the external one */
|
|
err = load_asic_generic(chip, DSP_FNC_LOAD_LAYLA24_EXTERNAL_ASIC,
|
|
FW_LAYLA24_2S_ASIC);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
/* Now give the external ASIC a little time to set up */
|
|
mdelay(10);
|
|
|
|
/* See if it worked */
|
|
err = check_asic_status(chip);
|
|
|
|
/* Set up the control register if the load succeeded -
|
|
48 kHz, internal clock, S/PDIF RCA mode */
|
|
if (!err)
|
|
err = write_control_reg(chip, GML_CONVERTER_ENABLE | GML_48KHZ,
|
|
true);
|
|
|
|
return err;
|
|
}
|
|
|
|
|
|
|
|
static int set_sample_rate(struct echoaudio *chip, u32 rate)
|
|
{
|
|
u32 control_reg, clock, base_rate;
|
|
|
|
if (snd_BUG_ON(rate >= 50000 &&
|
|
chip->digital_mode == DIGITAL_MODE_ADAT))
|
|
return -EINVAL;
|
|
|
|
/* Only set the clock for internal mode. */
|
|
if (chip->input_clock != ECHO_CLOCK_INTERNAL) {
|
|
dev_warn(chip->card->dev,
|
|
"Cannot set sample rate - clock not set to CLK_CLOCKININTERNAL\n");
|
|
/* Save the rate anyhow */
|
|
chip->comm_page->sample_rate = cpu_to_le32(rate);
|
|
chip->sample_rate = rate;
|
|
return 0;
|
|
}
|
|
|
|
/* Get the control register & clear the appropriate bits */
|
|
control_reg = le32_to_cpu(chip->comm_page->control_register);
|
|
control_reg &= GML_CLOCK_CLEAR_MASK & GML_SPDIF_RATE_CLEAR_MASK;
|
|
|
|
clock = 0;
|
|
|
|
switch (rate) {
|
|
case 96000:
|
|
clock = GML_96KHZ;
|
|
break;
|
|
case 88200:
|
|
clock = GML_88KHZ;
|
|
break;
|
|
case 48000:
|
|
clock = GML_48KHZ | GML_SPDIF_SAMPLE_RATE1;
|
|
break;
|
|
case 44100:
|
|
clock = GML_44KHZ;
|
|
/* Professional mode */
|
|
if (control_reg & GML_SPDIF_PRO_MODE)
|
|
clock |= GML_SPDIF_SAMPLE_RATE0;
|
|
break;
|
|
case 32000:
|
|
clock = GML_32KHZ | GML_SPDIF_SAMPLE_RATE0 |
|
|
GML_SPDIF_SAMPLE_RATE1;
|
|
break;
|
|
case 22050:
|
|
clock = GML_22KHZ;
|
|
break;
|
|
case 16000:
|
|
clock = GML_16KHZ;
|
|
break;
|
|
case 11025:
|
|
clock = GML_11KHZ;
|
|
break;
|
|
case 8000:
|
|
clock = GML_8KHZ;
|
|
break;
|
|
default:
|
|
/* If this is a non-standard rate, then the driver needs to
|
|
use Layla24's special "continuous frequency" mode */
|
|
clock = LAYLA24_CONTINUOUS_CLOCK;
|
|
if (rate > 50000) {
|
|
base_rate = rate >> 1;
|
|
control_reg |= GML_DOUBLE_SPEED_MODE;
|
|
} else {
|
|
base_rate = rate;
|
|
}
|
|
|
|
if (base_rate < 25000)
|
|
base_rate = 25000;
|
|
|
|
if (wait_handshake(chip))
|
|
return -EIO;
|
|
|
|
chip->comm_page->sample_rate =
|
|
cpu_to_le32(LAYLA24_MAGIC_NUMBER / base_rate - 2);
|
|
|
|
clear_handshake(chip);
|
|
send_vector(chip, DSP_VC_SET_LAYLA24_FREQUENCY_REG);
|
|
}
|
|
|
|
control_reg |= clock;
|
|
|
|
chip->comm_page->sample_rate = cpu_to_le32(rate); /* ignored by the DSP ? */
|
|
chip->sample_rate = rate;
|
|
dev_dbg(chip->card->dev,
|
|
"set_sample_rate: %d clock %d\n", rate, control_reg);
|
|
|
|
return write_control_reg(chip, control_reg, false);
|
|
}
|
|
|
|
|
|
|
|
static int set_input_clock(struct echoaudio *chip, u16 clock)
|
|
{
|
|
u32 control_reg, clocks_from_dsp;
|
|
|
|
/* Mask off the clock select bits */
|
|
control_reg = le32_to_cpu(chip->comm_page->control_register) &
|
|
GML_CLOCK_CLEAR_MASK;
|
|
clocks_from_dsp = le32_to_cpu(chip->comm_page->status_clocks);
|
|
|
|
/* Pick the new clock */
|
|
switch (clock) {
|
|
case ECHO_CLOCK_INTERNAL:
|
|
chip->input_clock = ECHO_CLOCK_INTERNAL;
|
|
return set_sample_rate(chip, chip->sample_rate);
|
|
case ECHO_CLOCK_SPDIF:
|
|
if (chip->digital_mode == DIGITAL_MODE_ADAT)
|
|
return -EAGAIN;
|
|
control_reg |= GML_SPDIF_CLOCK;
|
|
/* Layla24 doesn't support 96KHz S/PDIF */
|
|
control_reg &= ~GML_DOUBLE_SPEED_MODE;
|
|
break;
|
|
case ECHO_CLOCK_WORD:
|
|
control_reg |= GML_WORD_CLOCK;
|
|
if (clocks_from_dsp & GML_CLOCK_DETECT_BIT_WORD96)
|
|
control_reg |= GML_DOUBLE_SPEED_MODE;
|
|
else
|
|
control_reg &= ~GML_DOUBLE_SPEED_MODE;
|
|
break;
|
|
case ECHO_CLOCK_ADAT:
|
|
if (chip->digital_mode != DIGITAL_MODE_ADAT)
|
|
return -EAGAIN;
|
|
control_reg |= GML_ADAT_CLOCK;
|
|
control_reg &= ~GML_DOUBLE_SPEED_MODE;
|
|
break;
|
|
default:
|
|
dev_err(chip->card->dev,
|
|
"Input clock 0x%x not supported for Layla24\n", clock);
|
|
return -EINVAL;
|
|
}
|
|
|
|
chip->input_clock = clock;
|
|
return write_control_reg(chip, control_reg, true);
|
|
}
|
|
|
|
|
|
|
|
/* Depending on what digital mode you want, Layla24 needs different ASICs
|
|
loaded. This function checks the ASIC needed for the new mode and sees
|
|
if it matches the one already loaded. */
|
|
static int switch_asic(struct echoaudio *chip, short asic)
|
|
{
|
|
s8 *monitors;
|
|
|
|
/* Check to see if this is already loaded */
|
|
if (asic != chip->asic_code) {
|
|
monitors = kmemdup(chip->comm_page->monitors,
|
|
MONITOR_ARRAY_SIZE, GFP_KERNEL);
|
|
if (! monitors)
|
|
return -ENOMEM;
|
|
|
|
memset(chip->comm_page->monitors, ECHOGAIN_MUTED,
|
|
MONITOR_ARRAY_SIZE);
|
|
|
|
/* Load the desired ASIC */
|
|
if (load_asic_generic(chip, DSP_FNC_LOAD_LAYLA24_EXTERNAL_ASIC,
|
|
asic) < 0) {
|
|
memcpy(chip->comm_page->monitors, monitors,
|
|
MONITOR_ARRAY_SIZE);
|
|
kfree(monitors);
|
|
return -EIO;
|
|
}
|
|
chip->asic_code = asic;
|
|
memcpy(chip->comm_page->monitors, monitors, MONITOR_ARRAY_SIZE);
|
|
kfree(monitors);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int dsp_set_digital_mode(struct echoaudio *chip, u8 mode)
|
|
{
|
|
u32 control_reg;
|
|
int err, incompatible_clock;
|
|
short asic;
|
|
|
|
/* Set clock to "internal" if it's not compatible with the new mode */
|
|
incompatible_clock = false;
|
|
switch (mode) {
|
|
case DIGITAL_MODE_SPDIF_OPTICAL:
|
|
case DIGITAL_MODE_SPDIF_RCA:
|
|
if (chip->input_clock == ECHO_CLOCK_ADAT)
|
|
incompatible_clock = true;
|
|
asic = FW_LAYLA24_2S_ASIC;
|
|
break;
|
|
case DIGITAL_MODE_ADAT:
|
|
if (chip->input_clock == ECHO_CLOCK_SPDIF)
|
|
incompatible_clock = true;
|
|
asic = FW_LAYLA24_2A_ASIC;
|
|
break;
|
|
default:
|
|
dev_err(chip->card->dev,
|
|
"Digital mode not supported: %d\n", mode);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (incompatible_clock) { /* Switch to 48KHz, internal */
|
|
chip->sample_rate = 48000;
|
|
spin_lock_irq(&chip->lock);
|
|
set_input_clock(chip, ECHO_CLOCK_INTERNAL);
|
|
spin_unlock_irq(&chip->lock);
|
|
}
|
|
|
|
/* switch_asic() can sleep */
|
|
if (switch_asic(chip, asic) < 0)
|
|
return -EIO;
|
|
|
|
spin_lock_irq(&chip->lock);
|
|
|
|
/* Tweak the control register */
|
|
control_reg = le32_to_cpu(chip->comm_page->control_register);
|
|
control_reg &= GML_DIGITAL_MODE_CLEAR_MASK;
|
|
|
|
switch (mode) {
|
|
case DIGITAL_MODE_SPDIF_OPTICAL:
|
|
control_reg |= GML_SPDIF_OPTICAL_MODE;
|
|
break;
|
|
case DIGITAL_MODE_SPDIF_RCA:
|
|
/* GML_SPDIF_OPTICAL_MODE bit cleared */
|
|
break;
|
|
case DIGITAL_MODE_ADAT:
|
|
control_reg |= GML_ADAT_MODE;
|
|
control_reg &= ~GML_DOUBLE_SPEED_MODE;
|
|
break;
|
|
}
|
|
|
|
err = write_control_reg(chip, control_reg, true);
|
|
spin_unlock_irq(&chip->lock);
|
|
if (err < 0)
|
|
return err;
|
|
chip->digital_mode = mode;
|
|
|
|
dev_dbg(chip->card->dev, "set_digital_mode to %d\n", mode);
|
|
return incompatible_clock;
|
|
}
|