mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-21 11:44:01 +08:00
74eeb141d3
Dan Carpenter reported that setting 0 to uinfo->value.enumerated.items in snd_asihpi_cmode_info() may lead to Oops. This function should return an error immediately in such a case instead. Cc: Dan Carpenter <dan.carpenter@oracle.com> Signed-off-by: Takashi Iwai <tiwai@suse.de>
2993 lines
80 KiB
C
2993 lines
80 KiB
C
/*
|
|
* Asihpi soundcard
|
|
* Copyright (c) by AudioScience Inc <alsa@audioscience.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of version 2 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
|
|
*
|
|
*
|
|
* The following is not a condition of use, merely a request:
|
|
* If you modify this program, particularly if you fix errors, AudioScience Inc
|
|
* would appreciate it if you grant us the right to use those modifications
|
|
* for any purpose including commercial applications.
|
|
*/
|
|
|
|
#include "hpi_internal.h"
|
|
#include "hpi_version.h"
|
|
#include "hpimsginit.h"
|
|
#include "hpioctl.h"
|
|
#include "hpicmn.h"
|
|
|
|
|
|
#include <linux/pci.h>
|
|
#include <linux/init.h>
|
|
#include <linux/jiffies.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/time.h>
|
|
#include <linux/wait.h>
|
|
#include <linux/module.h>
|
|
#include <sound/core.h>
|
|
#include <sound/control.h>
|
|
#include <sound/pcm.h>
|
|
#include <sound/pcm_params.h>
|
|
#include <sound/info.h>
|
|
#include <sound/initval.h>
|
|
#include <sound/tlv.h>
|
|
#include <sound/hwdep.h>
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("AudioScience inc. <support@audioscience.com>");
|
|
MODULE_DESCRIPTION("AudioScience ALSA ASI5000 ASI6000 ASI87xx ASI89xx "
|
|
HPI_VER_STRING);
|
|
|
|
#if defined CONFIG_SND_DEBUG_VERBOSE
|
|
/**
|
|
* snd_printddd - very verbose debug printk
|
|
* @format: format string
|
|
*
|
|
* Works like snd_printk() for debugging purposes.
|
|
* Ignored when CONFIG_SND_DEBUG_VERBOSE is not set.
|
|
* Must set snd module debug parameter to 3 to enable at runtime.
|
|
*/
|
|
#define snd_printddd(format, args...) \
|
|
__snd_printk(3, __FILE__, __LINE__, format, ##args)
|
|
#else
|
|
#define snd_printddd(format, args...) do { } while (0)
|
|
#endif
|
|
|
|
static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; /* index 0-MAX */
|
|
static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; /* ID for this card */
|
|
static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
|
|
static bool enable_hpi_hwdep = 1;
|
|
|
|
module_param_array(index, int, NULL, S_IRUGO);
|
|
MODULE_PARM_DESC(index, "ALSA index value for AudioScience soundcard.");
|
|
|
|
module_param_array(id, charp, NULL, S_IRUGO);
|
|
MODULE_PARM_DESC(id, "ALSA ID string for AudioScience soundcard.");
|
|
|
|
module_param_array(enable, bool, NULL, S_IRUGO);
|
|
MODULE_PARM_DESC(enable, "ALSA enable AudioScience soundcard.");
|
|
|
|
module_param(enable_hpi_hwdep, bool, S_IRUGO|S_IWUSR);
|
|
MODULE_PARM_DESC(enable_hpi_hwdep,
|
|
"ALSA enable HPI hwdep for AudioScience soundcard ");
|
|
|
|
/* identify driver */
|
|
#ifdef KERNEL_ALSA_BUILD
|
|
static char *build_info = "Built using headers from kernel source";
|
|
module_param(build_info, charp, S_IRUGO);
|
|
MODULE_PARM_DESC(build_info, "built using headers from kernel source");
|
|
#else
|
|
static char *build_info = "Built within ALSA source";
|
|
module_param(build_info, charp, S_IRUGO);
|
|
MODULE_PARM_DESC(build_info, "built within ALSA source");
|
|
#endif
|
|
|
|
/* set to 1 to dump every control from adapter to log */
|
|
static const int mixer_dump;
|
|
|
|
#define DEFAULT_SAMPLERATE 44100
|
|
static int adapter_fs = DEFAULT_SAMPLERATE;
|
|
|
|
/* defaults */
|
|
#define PERIODS_MIN 2
|
|
#define PERIOD_BYTES_MIN 2048
|
|
#define BUFFER_BYTES_MAX (512 * 1024)
|
|
|
|
#define MAX_CLOCKSOURCES (HPI_SAMPLECLOCK_SOURCE_LAST + 1 + 7)
|
|
|
|
struct clk_source {
|
|
int source;
|
|
int index;
|
|
char *name;
|
|
};
|
|
|
|
struct clk_cache {
|
|
int count;
|
|
int has_local;
|
|
struct clk_source s[MAX_CLOCKSOURCES];
|
|
};
|
|
|
|
/* Per card data */
|
|
struct snd_card_asihpi {
|
|
struct snd_card *card;
|
|
struct pci_dev *pci;
|
|
struct hpi_adapter *hpi;
|
|
|
|
u32 h_mixer;
|
|
struct clk_cache cc;
|
|
|
|
u16 can_dma;
|
|
u16 support_grouping;
|
|
u16 support_mrx;
|
|
u16 update_interval_frames;
|
|
u16 in_max_chans;
|
|
u16 out_max_chans;
|
|
u16 in_min_chans;
|
|
u16 out_min_chans;
|
|
};
|
|
|
|
/* Per stream data */
|
|
struct snd_card_asihpi_pcm {
|
|
struct timer_list timer;
|
|
unsigned int respawn_timer;
|
|
unsigned int hpi_buffer_attached;
|
|
unsigned int buffer_bytes;
|
|
unsigned int period_bytes;
|
|
unsigned int bytes_per_sec;
|
|
unsigned int pcm_buf_host_rw_ofs; /* Host R/W pos */
|
|
unsigned int pcm_buf_dma_ofs; /* DMA R/W offset in buffer */
|
|
unsigned int pcm_buf_elapsed_dma_ofs; /* DMA R/W offset in buffer */
|
|
unsigned int drained_count;
|
|
struct snd_pcm_substream *substream;
|
|
u32 h_stream;
|
|
struct hpi_format format;
|
|
};
|
|
|
|
/* universal stream verbs work with out or in stream handles */
|
|
|
|
/* Functions to allow driver to give a buffer to HPI for busmastering */
|
|
|
|
static u16 hpi_stream_host_buffer_attach(
|
|
u32 h_stream, /* handle to outstream. */
|
|
u32 size_in_bytes, /* size in bytes of bus mastering buffer */
|
|
u32 pci_address
|
|
)
|
|
{
|
|
struct hpi_message hm;
|
|
struct hpi_response hr;
|
|
unsigned int obj = hpi_handle_object(h_stream);
|
|
|
|
if (!h_stream)
|
|
return HPI_ERROR_INVALID_OBJ;
|
|
hpi_init_message_response(&hm, &hr, obj,
|
|
obj == HPI_OBJ_OSTREAM ?
|
|
HPI_OSTREAM_HOSTBUFFER_ALLOC :
|
|
HPI_ISTREAM_HOSTBUFFER_ALLOC);
|
|
|
|
hpi_handle_to_indexes(h_stream, &hm.adapter_index,
|
|
&hm.obj_index);
|
|
|
|
hm.u.d.u.buffer.buffer_size = size_in_bytes;
|
|
hm.u.d.u.buffer.pci_address = pci_address;
|
|
hm.u.d.u.buffer.command = HPI_BUFFER_CMD_INTERNAL_GRANTADAPTER;
|
|
hpi_send_recv(&hm, &hr);
|
|
return hr.error;
|
|
}
|
|
|
|
static u16 hpi_stream_host_buffer_detach(u32 h_stream)
|
|
{
|
|
struct hpi_message hm;
|
|
struct hpi_response hr;
|
|
unsigned int obj = hpi_handle_object(h_stream);
|
|
|
|
if (!h_stream)
|
|
return HPI_ERROR_INVALID_OBJ;
|
|
|
|
hpi_init_message_response(&hm, &hr, obj,
|
|
obj == HPI_OBJ_OSTREAM ?
|
|
HPI_OSTREAM_HOSTBUFFER_FREE :
|
|
HPI_ISTREAM_HOSTBUFFER_FREE);
|
|
|
|
hpi_handle_to_indexes(h_stream, &hm.adapter_index,
|
|
&hm.obj_index);
|
|
hm.u.d.u.buffer.command = HPI_BUFFER_CMD_INTERNAL_REVOKEADAPTER;
|
|
hpi_send_recv(&hm, &hr);
|
|
return hr.error;
|
|
}
|
|
|
|
static inline u16 hpi_stream_start(u32 h_stream)
|
|
{
|
|
if (hpi_handle_object(h_stream) == HPI_OBJ_OSTREAM)
|
|
return hpi_outstream_start(h_stream);
|
|
else
|
|
return hpi_instream_start(h_stream);
|
|
}
|
|
|
|
static inline u16 hpi_stream_stop(u32 h_stream)
|
|
{
|
|
if (hpi_handle_object(h_stream) == HPI_OBJ_OSTREAM)
|
|
return hpi_outstream_stop(h_stream);
|
|
else
|
|
return hpi_instream_stop(h_stream);
|
|
}
|
|
|
|
static inline u16 hpi_stream_get_info_ex(
|
|
u32 h_stream,
|
|
u16 *pw_state,
|
|
u32 *pbuffer_size,
|
|
u32 *pdata_in_buffer,
|
|
u32 *psample_count,
|
|
u32 *pauxiliary_data
|
|
)
|
|
{
|
|
u16 e;
|
|
if (hpi_handle_object(h_stream) == HPI_OBJ_OSTREAM)
|
|
e = hpi_outstream_get_info_ex(h_stream, pw_state,
|
|
pbuffer_size, pdata_in_buffer,
|
|
psample_count, pauxiliary_data);
|
|
else
|
|
e = hpi_instream_get_info_ex(h_stream, pw_state,
|
|
pbuffer_size, pdata_in_buffer,
|
|
psample_count, pauxiliary_data);
|
|
return e;
|
|
}
|
|
|
|
static inline u16 hpi_stream_group_add(
|
|
u32 h_master,
|
|
u32 h_stream)
|
|
{
|
|
if (hpi_handle_object(h_master) == HPI_OBJ_OSTREAM)
|
|
return hpi_outstream_group_add(h_master, h_stream);
|
|
else
|
|
return hpi_instream_group_add(h_master, h_stream);
|
|
}
|
|
|
|
static inline u16 hpi_stream_group_reset(u32 h_stream)
|
|
{
|
|
if (hpi_handle_object(h_stream) == HPI_OBJ_OSTREAM)
|
|
return hpi_outstream_group_reset(h_stream);
|
|
else
|
|
return hpi_instream_group_reset(h_stream);
|
|
}
|
|
|
|
static inline u16 hpi_stream_group_get_map(
|
|
u32 h_stream, u32 *mo, u32 *mi)
|
|
{
|
|
if (hpi_handle_object(h_stream) == HPI_OBJ_OSTREAM)
|
|
return hpi_outstream_group_get_map(h_stream, mo, mi);
|
|
else
|
|
return hpi_instream_group_get_map(h_stream, mo, mi);
|
|
}
|
|
|
|
static u16 handle_error(u16 err, int line, char *filename)
|
|
{
|
|
if (err)
|
|
printk(KERN_WARNING
|
|
"in file %s, line %d: HPI error %d\n",
|
|
filename, line, err);
|
|
return err;
|
|
}
|
|
|
|
#define hpi_handle_error(x) handle_error(x, __LINE__, __FILE__)
|
|
|
|
/***************************** GENERAL PCM ****************/
|
|
|
|
static void print_hwparams(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *p)
|
|
{
|
|
char name[16];
|
|
snd_pcm_debug_name(substream, name, sizeof(name));
|
|
snd_printd("%s HWPARAMS\n", name);
|
|
snd_printd(" samplerate %d Hz\n", params_rate(p));
|
|
snd_printd(" channels %d\n", params_channels(p));
|
|
snd_printd(" format %d\n", params_format(p));
|
|
snd_printd(" subformat %d\n", params_subformat(p));
|
|
snd_printd(" buffer %d B\n", params_buffer_bytes(p));
|
|
snd_printd(" period %d B\n", params_period_bytes(p));
|
|
snd_printd(" access %d\n", params_access(p));
|
|
snd_printd(" period_size %d\n", params_period_size(p));
|
|
snd_printd(" periods %d\n", params_periods(p));
|
|
snd_printd(" buffer_size %d\n", params_buffer_size(p));
|
|
snd_printd(" %d B/s\n", params_rate(p) *
|
|
params_channels(p) *
|
|
snd_pcm_format_width(params_format(p)) / 8);
|
|
|
|
}
|
|
|
|
static snd_pcm_format_t hpi_to_alsa_formats[] = {
|
|
-1, /* INVALID */
|
|
SNDRV_PCM_FORMAT_U8, /* HPI_FORMAT_PCM8_UNSIGNED 1 */
|
|
SNDRV_PCM_FORMAT_S16, /* HPI_FORMAT_PCM16_SIGNED 2 */
|
|
-1, /* HPI_FORMAT_MPEG_L1 3 */
|
|
SNDRV_PCM_FORMAT_MPEG, /* HPI_FORMAT_MPEG_L2 4 */
|
|
SNDRV_PCM_FORMAT_MPEG, /* HPI_FORMAT_MPEG_L3 5 */
|
|
-1, /* HPI_FORMAT_DOLBY_AC2 6 */
|
|
-1, /* HPI_FORMAT_DOLBY_AC3 7 */
|
|
SNDRV_PCM_FORMAT_S16_BE,/* HPI_FORMAT_PCM16_BIGENDIAN 8 */
|
|
-1, /* HPI_FORMAT_AA_TAGIT1_HITS 9 */
|
|
-1, /* HPI_FORMAT_AA_TAGIT1_INSERTS 10 */
|
|
SNDRV_PCM_FORMAT_S32, /* HPI_FORMAT_PCM32_SIGNED 11 */
|
|
-1, /* HPI_FORMAT_RAW_BITSTREAM 12 */
|
|
-1, /* HPI_FORMAT_AA_TAGIT1_HITS_EX1 13 */
|
|
SNDRV_PCM_FORMAT_FLOAT, /* HPI_FORMAT_PCM32_FLOAT 14 */
|
|
#if 1
|
|
/* ALSA can't handle 3 byte sample size together with power-of-2
|
|
* constraint on buffer_bytes, so disable this format
|
|
*/
|
|
-1
|
|
#else
|
|
/* SNDRV_PCM_FORMAT_S24_3LE */ /* HPI_FORMAT_PCM24_SIGNED 15 */
|
|
#endif
|
|
};
|
|
|
|
|
|
static int snd_card_asihpi_format_alsa2hpi(snd_pcm_format_t alsa_format,
|
|
u16 *hpi_format)
|
|
{
|
|
u16 format;
|
|
|
|
for (format = HPI_FORMAT_PCM8_UNSIGNED;
|
|
format <= HPI_FORMAT_PCM24_SIGNED; format++) {
|
|
if (hpi_to_alsa_formats[format] == alsa_format) {
|
|
*hpi_format = format;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
snd_printd(KERN_WARNING "failed match for alsa format %d\n",
|
|
alsa_format);
|
|
*hpi_format = 0;
|
|
return -EINVAL;
|
|
}
|
|
|
|
static void snd_card_asihpi_pcm_samplerates(struct snd_card_asihpi *asihpi,
|
|
struct snd_pcm_hardware *pcmhw)
|
|
{
|
|
u16 err;
|
|
u32 h_control;
|
|
u32 sample_rate;
|
|
int idx;
|
|
unsigned int rate_min = 200000;
|
|
unsigned int rate_max = 0;
|
|
unsigned int rates = 0;
|
|
|
|
if (asihpi->support_mrx) {
|
|
rates |= SNDRV_PCM_RATE_CONTINUOUS;
|
|
rates |= SNDRV_PCM_RATE_8000_96000;
|
|
rate_min = 8000;
|
|
rate_max = 100000;
|
|
} else {
|
|
/* on cards without SRC,
|
|
valid rates are determined by sampleclock */
|
|
err = hpi_mixer_get_control(asihpi->h_mixer,
|
|
HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
|
|
HPI_CONTROL_SAMPLECLOCK, &h_control);
|
|
if (err) {
|
|
snd_printk(KERN_ERR
|
|
"No local sampleclock, err %d\n", err);
|
|
}
|
|
|
|
for (idx = -1; idx < 100; idx++) {
|
|
if (idx == -1) {
|
|
if (hpi_sample_clock_get_sample_rate(h_control,
|
|
&sample_rate))
|
|
continue;
|
|
} else if (hpi_sample_clock_query_local_rate(h_control,
|
|
idx, &sample_rate)) {
|
|
break;
|
|
}
|
|
|
|
rate_min = min(rate_min, sample_rate);
|
|
rate_max = max(rate_max, sample_rate);
|
|
|
|
switch (sample_rate) {
|
|
case 5512:
|
|
rates |= SNDRV_PCM_RATE_5512;
|
|
break;
|
|
case 8000:
|
|
rates |= SNDRV_PCM_RATE_8000;
|
|
break;
|
|
case 11025:
|
|
rates |= SNDRV_PCM_RATE_11025;
|
|
break;
|
|
case 16000:
|
|
rates |= SNDRV_PCM_RATE_16000;
|
|
break;
|
|
case 22050:
|
|
rates |= SNDRV_PCM_RATE_22050;
|
|
break;
|
|
case 32000:
|
|
rates |= SNDRV_PCM_RATE_32000;
|
|
break;
|
|
case 44100:
|
|
rates |= SNDRV_PCM_RATE_44100;
|
|
break;
|
|
case 48000:
|
|
rates |= SNDRV_PCM_RATE_48000;
|
|
break;
|
|
case 64000:
|
|
rates |= SNDRV_PCM_RATE_64000;
|
|
break;
|
|
case 88200:
|
|
rates |= SNDRV_PCM_RATE_88200;
|
|
break;
|
|
case 96000:
|
|
rates |= SNDRV_PCM_RATE_96000;
|
|
break;
|
|
case 176400:
|
|
rates |= SNDRV_PCM_RATE_176400;
|
|
break;
|
|
case 192000:
|
|
rates |= SNDRV_PCM_RATE_192000;
|
|
break;
|
|
default: /* some other rate */
|
|
rates |= SNDRV_PCM_RATE_KNOT;
|
|
}
|
|
}
|
|
}
|
|
|
|
pcmhw->rates = rates;
|
|
pcmhw->rate_min = rate_min;
|
|
pcmhw->rate_max = rate_max;
|
|
}
|
|
|
|
static int snd_card_asihpi_pcm_hw_params(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *params)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
|
|
struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
|
|
int err;
|
|
u16 format;
|
|
int width;
|
|
unsigned int bytes_per_sec;
|
|
|
|
print_hwparams(substream, params);
|
|
err = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
|
|
if (err < 0)
|
|
return err;
|
|
err = snd_card_asihpi_format_alsa2hpi(params_format(params), &format);
|
|
if (err)
|
|
return err;
|
|
|
|
hpi_handle_error(hpi_format_create(&dpcm->format,
|
|
params_channels(params),
|
|
format, params_rate(params), 0, 0));
|
|
|
|
if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
|
|
if (hpi_instream_reset(dpcm->h_stream) != 0)
|
|
return -EINVAL;
|
|
|
|
if (hpi_instream_set_format(
|
|
dpcm->h_stream, &dpcm->format) != 0)
|
|
return -EINVAL;
|
|
}
|
|
|
|
dpcm->hpi_buffer_attached = 0;
|
|
if (card->can_dma) {
|
|
err = hpi_stream_host_buffer_attach(dpcm->h_stream,
|
|
params_buffer_bytes(params), runtime->dma_addr);
|
|
if (err == 0) {
|
|
snd_printdd(
|
|
"stream_host_buffer_attach succeeded %u %lu\n",
|
|
params_buffer_bytes(params),
|
|
(unsigned long)runtime->dma_addr);
|
|
} else {
|
|
snd_printd("stream_host_buffer_attach error %d\n",
|
|
err);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
err = hpi_stream_get_info_ex(dpcm->h_stream, NULL,
|
|
&dpcm->hpi_buffer_attached,
|
|
NULL, NULL, NULL);
|
|
|
|
snd_printdd("stream_host_buffer_attach status 0x%x\n",
|
|
dpcm->hpi_buffer_attached);
|
|
|
|
}
|
|
bytes_per_sec = params_rate(params) * params_channels(params);
|
|
width = snd_pcm_format_width(params_format(params));
|
|
bytes_per_sec *= width;
|
|
bytes_per_sec /= 8;
|
|
if (width < 0 || bytes_per_sec == 0)
|
|
return -EINVAL;
|
|
|
|
dpcm->bytes_per_sec = bytes_per_sec;
|
|
dpcm->buffer_bytes = params_buffer_bytes(params);
|
|
dpcm->period_bytes = params_period_bytes(params);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
snd_card_asihpi_hw_free(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
|
|
if (dpcm->hpi_buffer_attached)
|
|
hpi_stream_host_buffer_detach(dpcm->h_stream);
|
|
|
|
snd_pcm_lib_free_pages(substream);
|
|
return 0;
|
|
}
|
|
|
|
static void snd_card_asihpi_runtime_free(struct snd_pcm_runtime *runtime)
|
|
{
|
|
struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
|
|
kfree(dpcm);
|
|
}
|
|
|
|
static void snd_card_asihpi_pcm_timer_start(struct snd_pcm_substream *
|
|
substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
|
|
int expiry;
|
|
|
|
expiry = HZ / 200;
|
|
/*? (dpcm->period_bytes * HZ / dpcm->bytes_per_sec); */
|
|
expiry = max(expiry, 1); /* don't let it be zero! */
|
|
dpcm->timer.expires = jiffies + expiry;
|
|
dpcm->respawn_timer = 1;
|
|
add_timer(&dpcm->timer);
|
|
}
|
|
|
|
static void snd_card_asihpi_pcm_timer_stop(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
|
|
|
|
dpcm->respawn_timer = 0;
|
|
del_timer(&dpcm->timer);
|
|
}
|
|
|
|
static int snd_card_asihpi_trigger(struct snd_pcm_substream *substream,
|
|
int cmd)
|
|
{
|
|
struct snd_card_asihpi_pcm *dpcm = substream->runtime->private_data;
|
|
struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
|
|
struct snd_pcm_substream *s;
|
|
u16 e;
|
|
char name[16];
|
|
|
|
snd_pcm_debug_name(substream, name, sizeof(name));
|
|
snd_printdd("%s trigger\n", name);
|
|
|
|
switch (cmd) {
|
|
case SNDRV_PCM_TRIGGER_START:
|
|
snd_pcm_group_for_each_entry(s, substream) {
|
|
struct snd_pcm_runtime *runtime = s->runtime;
|
|
struct snd_card_asihpi_pcm *ds = runtime->private_data;
|
|
|
|
if (snd_pcm_substream_chip(s) != card)
|
|
continue;
|
|
|
|
/* don't link Cap and Play */
|
|
if (substream->stream != s->stream)
|
|
continue;
|
|
|
|
ds->drained_count = 0;
|
|
if (s->stream == SNDRV_PCM_STREAM_PLAYBACK) {
|
|
/* How do I know how much valid data is present
|
|
* in buffer? Must be at least one period!
|
|
* Guessing 2 periods, but if
|
|
* buffer is bigger it may contain even more
|
|
* data??
|
|
*/
|
|
unsigned int preload = ds->period_bytes * 1;
|
|
snd_printddd("%d preload x%x\n", s->number, preload);
|
|
hpi_handle_error(hpi_outstream_write_buf(
|
|
ds->h_stream,
|
|
&runtime->dma_area[0],
|
|
preload,
|
|
&ds->format));
|
|
ds->pcm_buf_host_rw_ofs = preload;
|
|
}
|
|
|
|
if (card->support_grouping) {
|
|
snd_printdd("%d group\n", s->number);
|
|
e = hpi_stream_group_add(
|
|
dpcm->h_stream,
|
|
ds->h_stream);
|
|
if (!e) {
|
|
snd_pcm_trigger_done(s, substream);
|
|
} else {
|
|
hpi_handle_error(e);
|
|
break;
|
|
}
|
|
} else
|
|
break;
|
|
}
|
|
snd_printdd("start\n");
|
|
/* start the master stream */
|
|
snd_card_asihpi_pcm_timer_start(substream);
|
|
if ((substream->stream == SNDRV_PCM_STREAM_CAPTURE) ||
|
|
!card->can_dma)
|
|
hpi_handle_error(hpi_stream_start(dpcm->h_stream));
|
|
break;
|
|
|
|
case SNDRV_PCM_TRIGGER_STOP:
|
|
snd_card_asihpi_pcm_timer_stop(substream);
|
|
snd_pcm_group_for_each_entry(s, substream) {
|
|
if (snd_pcm_substream_chip(s) != card)
|
|
continue;
|
|
/* don't link Cap and Play */
|
|
if (substream->stream != s->stream)
|
|
continue;
|
|
|
|
/*? workaround linked streams don't
|
|
transition to SETUP 20070706*/
|
|
s->runtime->status->state = SNDRV_PCM_STATE_SETUP;
|
|
|
|
if (card->support_grouping) {
|
|
snd_printdd("%d group\n", s->number);
|
|
snd_pcm_trigger_done(s, substream);
|
|
} else
|
|
break;
|
|
}
|
|
snd_printdd("stop\n");
|
|
|
|
/* _prepare and _hwparams reset the stream */
|
|
hpi_handle_error(hpi_stream_stop(dpcm->h_stream));
|
|
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
|
|
hpi_handle_error(
|
|
hpi_outstream_reset(dpcm->h_stream));
|
|
|
|
if (card->support_grouping)
|
|
hpi_handle_error(hpi_stream_group_reset(dpcm->h_stream));
|
|
break;
|
|
|
|
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
|
|
snd_printdd("pause release\n");
|
|
hpi_handle_error(hpi_stream_start(dpcm->h_stream));
|
|
snd_card_asihpi_pcm_timer_start(substream);
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
|
|
snd_printdd("pause\n");
|
|
snd_card_asihpi_pcm_timer_stop(substream);
|
|
hpi_handle_error(hpi_stream_stop(dpcm->h_stream));
|
|
break;
|
|
default:
|
|
snd_printd(KERN_ERR "\tINVALID\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*algorithm outline
|
|
Without linking degenerates to getting single stream pos etc
|
|
Without mmap 2nd loop degenerates to snd_pcm_period_elapsed
|
|
*/
|
|
/*
|
|
pcm_buf_dma_ofs=get_buf_pos(s);
|
|
for_each_linked_stream(s) {
|
|
pcm_buf_dma_ofs=get_buf_pos(s);
|
|
min_buf_pos = modulo_min(min_buf_pos, pcm_buf_dma_ofs, buffer_bytes)
|
|
new_data = min(new_data, calc_new_data(pcm_buf_dma_ofs,irq_pos)
|
|
}
|
|
timer.expires = jiffies + predict_next_period_ready(min_buf_pos);
|
|
for_each_linked_stream(s) {
|
|
s->pcm_buf_dma_ofs = min_buf_pos;
|
|
if (new_data > period_bytes) {
|
|
if (mmap) {
|
|
irq_pos = (irq_pos + period_bytes) % buffer_bytes;
|
|
if (playback) {
|
|
write(period_bytes);
|
|
} else {
|
|
read(period_bytes);
|
|
}
|
|
}
|
|
snd_pcm_period_elapsed(s);
|
|
}
|
|
}
|
|
*/
|
|
|
|
/** Minimum of 2 modulo values. Works correctly when the difference between
|
|
* the values is less than half the modulus
|
|
*/
|
|
static inline unsigned int modulo_min(unsigned int a, unsigned int b,
|
|
unsigned long int modulus)
|
|
{
|
|
unsigned int result;
|
|
if (((a-b) % modulus) < (modulus/2))
|
|
result = b;
|
|
else
|
|
result = a;
|
|
|
|
return result;
|
|
}
|
|
|
|
/** Timer function, equivalent to interrupt service routine for cards
|
|
*/
|
|
static void snd_card_asihpi_timer_function(unsigned long data)
|
|
{
|
|
struct snd_card_asihpi_pcm *dpcm = (struct snd_card_asihpi_pcm *)data;
|
|
struct snd_pcm_substream *substream = dpcm->substream;
|
|
struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
|
|
struct snd_pcm_runtime *runtime;
|
|
struct snd_pcm_substream *s;
|
|
unsigned int newdata = 0;
|
|
unsigned int pcm_buf_dma_ofs, min_buf_pos = 0;
|
|
unsigned int remdata, xfercount, next_jiffies;
|
|
int first = 1;
|
|
int loops = 0;
|
|
u16 state;
|
|
u32 buffer_size, bytes_avail, samples_played, on_card_bytes;
|
|
char name[16];
|
|
|
|
snd_pcm_debug_name(substream, name, sizeof(name));
|
|
|
|
snd_printdd("%s snd_card_asihpi_timer_function\n", name);
|
|
|
|
/* find minimum newdata and buffer pos in group */
|
|
snd_pcm_group_for_each_entry(s, substream) {
|
|
struct snd_card_asihpi_pcm *ds = s->runtime->private_data;
|
|
runtime = s->runtime;
|
|
|
|
if (snd_pcm_substream_chip(s) != card)
|
|
continue;
|
|
|
|
/* don't link Cap and Play */
|
|
if (substream->stream != s->stream)
|
|
continue;
|
|
|
|
hpi_handle_error(hpi_stream_get_info_ex(
|
|
ds->h_stream, &state,
|
|
&buffer_size, &bytes_avail,
|
|
&samples_played, &on_card_bytes));
|
|
|
|
/* number of bytes in on-card buffer */
|
|
runtime->delay = on_card_bytes;
|
|
|
|
if (!card->can_dma)
|
|
on_card_bytes = bytes_avail;
|
|
|
|
if (s->stream == SNDRV_PCM_STREAM_PLAYBACK) {
|
|
pcm_buf_dma_ofs = ds->pcm_buf_host_rw_ofs - bytes_avail;
|
|
if (state == HPI_STATE_STOPPED) {
|
|
if (bytes_avail == 0) {
|
|
hpi_handle_error(hpi_stream_start(ds->h_stream));
|
|
snd_printdd("P%d start\n", s->number);
|
|
ds->drained_count = 0;
|
|
}
|
|
} else if (state == HPI_STATE_DRAINED) {
|
|
snd_printd(KERN_WARNING "P%d drained\n",
|
|
s->number);
|
|
ds->drained_count++;
|
|
if (ds->drained_count > 20) {
|
|
snd_pcm_stop(s, SNDRV_PCM_STATE_XRUN);
|
|
continue;
|
|
}
|
|
} else {
|
|
ds->drained_count = 0;
|
|
}
|
|
} else
|
|
pcm_buf_dma_ofs = bytes_avail + ds->pcm_buf_host_rw_ofs;
|
|
|
|
if (first) {
|
|
/* can't statically init min when wrap is involved */
|
|
min_buf_pos = pcm_buf_dma_ofs;
|
|
newdata = (pcm_buf_dma_ofs - ds->pcm_buf_elapsed_dma_ofs) % ds->buffer_bytes;
|
|
first = 0;
|
|
} else {
|
|
min_buf_pos =
|
|
modulo_min(min_buf_pos, pcm_buf_dma_ofs, UINT_MAX+1L);
|
|
newdata = min(
|
|
(pcm_buf_dma_ofs - ds->pcm_buf_elapsed_dma_ofs) % ds->buffer_bytes,
|
|
newdata);
|
|
}
|
|
|
|
snd_printdd("hw_ptr 0x%04lX, appl_ptr 0x%04lX\n",
|
|
(unsigned long)frames_to_bytes(runtime,
|
|
runtime->status->hw_ptr),
|
|
(unsigned long)frames_to_bytes(runtime,
|
|
runtime->control->appl_ptr));
|
|
|
|
snd_printdd("%d S=%d, "
|
|
"rw=0x%04X, dma=0x%04X, left=0x%04X, "
|
|
"aux=0x%04X space=0x%04X\n",
|
|
s->number, state,
|
|
ds->pcm_buf_host_rw_ofs, pcm_buf_dma_ofs,
|
|
(int)bytes_avail,
|
|
(int)on_card_bytes, buffer_size-bytes_avail);
|
|
loops++;
|
|
}
|
|
pcm_buf_dma_ofs = min_buf_pos;
|
|
|
|
remdata = newdata % dpcm->period_bytes;
|
|
xfercount = newdata - remdata; /* a multiple of period_bytes */
|
|
/* come back when on_card_bytes has decreased enough to allow
|
|
write to happen, or when data has been consumed to make another
|
|
period
|
|
*/
|
|
if (xfercount && (on_card_bytes > dpcm->period_bytes))
|
|
next_jiffies = ((on_card_bytes - dpcm->period_bytes) * HZ / dpcm->bytes_per_sec);
|
|
else
|
|
next_jiffies = ((dpcm->period_bytes - remdata) * HZ / dpcm->bytes_per_sec);
|
|
|
|
next_jiffies = max(next_jiffies, 1U);
|
|
dpcm->timer.expires = jiffies + next_jiffies;
|
|
snd_printdd("jif %d buf pos 0x%04X newdata 0x%04X xfer 0x%04X\n",
|
|
next_jiffies, pcm_buf_dma_ofs, newdata, xfercount);
|
|
|
|
snd_pcm_group_for_each_entry(s, substream) {
|
|
struct snd_card_asihpi_pcm *ds = s->runtime->private_data;
|
|
|
|
/* don't link Cap and Play */
|
|
if (substream->stream != s->stream)
|
|
continue;
|
|
|
|
ds->pcm_buf_dma_ofs = pcm_buf_dma_ofs;
|
|
|
|
if (xfercount &&
|
|
/* Limit use of on card fifo for playback */
|
|
((on_card_bytes <= ds->period_bytes) ||
|
|
(s->stream == SNDRV_PCM_STREAM_CAPTURE)))
|
|
|
|
{
|
|
|
|
unsigned int buf_ofs = ds->pcm_buf_host_rw_ofs % ds->buffer_bytes;
|
|
unsigned int xfer1, xfer2;
|
|
char *pd = &s->runtime->dma_area[buf_ofs];
|
|
|
|
if (card->can_dma) { /* buffer wrap is handled at lower level */
|
|
xfer1 = xfercount;
|
|
xfer2 = 0;
|
|
} else {
|
|
xfer1 = min(xfercount, ds->buffer_bytes - buf_ofs);
|
|
xfer2 = xfercount - xfer1;
|
|
}
|
|
|
|
if (s->stream == SNDRV_PCM_STREAM_PLAYBACK) {
|
|
snd_printddd("P%d write1 0x%04X 0x%04X\n",
|
|
s->number, xfer1, buf_ofs);
|
|
hpi_handle_error(
|
|
hpi_outstream_write_buf(
|
|
ds->h_stream, pd, xfer1,
|
|
&ds->format));
|
|
|
|
if (xfer2) {
|
|
pd = s->runtime->dma_area;
|
|
|
|
snd_printddd("P%d write2 0x%04X 0x%04X\n",
|
|
s->number,
|
|
xfercount - xfer1, buf_ofs);
|
|
hpi_handle_error(
|
|
hpi_outstream_write_buf(
|
|
ds->h_stream, pd,
|
|
xfercount - xfer1,
|
|
&ds->format));
|
|
}
|
|
} else {
|
|
snd_printddd("C%d read1 0x%04x\n",
|
|
s->number, xfer1);
|
|
hpi_handle_error(
|
|
hpi_instream_read_buf(
|
|
ds->h_stream,
|
|
pd, xfer1));
|
|
if (xfer2) {
|
|
pd = s->runtime->dma_area;
|
|
snd_printddd("C%d read2 0x%04x\n",
|
|
s->number, xfer2);
|
|
hpi_handle_error(
|
|
hpi_instream_read_buf(
|
|
ds->h_stream,
|
|
pd, xfer2));
|
|
}
|
|
}
|
|
ds->pcm_buf_host_rw_ofs += xfercount;
|
|
ds->pcm_buf_elapsed_dma_ofs += xfercount;
|
|
snd_pcm_period_elapsed(s);
|
|
}
|
|
}
|
|
|
|
if (dpcm->respawn_timer)
|
|
add_timer(&dpcm->timer);
|
|
}
|
|
|
|
/***************************** PLAYBACK OPS ****************/
|
|
static int snd_card_asihpi_playback_ioctl(struct snd_pcm_substream *substream,
|
|
unsigned int cmd, void *arg)
|
|
{
|
|
char name[16];
|
|
snd_pcm_debug_name(substream, name, sizeof(name));
|
|
snd_printddd(KERN_INFO "%s ioctl %d\n", name, cmd);
|
|
return snd_pcm_lib_ioctl(substream, cmd, arg);
|
|
}
|
|
|
|
static int snd_card_asihpi_playback_prepare(struct snd_pcm_substream *
|
|
substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
|
|
|
|
snd_printdd("P%d prepare\n", substream->number);
|
|
|
|
hpi_handle_error(hpi_outstream_reset(dpcm->h_stream));
|
|
dpcm->pcm_buf_host_rw_ofs = 0;
|
|
dpcm->pcm_buf_dma_ofs = 0;
|
|
dpcm->pcm_buf_elapsed_dma_ofs = 0;
|
|
return 0;
|
|
}
|
|
|
|
static snd_pcm_uframes_t
|
|
snd_card_asihpi_playback_pointer(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
|
|
snd_pcm_uframes_t ptr;
|
|
char name[16];
|
|
snd_pcm_debug_name(substream, name, sizeof(name));
|
|
|
|
ptr = bytes_to_frames(runtime, dpcm->pcm_buf_dma_ofs % dpcm->buffer_bytes);
|
|
snd_printddd("%s pointer = 0x%04lx\n", name, (unsigned long)ptr);
|
|
return ptr;
|
|
}
|
|
|
|
static u64 snd_card_asihpi_playback_formats(struct snd_card_asihpi *asihpi,
|
|
u32 h_stream)
|
|
{
|
|
struct hpi_format hpi_format;
|
|
u16 format;
|
|
u16 err;
|
|
u32 h_control;
|
|
u32 sample_rate = 48000;
|
|
u64 formats = 0;
|
|
|
|
/* on cards without SRC, must query at valid rate,
|
|
* maybe set by external sync
|
|
*/
|
|
err = hpi_mixer_get_control(asihpi->h_mixer,
|
|
HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
|
|
HPI_CONTROL_SAMPLECLOCK, &h_control);
|
|
|
|
if (!err)
|
|
err = hpi_sample_clock_get_sample_rate(h_control,
|
|
&sample_rate);
|
|
|
|
for (format = HPI_FORMAT_PCM8_UNSIGNED;
|
|
format <= HPI_FORMAT_PCM24_SIGNED; format++) {
|
|
err = hpi_format_create(&hpi_format, asihpi->out_max_chans,
|
|
format, sample_rate, 128000, 0);
|
|
if (!err)
|
|
err = hpi_outstream_query_format(h_stream, &hpi_format);
|
|
if (!err && (hpi_to_alsa_formats[format] != -1))
|
|
formats |= (1ULL << hpi_to_alsa_formats[format]);
|
|
}
|
|
return formats;
|
|
}
|
|
|
|
static int snd_card_asihpi_playback_open(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi_pcm *dpcm;
|
|
struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
|
|
struct snd_pcm_hardware snd_card_asihpi_playback;
|
|
int err;
|
|
|
|
dpcm = kzalloc(sizeof(*dpcm), GFP_KERNEL);
|
|
if (dpcm == NULL)
|
|
return -ENOMEM;
|
|
|
|
err = hpi_outstream_open(card->hpi->adapter->index,
|
|
substream->number, &dpcm->h_stream);
|
|
hpi_handle_error(err);
|
|
if (err)
|
|
kfree(dpcm);
|
|
if (err == HPI_ERROR_OBJ_ALREADY_OPEN)
|
|
return -EBUSY;
|
|
if (err)
|
|
return -EIO;
|
|
|
|
/*? also check ASI5000 samplerate source
|
|
If external, only support external rate.
|
|
If internal and other stream playing, can't switch
|
|
*/
|
|
|
|
init_timer(&dpcm->timer);
|
|
dpcm->timer.data = (unsigned long) dpcm;
|
|
dpcm->timer.function = snd_card_asihpi_timer_function;
|
|
dpcm->substream = substream;
|
|
runtime->private_data = dpcm;
|
|
runtime->private_free = snd_card_asihpi_runtime_free;
|
|
|
|
memset(&snd_card_asihpi_playback, 0, sizeof(snd_card_asihpi_playback));
|
|
snd_card_asihpi_playback.buffer_bytes_max = BUFFER_BYTES_MAX;
|
|
snd_card_asihpi_playback.period_bytes_min = PERIOD_BYTES_MIN;
|
|
/*?snd_card_asihpi_playback.period_bytes_min =
|
|
card->out_max_chans * 4096; */
|
|
snd_card_asihpi_playback.period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN;
|
|
snd_card_asihpi_playback.periods_min = PERIODS_MIN;
|
|
snd_card_asihpi_playback.periods_max = BUFFER_BYTES_MAX / PERIOD_BYTES_MIN;
|
|
/* snd_card_asihpi_playback.fifo_size = 0; */
|
|
snd_card_asihpi_playback.channels_max = card->out_max_chans;
|
|
snd_card_asihpi_playback.channels_min = card->out_min_chans;
|
|
snd_card_asihpi_playback.formats =
|
|
snd_card_asihpi_playback_formats(card, dpcm->h_stream);
|
|
|
|
snd_card_asihpi_pcm_samplerates(card, &snd_card_asihpi_playback);
|
|
|
|
snd_card_asihpi_playback.info = SNDRV_PCM_INFO_INTERLEAVED |
|
|
SNDRV_PCM_INFO_DOUBLE |
|
|
SNDRV_PCM_INFO_BATCH |
|
|
SNDRV_PCM_INFO_BLOCK_TRANSFER |
|
|
SNDRV_PCM_INFO_PAUSE |
|
|
SNDRV_PCM_INFO_MMAP |
|
|
SNDRV_PCM_INFO_MMAP_VALID;
|
|
|
|
if (card->support_grouping) {
|
|
snd_card_asihpi_playback.info |= SNDRV_PCM_INFO_SYNC_START;
|
|
snd_pcm_set_sync(substream);
|
|
}
|
|
|
|
/* struct is copied, so can create initializer dynamically */
|
|
runtime->hw = snd_card_asihpi_playback;
|
|
|
|
if (card->can_dma)
|
|
err = snd_pcm_hw_constraint_pow2(runtime, 0,
|
|
SNDRV_PCM_HW_PARAM_BUFFER_BYTES);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
|
|
card->update_interval_frames);
|
|
|
|
snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
|
|
card->update_interval_frames * 2, UINT_MAX);
|
|
|
|
snd_printdd("playback open\n");
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_card_asihpi_playback_close(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
|
|
|
|
hpi_handle_error(hpi_outstream_close(dpcm->h_stream));
|
|
snd_printdd("playback close\n");
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct snd_pcm_ops snd_card_asihpi_playback_mmap_ops = {
|
|
.open = snd_card_asihpi_playback_open,
|
|
.close = snd_card_asihpi_playback_close,
|
|
.ioctl = snd_card_asihpi_playback_ioctl,
|
|
.hw_params = snd_card_asihpi_pcm_hw_params,
|
|
.hw_free = snd_card_asihpi_hw_free,
|
|
.prepare = snd_card_asihpi_playback_prepare,
|
|
.trigger = snd_card_asihpi_trigger,
|
|
.pointer = snd_card_asihpi_playback_pointer,
|
|
};
|
|
|
|
/***************************** CAPTURE OPS ****************/
|
|
static snd_pcm_uframes_t
|
|
snd_card_asihpi_capture_pointer(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
|
|
|
|
snd_printddd("capture pointer %d=%d\n",
|
|
substream->number, dpcm->pcm_buf_dma_ofs);
|
|
/* NOTE Unlike playback can't use actual samples_played
|
|
for the capture position, because those samples aren't yet in
|
|
the local buffer available for reading.
|
|
*/
|
|
return bytes_to_frames(runtime, dpcm->pcm_buf_dma_ofs % dpcm->buffer_bytes);
|
|
}
|
|
|
|
static int snd_card_asihpi_capture_ioctl(struct snd_pcm_substream *substream,
|
|
unsigned int cmd, void *arg)
|
|
{
|
|
return snd_pcm_lib_ioctl(substream, cmd, arg);
|
|
}
|
|
|
|
static int snd_card_asihpi_capture_prepare(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
|
|
|
|
hpi_handle_error(hpi_instream_reset(dpcm->h_stream));
|
|
dpcm->pcm_buf_host_rw_ofs = 0;
|
|
dpcm->pcm_buf_dma_ofs = 0;
|
|
dpcm->pcm_buf_elapsed_dma_ofs = 0;
|
|
|
|
snd_printdd("Capture Prepare %d\n", substream->number);
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static u64 snd_card_asihpi_capture_formats(struct snd_card_asihpi *asihpi,
|
|
u32 h_stream)
|
|
{
|
|
struct hpi_format hpi_format;
|
|
u16 format;
|
|
u16 err;
|
|
u32 h_control;
|
|
u32 sample_rate = 48000;
|
|
u64 formats = 0;
|
|
|
|
/* on cards without SRC, must query at valid rate,
|
|
maybe set by external sync */
|
|
err = hpi_mixer_get_control(asihpi->h_mixer,
|
|
HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
|
|
HPI_CONTROL_SAMPLECLOCK, &h_control);
|
|
|
|
if (!err)
|
|
err = hpi_sample_clock_get_sample_rate(h_control,
|
|
&sample_rate);
|
|
|
|
for (format = HPI_FORMAT_PCM8_UNSIGNED;
|
|
format <= HPI_FORMAT_PCM24_SIGNED; format++) {
|
|
|
|
err = hpi_format_create(&hpi_format, asihpi->in_max_chans,
|
|
format, sample_rate, 128000, 0);
|
|
if (!err)
|
|
err = hpi_instream_query_format(h_stream, &hpi_format);
|
|
if (!err)
|
|
formats |= (1ULL << hpi_to_alsa_formats[format]);
|
|
}
|
|
return formats;
|
|
}
|
|
|
|
static int snd_card_asihpi_capture_open(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
|
|
struct snd_card_asihpi_pcm *dpcm;
|
|
struct snd_pcm_hardware snd_card_asihpi_capture;
|
|
int err;
|
|
|
|
dpcm = kzalloc(sizeof(*dpcm), GFP_KERNEL);
|
|
if (dpcm == NULL)
|
|
return -ENOMEM;
|
|
|
|
snd_printdd("capture open adapter %d stream %d\n",
|
|
card->hpi->adapter->index, substream->number);
|
|
|
|
err = hpi_handle_error(
|
|
hpi_instream_open(card->hpi->adapter->index,
|
|
substream->number, &dpcm->h_stream));
|
|
if (err)
|
|
kfree(dpcm);
|
|
if (err == HPI_ERROR_OBJ_ALREADY_OPEN)
|
|
return -EBUSY;
|
|
if (err)
|
|
return -EIO;
|
|
|
|
init_timer(&dpcm->timer);
|
|
dpcm->timer.data = (unsigned long) dpcm;
|
|
dpcm->timer.function = snd_card_asihpi_timer_function;
|
|
dpcm->substream = substream;
|
|
runtime->private_data = dpcm;
|
|
runtime->private_free = snd_card_asihpi_runtime_free;
|
|
|
|
memset(&snd_card_asihpi_capture, 0, sizeof(snd_card_asihpi_capture));
|
|
snd_card_asihpi_capture.buffer_bytes_max = BUFFER_BYTES_MAX;
|
|
snd_card_asihpi_capture.period_bytes_min = PERIOD_BYTES_MIN;
|
|
snd_card_asihpi_capture.period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN;
|
|
snd_card_asihpi_capture.periods_min = PERIODS_MIN;
|
|
snd_card_asihpi_capture.periods_max = BUFFER_BYTES_MAX / PERIOD_BYTES_MIN;
|
|
/* snd_card_asihpi_capture.fifo_size = 0; */
|
|
snd_card_asihpi_capture.channels_max = card->in_max_chans;
|
|
snd_card_asihpi_capture.channels_min = card->in_min_chans;
|
|
snd_card_asihpi_capture.formats =
|
|
snd_card_asihpi_capture_formats(card, dpcm->h_stream);
|
|
snd_card_asihpi_pcm_samplerates(card, &snd_card_asihpi_capture);
|
|
snd_card_asihpi_capture.info = SNDRV_PCM_INFO_INTERLEAVED |
|
|
SNDRV_PCM_INFO_MMAP |
|
|
SNDRV_PCM_INFO_MMAP_VALID;
|
|
|
|
if (card->support_grouping)
|
|
snd_card_asihpi_capture.info |= SNDRV_PCM_INFO_SYNC_START;
|
|
|
|
runtime->hw = snd_card_asihpi_capture;
|
|
|
|
if (card->can_dma)
|
|
err = snd_pcm_hw_constraint_pow2(runtime, 0,
|
|
SNDRV_PCM_HW_PARAM_BUFFER_BYTES);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
|
|
card->update_interval_frames);
|
|
snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
|
|
card->update_interval_frames * 2, UINT_MAX);
|
|
|
|
snd_pcm_set_sync(substream);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_card_asihpi_capture_close(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_card_asihpi_pcm *dpcm = substream->runtime->private_data;
|
|
|
|
hpi_handle_error(hpi_instream_close(dpcm->h_stream));
|
|
return 0;
|
|
}
|
|
|
|
static struct snd_pcm_ops snd_card_asihpi_capture_mmap_ops = {
|
|
.open = snd_card_asihpi_capture_open,
|
|
.close = snd_card_asihpi_capture_close,
|
|
.ioctl = snd_card_asihpi_capture_ioctl,
|
|
.hw_params = snd_card_asihpi_pcm_hw_params,
|
|
.hw_free = snd_card_asihpi_hw_free,
|
|
.prepare = snd_card_asihpi_capture_prepare,
|
|
.trigger = snd_card_asihpi_trigger,
|
|
.pointer = snd_card_asihpi_capture_pointer,
|
|
};
|
|
|
|
static int __devinit snd_card_asihpi_pcm_new(
|
|
struct snd_card_asihpi *asihpi, int device)
|
|
{
|
|
struct snd_pcm *pcm;
|
|
int err;
|
|
u16 num_instreams, num_outstreams, x16;
|
|
u32 x32;
|
|
|
|
err = hpi_adapter_get_info(asihpi->hpi->adapter->index,
|
|
&num_outstreams, &num_instreams,
|
|
&x16, &x32, &x16);
|
|
|
|
err = snd_pcm_new(asihpi->card, "Asihpi PCM", device,
|
|
num_outstreams, num_instreams, &pcm);
|
|
if (err < 0)
|
|
return err;
|
|
/* pointer to ops struct is stored, dont change ops afterwards! */
|
|
snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
|
|
&snd_card_asihpi_playback_mmap_ops);
|
|
snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
|
|
&snd_card_asihpi_capture_mmap_ops);
|
|
|
|
pcm->private_data = asihpi;
|
|
pcm->info_flags = 0;
|
|
strcpy(pcm->name, "Asihpi PCM");
|
|
|
|
/*? do we want to emulate MMAP for non-BBM cards?
|
|
Jack doesn't work with ALSAs MMAP emulation - WHY NOT? */
|
|
snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
|
|
snd_dma_pci_data(asihpi->pci),
|
|
64*1024, BUFFER_BYTES_MAX);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/***************************** MIXER CONTROLS ****************/
|
|
struct hpi_control {
|
|
u32 h_control;
|
|
u16 control_type;
|
|
u16 src_node_type;
|
|
u16 src_node_index;
|
|
u16 dst_node_type;
|
|
u16 dst_node_index;
|
|
u16 band;
|
|
char name[44]; /* copied to snd_ctl_elem_id.name[44]; */
|
|
};
|
|
|
|
static const char * const asihpi_tuner_band_names[] = {
|
|
"invalid",
|
|
"AM",
|
|
"FM mono",
|
|
"TV NTSC-M",
|
|
"FM stereo",
|
|
"AUX",
|
|
"TV PAL BG",
|
|
"TV PAL I",
|
|
"TV PAL DK",
|
|
"TV SECAM",
|
|
};
|
|
|
|
compile_time_assert(
|
|
(ARRAY_SIZE(asihpi_tuner_band_names) ==
|
|
(HPI_TUNER_BAND_LAST+1)),
|
|
assert_tuner_band_names_size);
|
|
|
|
static const char * const asihpi_src_names[] = {
|
|
"no source",
|
|
"PCM",
|
|
"Line",
|
|
"Digital",
|
|
"Tuner",
|
|
"RF",
|
|
"Clock",
|
|
"Bitstream",
|
|
"Mic",
|
|
"Net",
|
|
"Analog",
|
|
"Adapter",
|
|
"RTP",
|
|
"Internal"
|
|
};
|
|
|
|
compile_time_assert(
|
|
(ARRAY_SIZE(asihpi_src_names) ==
|
|
(HPI_SOURCENODE_LAST_INDEX-HPI_SOURCENODE_NONE+1)),
|
|
assert_src_names_size);
|
|
|
|
static const char * const asihpi_dst_names[] = {
|
|
"no destination",
|
|
"PCM",
|
|
"Line",
|
|
"Digital",
|
|
"RF",
|
|
"Speaker",
|
|
"Net",
|
|
"Analog",
|
|
"RTP",
|
|
};
|
|
|
|
compile_time_assert(
|
|
(ARRAY_SIZE(asihpi_dst_names) ==
|
|
(HPI_DESTNODE_LAST_INDEX-HPI_DESTNODE_NONE+1)),
|
|
assert_dst_names_size);
|
|
|
|
static inline int ctl_add(struct snd_card *card, struct snd_kcontrol_new *ctl,
|
|
struct snd_card_asihpi *asihpi)
|
|
{
|
|
int err;
|
|
|
|
err = snd_ctl_add(card, snd_ctl_new1(ctl, asihpi));
|
|
if (err < 0)
|
|
return err;
|
|
else if (mixer_dump)
|
|
snd_printk(KERN_INFO "added %s(%d)\n", ctl->name, ctl->index);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Convert HPI control name and location into ALSA control name */
|
|
static void asihpi_ctl_init(struct snd_kcontrol_new *snd_control,
|
|
struct hpi_control *hpi_ctl,
|
|
char *name)
|
|
{
|
|
char *dir;
|
|
memset(snd_control, 0, sizeof(*snd_control));
|
|
snd_control->name = hpi_ctl->name;
|
|
snd_control->private_value = hpi_ctl->h_control;
|
|
snd_control->iface = SNDRV_CTL_ELEM_IFACE_MIXER;
|
|
snd_control->index = 0;
|
|
|
|
if (hpi_ctl->src_node_type + HPI_SOURCENODE_NONE == HPI_SOURCENODE_CLOCK_SOURCE)
|
|
dir = ""; /* clock is neither capture nor playback */
|
|
else if (hpi_ctl->dst_node_type + HPI_DESTNODE_NONE == HPI_DESTNODE_ISTREAM)
|
|
dir = "Capture "; /* On or towards a PCM capture destination*/
|
|
else if ((hpi_ctl->src_node_type + HPI_SOURCENODE_NONE != HPI_SOURCENODE_OSTREAM) &&
|
|
(!hpi_ctl->dst_node_type))
|
|
dir = "Capture "; /* On a source node that is not PCM playback */
|
|
else if (hpi_ctl->src_node_type &&
|
|
(hpi_ctl->src_node_type + HPI_SOURCENODE_NONE != HPI_SOURCENODE_OSTREAM) &&
|
|
(hpi_ctl->dst_node_type))
|
|
dir = "Monitor Playback "; /* Between an input and an output */
|
|
else
|
|
dir = "Playback "; /* PCM Playback source, or output node */
|
|
|
|
if (hpi_ctl->src_node_type && hpi_ctl->dst_node_type)
|
|
sprintf(hpi_ctl->name, "%s %d %s %d %s%s",
|
|
asihpi_src_names[hpi_ctl->src_node_type],
|
|
hpi_ctl->src_node_index,
|
|
asihpi_dst_names[hpi_ctl->dst_node_type],
|
|
hpi_ctl->dst_node_index,
|
|
dir, name);
|
|
else if (hpi_ctl->dst_node_type) {
|
|
sprintf(hpi_ctl->name, "%s %d %s%s",
|
|
asihpi_dst_names[hpi_ctl->dst_node_type],
|
|
hpi_ctl->dst_node_index,
|
|
dir, name);
|
|
} else {
|
|
sprintf(hpi_ctl->name, "%s %d %s%s",
|
|
asihpi_src_names[hpi_ctl->src_node_type],
|
|
hpi_ctl->src_node_index,
|
|
dir, name);
|
|
}
|
|
/* printk(KERN_INFO "Adding %s %d to %d ", hpi_ctl->name,
|
|
hpi_ctl->wSrcNodeType, hpi_ctl->wDstNodeType); */
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
Volume controls
|
|
------------------------------------------------------------*/
|
|
#define VOL_STEP_mB 1
|
|
static int snd_asihpi_volume_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u32 count;
|
|
u16 err;
|
|
/* native gains are in millibels */
|
|
short min_gain_mB;
|
|
short max_gain_mB;
|
|
short step_gain_mB;
|
|
|
|
err = hpi_volume_query_range(h_control,
|
|
&min_gain_mB, &max_gain_mB, &step_gain_mB);
|
|
if (err) {
|
|
max_gain_mB = 0;
|
|
min_gain_mB = -10000;
|
|
step_gain_mB = VOL_STEP_mB;
|
|
}
|
|
|
|
err = hpi_meter_query_channels(h_control, &count);
|
|
if (err)
|
|
count = HPI_MAX_CHANNELS;
|
|
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
|
|
uinfo->count = count;
|
|
uinfo->value.integer.min = min_gain_mB / VOL_STEP_mB;
|
|
uinfo->value.integer.max = max_gain_mB / VOL_STEP_mB;
|
|
uinfo->value.integer.step = step_gain_mB / VOL_STEP_mB;
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_volume_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
short an_gain_mB[HPI_MAX_CHANNELS];
|
|
|
|
hpi_handle_error(hpi_volume_get_gain(h_control, an_gain_mB));
|
|
ucontrol->value.integer.value[0] = an_gain_mB[0] / VOL_STEP_mB;
|
|
ucontrol->value.integer.value[1] = an_gain_mB[1] / VOL_STEP_mB;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_volume_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
int change;
|
|
u32 h_control = kcontrol->private_value;
|
|
short an_gain_mB[HPI_MAX_CHANNELS];
|
|
|
|
an_gain_mB[0] =
|
|
(ucontrol->value.integer.value[0]) * VOL_STEP_mB;
|
|
an_gain_mB[1] =
|
|
(ucontrol->value.integer.value[1]) * VOL_STEP_mB;
|
|
/* change = asihpi->mixer_volume[addr][0] != left ||
|
|
asihpi->mixer_volume[addr][1] != right;
|
|
*/
|
|
change = 1;
|
|
hpi_handle_error(hpi_volume_set_gain(h_control, an_gain_mB));
|
|
return change;
|
|
}
|
|
|
|
static const DECLARE_TLV_DB_SCALE(db_scale_100, -10000, VOL_STEP_mB, 0);
|
|
|
|
#define snd_asihpi_volume_mute_info snd_ctl_boolean_mono_info
|
|
|
|
static int snd_asihpi_volume_mute_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u32 mute;
|
|
|
|
hpi_handle_error(hpi_volume_get_mute(h_control, &mute));
|
|
ucontrol->value.integer.value[0] = mute ? 0 : 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_volume_mute_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
int change = 1;
|
|
/* HPI currently only supports all or none muting of multichannel volume
|
|
ALSA Switch element has opposite sense to HPI mute: on==unmuted, off=muted
|
|
*/
|
|
int mute = ucontrol->value.integer.value[0] ? 0 : HPI_BITMASK_ALL_CHANNELS;
|
|
hpi_handle_error(hpi_volume_set_mute(h_control, mute));
|
|
return change;
|
|
}
|
|
|
|
static int __devinit snd_asihpi_volume_add(struct snd_card_asihpi *asihpi,
|
|
struct hpi_control *hpi_ctl)
|
|
{
|
|
struct snd_card *card = asihpi->card;
|
|
struct snd_kcontrol_new snd_control;
|
|
int err;
|
|
u32 mute;
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Volume");
|
|
snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE |
|
|
SNDRV_CTL_ELEM_ACCESS_TLV_READ;
|
|
snd_control.info = snd_asihpi_volume_info;
|
|
snd_control.get = snd_asihpi_volume_get;
|
|
snd_control.put = snd_asihpi_volume_put;
|
|
snd_control.tlv.p = db_scale_100;
|
|
|
|
err = ctl_add(card, &snd_control, asihpi);
|
|
if (err)
|
|
return err;
|
|
|
|
if (hpi_volume_get_mute(hpi_ctl->h_control, &mute) == 0) {
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Switch");
|
|
snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
|
|
snd_control.info = snd_asihpi_volume_mute_info;
|
|
snd_control.get = snd_asihpi_volume_mute_get;
|
|
snd_control.put = snd_asihpi_volume_mute_put;
|
|
err = ctl_add(card, &snd_control, asihpi);
|
|
}
|
|
return err;
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
Level controls
|
|
------------------------------------------------------------*/
|
|
static int snd_asihpi_level_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 err;
|
|
short min_gain_mB;
|
|
short max_gain_mB;
|
|
short step_gain_mB;
|
|
|
|
err =
|
|
hpi_level_query_range(h_control, &min_gain_mB,
|
|
&max_gain_mB, &step_gain_mB);
|
|
if (err) {
|
|
max_gain_mB = 2400;
|
|
min_gain_mB = -1000;
|
|
step_gain_mB = 100;
|
|
}
|
|
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
|
|
uinfo->count = 2;
|
|
uinfo->value.integer.min = min_gain_mB / HPI_UNITS_PER_dB;
|
|
uinfo->value.integer.max = max_gain_mB / HPI_UNITS_PER_dB;
|
|
uinfo->value.integer.step = step_gain_mB / HPI_UNITS_PER_dB;
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_level_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
short an_gain_mB[HPI_MAX_CHANNELS];
|
|
|
|
hpi_handle_error(hpi_level_get_gain(h_control, an_gain_mB));
|
|
ucontrol->value.integer.value[0] =
|
|
an_gain_mB[0] / HPI_UNITS_PER_dB;
|
|
ucontrol->value.integer.value[1] =
|
|
an_gain_mB[1] / HPI_UNITS_PER_dB;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_level_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
int change;
|
|
u32 h_control = kcontrol->private_value;
|
|
short an_gain_mB[HPI_MAX_CHANNELS];
|
|
|
|
an_gain_mB[0] =
|
|
(ucontrol->value.integer.value[0]) * HPI_UNITS_PER_dB;
|
|
an_gain_mB[1] =
|
|
(ucontrol->value.integer.value[1]) * HPI_UNITS_PER_dB;
|
|
/* change = asihpi->mixer_level[addr][0] != left ||
|
|
asihpi->mixer_level[addr][1] != right;
|
|
*/
|
|
change = 1;
|
|
hpi_handle_error(hpi_level_set_gain(h_control, an_gain_mB));
|
|
return change;
|
|
}
|
|
|
|
static const DECLARE_TLV_DB_SCALE(db_scale_level, -1000, 100, 0);
|
|
|
|
static int __devinit snd_asihpi_level_add(struct snd_card_asihpi *asihpi,
|
|
struct hpi_control *hpi_ctl)
|
|
{
|
|
struct snd_card *card = asihpi->card;
|
|
struct snd_kcontrol_new snd_control;
|
|
|
|
/* can't use 'volume' cos some nodes have volume as well */
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Level");
|
|
snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE |
|
|
SNDRV_CTL_ELEM_ACCESS_TLV_READ;
|
|
snd_control.info = snd_asihpi_level_info;
|
|
snd_control.get = snd_asihpi_level_get;
|
|
snd_control.put = snd_asihpi_level_put;
|
|
snd_control.tlv.p = db_scale_level;
|
|
|
|
return ctl_add(card, &snd_control, asihpi);
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
AESEBU controls
|
|
------------------------------------------------------------*/
|
|
|
|
/* AESEBU format */
|
|
static const char * const asihpi_aesebu_format_names[] = {
|
|
"N/A", "S/PDIF", "AES/EBU" };
|
|
|
|
static int snd_asihpi_aesebu_format_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
|
|
uinfo->count = 1;
|
|
uinfo->value.enumerated.items = 3;
|
|
|
|
if (uinfo->value.enumerated.item >= uinfo->value.enumerated.items)
|
|
uinfo->value.enumerated.item =
|
|
uinfo->value.enumerated.items - 1;
|
|
|
|
strcpy(uinfo->value.enumerated.name,
|
|
asihpi_aesebu_format_names[uinfo->value.enumerated.item]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_aesebu_format_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol,
|
|
u16 (*func)(u32, u16 *))
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 source, err;
|
|
|
|
err = func(h_control, &source);
|
|
|
|
/* default to N/A */
|
|
ucontrol->value.enumerated.item[0] = 0;
|
|
/* return success but set the control to N/A */
|
|
if (err)
|
|
return 0;
|
|
if (source == HPI_AESEBU_FORMAT_SPDIF)
|
|
ucontrol->value.enumerated.item[0] = 1;
|
|
if (source == HPI_AESEBU_FORMAT_AESEBU)
|
|
ucontrol->value.enumerated.item[0] = 2;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_aesebu_format_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol,
|
|
u16 (*func)(u32, u16))
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
|
|
/* default to S/PDIF */
|
|
u16 source = HPI_AESEBU_FORMAT_SPDIF;
|
|
|
|
if (ucontrol->value.enumerated.item[0] == 1)
|
|
source = HPI_AESEBU_FORMAT_SPDIF;
|
|
if (ucontrol->value.enumerated.item[0] == 2)
|
|
source = HPI_AESEBU_FORMAT_AESEBU;
|
|
|
|
if (func(h_control, source) != 0)
|
|
return -EINVAL;
|
|
|
|
return 1;
|
|
}
|
|
|
|
static int snd_asihpi_aesebu_rx_format_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol) {
|
|
return snd_asihpi_aesebu_format_get(kcontrol, ucontrol,
|
|
hpi_aesebu_receiver_get_format);
|
|
}
|
|
|
|
static int snd_asihpi_aesebu_rx_format_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol) {
|
|
return snd_asihpi_aesebu_format_put(kcontrol, ucontrol,
|
|
hpi_aesebu_receiver_set_format);
|
|
}
|
|
|
|
static int snd_asihpi_aesebu_rxstatus_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
|
|
uinfo->count = 1;
|
|
|
|
uinfo->value.integer.min = 0;
|
|
uinfo->value.integer.max = 0X1F;
|
|
uinfo->value.integer.step = 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_aesebu_rxstatus_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol) {
|
|
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 status;
|
|
|
|
hpi_handle_error(hpi_aesebu_receiver_get_error_status(
|
|
h_control, &status));
|
|
ucontrol->value.integer.value[0] = status;
|
|
return 0;
|
|
}
|
|
|
|
static int __devinit snd_asihpi_aesebu_rx_add(struct snd_card_asihpi *asihpi,
|
|
struct hpi_control *hpi_ctl)
|
|
{
|
|
struct snd_card *card = asihpi->card;
|
|
struct snd_kcontrol_new snd_control;
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Format");
|
|
snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
|
|
snd_control.info = snd_asihpi_aesebu_format_info;
|
|
snd_control.get = snd_asihpi_aesebu_rx_format_get;
|
|
snd_control.put = snd_asihpi_aesebu_rx_format_put;
|
|
|
|
|
|
if (ctl_add(card, &snd_control, asihpi) < 0)
|
|
return -EINVAL;
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Status");
|
|
snd_control.access =
|
|
SNDRV_CTL_ELEM_ACCESS_VOLATILE | SNDRV_CTL_ELEM_ACCESS_READ;
|
|
snd_control.info = snd_asihpi_aesebu_rxstatus_info;
|
|
snd_control.get = snd_asihpi_aesebu_rxstatus_get;
|
|
|
|
return ctl_add(card, &snd_control, asihpi);
|
|
}
|
|
|
|
static int snd_asihpi_aesebu_tx_format_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol) {
|
|
return snd_asihpi_aesebu_format_get(kcontrol, ucontrol,
|
|
hpi_aesebu_transmitter_get_format);
|
|
}
|
|
|
|
static int snd_asihpi_aesebu_tx_format_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol) {
|
|
return snd_asihpi_aesebu_format_put(kcontrol, ucontrol,
|
|
hpi_aesebu_transmitter_set_format);
|
|
}
|
|
|
|
|
|
static int __devinit snd_asihpi_aesebu_tx_add(struct snd_card_asihpi *asihpi,
|
|
struct hpi_control *hpi_ctl)
|
|
{
|
|
struct snd_card *card = asihpi->card;
|
|
struct snd_kcontrol_new snd_control;
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Format");
|
|
snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
|
|
snd_control.info = snd_asihpi_aesebu_format_info;
|
|
snd_control.get = snd_asihpi_aesebu_tx_format_get;
|
|
snd_control.put = snd_asihpi_aesebu_tx_format_put;
|
|
|
|
return ctl_add(card, &snd_control, asihpi);
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
Tuner controls
|
|
------------------------------------------------------------*/
|
|
|
|
/* Gain */
|
|
|
|
static int snd_asihpi_tuner_gain_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 err;
|
|
short idx;
|
|
u16 gain_range[3];
|
|
|
|
for (idx = 0; idx < 3; idx++) {
|
|
err = hpi_tuner_query_gain(h_control,
|
|
idx, &gain_range[idx]);
|
|
if (err != 0)
|
|
return err;
|
|
}
|
|
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
|
|
uinfo->count = 1;
|
|
uinfo->value.integer.min = ((int)gain_range[0]) / HPI_UNITS_PER_dB;
|
|
uinfo->value.integer.max = ((int)gain_range[1]) / HPI_UNITS_PER_dB;
|
|
uinfo->value.integer.step = ((int) gain_range[2]) / HPI_UNITS_PER_dB;
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_tuner_gain_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
/*
|
|
struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
|
|
*/
|
|
u32 h_control = kcontrol->private_value;
|
|
short gain;
|
|
|
|
hpi_handle_error(hpi_tuner_get_gain(h_control, &gain));
|
|
ucontrol->value.integer.value[0] = gain / HPI_UNITS_PER_dB;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_tuner_gain_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
/*
|
|
struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
|
|
*/
|
|
u32 h_control = kcontrol->private_value;
|
|
short gain;
|
|
|
|
gain = (ucontrol->value.integer.value[0]) * HPI_UNITS_PER_dB;
|
|
hpi_handle_error(hpi_tuner_set_gain(h_control, gain));
|
|
|
|
return 1;
|
|
}
|
|
|
|
/* Band */
|
|
|
|
static int asihpi_tuner_band_query(struct snd_kcontrol *kcontrol,
|
|
u16 *band_list, u32 len) {
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 err = 0;
|
|
u32 i;
|
|
|
|
for (i = 0; i < len; i++) {
|
|
err = hpi_tuner_query_band(
|
|
h_control, i, &band_list[i]);
|
|
if (err != 0)
|
|
break;
|
|
}
|
|
|
|
if (err && (err != HPI_ERROR_INVALID_OBJ_INDEX))
|
|
return -EIO;
|
|
|
|
return i;
|
|
}
|
|
|
|
static int snd_asihpi_tuner_band_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
u16 tuner_bands[HPI_TUNER_BAND_LAST];
|
|
int num_bands = 0;
|
|
|
|
num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
|
|
HPI_TUNER_BAND_LAST);
|
|
|
|
if (num_bands < 0)
|
|
return num_bands;
|
|
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
|
|
uinfo->count = 1;
|
|
uinfo->value.enumerated.items = num_bands;
|
|
|
|
if (num_bands > 0) {
|
|
if (uinfo->value.enumerated.item >=
|
|
uinfo->value.enumerated.items)
|
|
uinfo->value.enumerated.item =
|
|
uinfo->value.enumerated.items - 1;
|
|
|
|
strcpy(uinfo->value.enumerated.name,
|
|
asihpi_tuner_band_names[
|
|
tuner_bands[uinfo->value.enumerated.item]]);
|
|
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_tuner_band_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
/*
|
|
struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
|
|
*/
|
|
u16 band, idx;
|
|
u16 tuner_bands[HPI_TUNER_BAND_LAST];
|
|
u32 num_bands = 0;
|
|
|
|
num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
|
|
HPI_TUNER_BAND_LAST);
|
|
|
|
hpi_handle_error(hpi_tuner_get_band(h_control, &band));
|
|
|
|
ucontrol->value.enumerated.item[0] = -1;
|
|
for (idx = 0; idx < HPI_TUNER_BAND_LAST; idx++)
|
|
if (tuner_bands[idx] == band) {
|
|
ucontrol->value.enumerated.item[0] = idx;
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_tuner_band_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
/*
|
|
struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
|
|
*/
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 band;
|
|
u16 tuner_bands[HPI_TUNER_BAND_LAST];
|
|
u32 num_bands = 0;
|
|
|
|
num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
|
|
HPI_TUNER_BAND_LAST);
|
|
|
|
band = tuner_bands[ucontrol->value.enumerated.item[0]];
|
|
hpi_handle_error(hpi_tuner_set_band(h_control, band));
|
|
|
|
return 1;
|
|
}
|
|
|
|
/* Freq */
|
|
|
|
static int snd_asihpi_tuner_freq_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 err;
|
|
u16 tuner_bands[HPI_TUNER_BAND_LAST];
|
|
u16 num_bands = 0, band_iter, idx;
|
|
u32 freq_range[3], temp_freq_range[3];
|
|
|
|
num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
|
|
HPI_TUNER_BAND_LAST);
|
|
|
|
freq_range[0] = INT_MAX;
|
|
freq_range[1] = 0;
|
|
freq_range[2] = INT_MAX;
|
|
|
|
for (band_iter = 0; band_iter < num_bands; band_iter++) {
|
|
for (idx = 0; idx < 3; idx++) {
|
|
err = hpi_tuner_query_frequency(h_control,
|
|
idx, tuner_bands[band_iter],
|
|
&temp_freq_range[idx]);
|
|
if (err != 0)
|
|
return err;
|
|
}
|
|
|
|
/* skip band with bogus stepping */
|
|
if (temp_freq_range[2] <= 0)
|
|
continue;
|
|
|
|
if (temp_freq_range[0] < freq_range[0])
|
|
freq_range[0] = temp_freq_range[0];
|
|
if (temp_freq_range[1] > freq_range[1])
|
|
freq_range[1] = temp_freq_range[1];
|
|
if (temp_freq_range[2] < freq_range[2])
|
|
freq_range[2] = temp_freq_range[2];
|
|
}
|
|
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
|
|
uinfo->count = 1;
|
|
uinfo->value.integer.min = ((int)freq_range[0]);
|
|
uinfo->value.integer.max = ((int)freq_range[1]);
|
|
uinfo->value.integer.step = ((int)freq_range[2]);
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_tuner_freq_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u32 freq;
|
|
|
|
hpi_handle_error(hpi_tuner_get_frequency(h_control, &freq));
|
|
ucontrol->value.integer.value[0] = freq;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_tuner_freq_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u32 freq;
|
|
|
|
freq = ucontrol->value.integer.value[0];
|
|
hpi_handle_error(hpi_tuner_set_frequency(h_control, freq));
|
|
|
|
return 1;
|
|
}
|
|
|
|
/* Tuner control group initializer */
|
|
static int __devinit snd_asihpi_tuner_add(struct snd_card_asihpi *asihpi,
|
|
struct hpi_control *hpi_ctl)
|
|
{
|
|
struct snd_card *card = asihpi->card;
|
|
struct snd_kcontrol_new snd_control;
|
|
|
|
snd_control.private_value = hpi_ctl->h_control;
|
|
snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
|
|
|
|
if (!hpi_tuner_get_gain(hpi_ctl->h_control, NULL)) {
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Gain");
|
|
snd_control.info = snd_asihpi_tuner_gain_info;
|
|
snd_control.get = snd_asihpi_tuner_gain_get;
|
|
snd_control.put = snd_asihpi_tuner_gain_put;
|
|
|
|
if (ctl_add(card, &snd_control, asihpi) < 0)
|
|
return -EINVAL;
|
|
}
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Band");
|
|
snd_control.info = snd_asihpi_tuner_band_info;
|
|
snd_control.get = snd_asihpi_tuner_band_get;
|
|
snd_control.put = snd_asihpi_tuner_band_put;
|
|
|
|
if (ctl_add(card, &snd_control, asihpi) < 0)
|
|
return -EINVAL;
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Freq");
|
|
snd_control.info = snd_asihpi_tuner_freq_info;
|
|
snd_control.get = snd_asihpi_tuner_freq_get;
|
|
snd_control.put = snd_asihpi_tuner_freq_put;
|
|
|
|
return ctl_add(card, &snd_control, asihpi);
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
Meter controls
|
|
------------------------------------------------------------*/
|
|
static int snd_asihpi_meter_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u32 count;
|
|
u16 err;
|
|
err = hpi_meter_query_channels(h_control, &count);
|
|
if (err)
|
|
count = HPI_MAX_CHANNELS;
|
|
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
|
|
uinfo->count = count;
|
|
uinfo->value.integer.min = 0;
|
|
uinfo->value.integer.max = 0x7FFFFFFF;
|
|
return 0;
|
|
}
|
|
|
|
/* linear values for 10dB steps */
|
|
static int log2lin[] = {
|
|
0x7FFFFFFF, /* 0dB */
|
|
679093956,
|
|
214748365,
|
|
67909396,
|
|
21474837,
|
|
6790940,
|
|
2147484, /* -60dB */
|
|
679094,
|
|
214748, /* -80 */
|
|
67909,
|
|
21475, /* -100 */
|
|
6791,
|
|
2147,
|
|
679,
|
|
214,
|
|
68,
|
|
21,
|
|
7,
|
|
2
|
|
};
|
|
|
|
static int snd_asihpi_meter_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
short an_gain_mB[HPI_MAX_CHANNELS], i;
|
|
u16 err;
|
|
|
|
err = hpi_meter_get_peak(h_control, an_gain_mB);
|
|
|
|
for (i = 0; i < HPI_MAX_CHANNELS; i++) {
|
|
if (err) {
|
|
ucontrol->value.integer.value[i] = 0;
|
|
} else if (an_gain_mB[i] >= 0) {
|
|
ucontrol->value.integer.value[i] =
|
|
an_gain_mB[i] << 16;
|
|
} else {
|
|
/* -ve is log value in millibels < -60dB,
|
|
* convert to (roughly!) linear,
|
|
*/
|
|
ucontrol->value.integer.value[i] =
|
|
log2lin[an_gain_mB[i] / -1000];
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int __devinit snd_asihpi_meter_add(struct snd_card_asihpi *asihpi,
|
|
struct hpi_control *hpi_ctl, int subidx)
|
|
{
|
|
struct snd_card *card = asihpi->card;
|
|
struct snd_kcontrol_new snd_control;
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Meter");
|
|
snd_control.access =
|
|
SNDRV_CTL_ELEM_ACCESS_VOLATILE | SNDRV_CTL_ELEM_ACCESS_READ;
|
|
snd_control.info = snd_asihpi_meter_info;
|
|
snd_control.get = snd_asihpi_meter_get;
|
|
|
|
snd_control.index = subidx;
|
|
|
|
return ctl_add(card, &snd_control, asihpi);
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
Multiplexer controls
|
|
------------------------------------------------------------*/
|
|
static int snd_card_asihpi_mux_count_sources(struct snd_kcontrol *snd_control)
|
|
{
|
|
u32 h_control = snd_control->private_value;
|
|
struct hpi_control hpi_ctl;
|
|
int s, err;
|
|
for (s = 0; s < 32; s++) {
|
|
err = hpi_multiplexer_query_source(h_control, s,
|
|
&hpi_ctl.
|
|
src_node_type,
|
|
&hpi_ctl.
|
|
src_node_index);
|
|
if (err)
|
|
break;
|
|
}
|
|
return s;
|
|
}
|
|
|
|
static int snd_asihpi_mux_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
int err;
|
|
u16 src_node_type, src_node_index;
|
|
u32 h_control = kcontrol->private_value;
|
|
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
|
|
uinfo->count = 1;
|
|
uinfo->value.enumerated.items =
|
|
snd_card_asihpi_mux_count_sources(kcontrol);
|
|
|
|
if (uinfo->value.enumerated.item >= uinfo->value.enumerated.items)
|
|
uinfo->value.enumerated.item =
|
|
uinfo->value.enumerated.items - 1;
|
|
|
|
err =
|
|
hpi_multiplexer_query_source(h_control,
|
|
uinfo->value.enumerated.item,
|
|
&src_node_type, &src_node_index);
|
|
|
|
sprintf(uinfo->value.enumerated.name, "%s %d",
|
|
asihpi_src_names[src_node_type - HPI_SOURCENODE_NONE],
|
|
src_node_index);
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_mux_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 source_type, source_index;
|
|
u16 src_node_type, src_node_index;
|
|
int s;
|
|
|
|
hpi_handle_error(hpi_multiplexer_get_source(h_control,
|
|
&source_type, &source_index));
|
|
/* Should cache this search result! */
|
|
for (s = 0; s < 256; s++) {
|
|
if (hpi_multiplexer_query_source(h_control, s,
|
|
&src_node_type, &src_node_index))
|
|
break;
|
|
|
|
if ((source_type == src_node_type)
|
|
&& (source_index == src_node_index)) {
|
|
ucontrol->value.enumerated.item[0] = s;
|
|
return 0;
|
|
}
|
|
}
|
|
snd_printd(KERN_WARNING
|
|
"Control %x failed to match mux source %hu %hu\n",
|
|
h_control, source_type, source_index);
|
|
ucontrol->value.enumerated.item[0] = 0;
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_mux_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
int change;
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 source_type, source_index;
|
|
u16 e;
|
|
|
|
change = 1;
|
|
|
|
e = hpi_multiplexer_query_source(h_control,
|
|
ucontrol->value.enumerated.item[0],
|
|
&source_type, &source_index);
|
|
if (!e)
|
|
hpi_handle_error(
|
|
hpi_multiplexer_set_source(h_control,
|
|
source_type, source_index));
|
|
return change;
|
|
}
|
|
|
|
|
|
static int __devinit snd_asihpi_mux_add(struct snd_card_asihpi *asihpi,
|
|
struct hpi_control *hpi_ctl)
|
|
{
|
|
struct snd_card *card = asihpi->card;
|
|
struct snd_kcontrol_new snd_control;
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Route");
|
|
snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
|
|
snd_control.info = snd_asihpi_mux_info;
|
|
snd_control.get = snd_asihpi_mux_get;
|
|
snd_control.put = snd_asihpi_mux_put;
|
|
|
|
return ctl_add(card, &snd_control, asihpi);
|
|
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
Channel mode controls
|
|
------------------------------------------------------------*/
|
|
static int snd_asihpi_cmode_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
static const char * const mode_names[HPI_CHANNEL_MODE_LAST + 1] = {
|
|
"invalid",
|
|
"Normal", "Swap",
|
|
"From Left", "From Right",
|
|
"To Left", "To Right"
|
|
};
|
|
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 mode;
|
|
int i;
|
|
u16 mode_map[6];
|
|
int valid_modes = 0;
|
|
|
|
/* HPI channel mode values can be from 1 to 6
|
|
Some adapters only support a contiguous subset
|
|
*/
|
|
for (i = 0; i < HPI_CHANNEL_MODE_LAST; i++)
|
|
if (!hpi_channel_mode_query_mode(
|
|
h_control, i, &mode)) {
|
|
mode_map[valid_modes] = mode;
|
|
valid_modes++;
|
|
}
|
|
|
|
if (!valid_modes)
|
|
return -EINVAL;
|
|
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
|
|
uinfo->count = 1;
|
|
uinfo->value.enumerated.items = valid_modes;
|
|
|
|
if (uinfo->value.enumerated.item >= valid_modes)
|
|
uinfo->value.enumerated.item = valid_modes - 1;
|
|
|
|
strcpy(uinfo->value.enumerated.name,
|
|
mode_names[mode_map[uinfo->value.enumerated.item]]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_cmode_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 mode;
|
|
|
|
if (hpi_channel_mode_get(h_control, &mode))
|
|
mode = 1;
|
|
|
|
ucontrol->value.enumerated.item[0] = mode - 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_cmode_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
int change;
|
|
u32 h_control = kcontrol->private_value;
|
|
|
|
change = 1;
|
|
|
|
hpi_handle_error(hpi_channel_mode_set(h_control,
|
|
ucontrol->value.enumerated.item[0] + 1));
|
|
return change;
|
|
}
|
|
|
|
|
|
static int __devinit snd_asihpi_cmode_add(struct snd_card_asihpi *asihpi,
|
|
struct hpi_control *hpi_ctl)
|
|
{
|
|
struct snd_card *card = asihpi->card;
|
|
struct snd_kcontrol_new snd_control;
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Mode");
|
|
snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
|
|
snd_control.info = snd_asihpi_cmode_info;
|
|
snd_control.get = snd_asihpi_cmode_get;
|
|
snd_control.put = snd_asihpi_cmode_put;
|
|
|
|
return ctl_add(card, &snd_control, asihpi);
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
Sampleclock source controls
|
|
------------------------------------------------------------*/
|
|
static char *sampleclock_sources[MAX_CLOCKSOURCES] = {
|
|
"N/A", "Local PLL", "Digital Sync", "Word External", "Word Header",
|
|
"SMPTE", "Digital1", "Auto", "Network", "Invalid",
|
|
"Prev Module",
|
|
"Digital2", "Digital3", "Digital4", "Digital5",
|
|
"Digital6", "Digital7", "Digital8"};
|
|
|
|
static int snd_asihpi_clksrc_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
struct snd_card_asihpi *asihpi =
|
|
(struct snd_card_asihpi *)(kcontrol->private_data);
|
|
struct clk_cache *clkcache = &asihpi->cc;
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
|
|
uinfo->count = 1;
|
|
uinfo->value.enumerated.items = clkcache->count;
|
|
|
|
if (uinfo->value.enumerated.item >= uinfo->value.enumerated.items)
|
|
uinfo->value.enumerated.item =
|
|
uinfo->value.enumerated.items - 1;
|
|
|
|
strcpy(uinfo->value.enumerated.name,
|
|
clkcache->s[uinfo->value.enumerated.item].name);
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_clksrc_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
struct snd_card_asihpi *asihpi =
|
|
(struct snd_card_asihpi *)(kcontrol->private_data);
|
|
struct clk_cache *clkcache = &asihpi->cc;
|
|
u32 h_control = kcontrol->private_value;
|
|
u16 source, srcindex = 0;
|
|
int i;
|
|
|
|
ucontrol->value.enumerated.item[0] = 0;
|
|
if (hpi_sample_clock_get_source(h_control, &source))
|
|
source = 0;
|
|
|
|
if (source == HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT)
|
|
if (hpi_sample_clock_get_source_index(h_control, &srcindex))
|
|
srcindex = 0;
|
|
|
|
for (i = 0; i < clkcache->count; i++)
|
|
if ((clkcache->s[i].source == source) &&
|
|
(clkcache->s[i].index == srcindex))
|
|
break;
|
|
|
|
ucontrol->value.enumerated.item[0] = i;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_clksrc_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
struct snd_card_asihpi *asihpi =
|
|
(struct snd_card_asihpi *)(kcontrol->private_data);
|
|
struct clk_cache *clkcache = &asihpi->cc;
|
|
int change, item;
|
|
u32 h_control = kcontrol->private_value;
|
|
|
|
change = 1;
|
|
item = ucontrol->value.enumerated.item[0];
|
|
if (item >= clkcache->count)
|
|
item = clkcache->count-1;
|
|
|
|
hpi_handle_error(hpi_sample_clock_set_source(
|
|
h_control, clkcache->s[item].source));
|
|
|
|
if (clkcache->s[item].source == HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT)
|
|
hpi_handle_error(hpi_sample_clock_set_source_index(
|
|
h_control, clkcache->s[item].index));
|
|
return change;
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
Clkrate controls
|
|
------------------------------------------------------------*/
|
|
/* Need to change this to enumerated control with list of rates */
|
|
static int snd_asihpi_clklocal_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
|
|
uinfo->count = 1;
|
|
uinfo->value.integer.min = 8000;
|
|
uinfo->value.integer.max = 192000;
|
|
uinfo->value.integer.step = 100;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_clklocal_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u32 rate;
|
|
u16 e;
|
|
|
|
e = hpi_sample_clock_get_local_rate(h_control, &rate);
|
|
if (!e)
|
|
ucontrol->value.integer.value[0] = rate;
|
|
else
|
|
ucontrol->value.integer.value[0] = 0;
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_clklocal_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
int change;
|
|
u32 h_control = kcontrol->private_value;
|
|
|
|
/* change = asihpi->mixer_clkrate[addr][0] != left ||
|
|
asihpi->mixer_clkrate[addr][1] != right;
|
|
*/
|
|
change = 1;
|
|
hpi_handle_error(hpi_sample_clock_set_local_rate(h_control,
|
|
ucontrol->value.integer.value[0]));
|
|
return change;
|
|
}
|
|
|
|
static int snd_asihpi_clkrate_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
|
|
uinfo->count = 1;
|
|
uinfo->value.integer.min = 8000;
|
|
uinfo->value.integer.max = 192000;
|
|
uinfo->value.integer.step = 100;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int snd_asihpi_clkrate_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
u32 h_control = kcontrol->private_value;
|
|
u32 rate;
|
|
u16 e;
|
|
|
|
e = hpi_sample_clock_get_sample_rate(h_control, &rate);
|
|
if (!e)
|
|
ucontrol->value.integer.value[0] = rate;
|
|
else
|
|
ucontrol->value.integer.value[0] = 0;
|
|
return 0;
|
|
}
|
|
|
|
static int __devinit snd_asihpi_sampleclock_add(struct snd_card_asihpi *asihpi,
|
|
struct hpi_control *hpi_ctl)
|
|
{
|
|
struct snd_card *card = asihpi->card;
|
|
struct snd_kcontrol_new snd_control;
|
|
|
|
struct clk_cache *clkcache = &asihpi->cc;
|
|
u32 hSC = hpi_ctl->h_control;
|
|
int has_aes_in = 0;
|
|
int i, j;
|
|
u16 source;
|
|
|
|
snd_control.private_value = hpi_ctl->h_control;
|
|
|
|
clkcache->has_local = 0;
|
|
|
|
for (i = 0; i <= HPI_SAMPLECLOCK_SOURCE_LAST; i++) {
|
|
if (hpi_sample_clock_query_source(hSC,
|
|
i, &source))
|
|
break;
|
|
clkcache->s[i].source = source;
|
|
clkcache->s[i].index = 0;
|
|
clkcache->s[i].name = sampleclock_sources[source];
|
|
if (source == HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT)
|
|
has_aes_in = 1;
|
|
if (source == HPI_SAMPLECLOCK_SOURCE_LOCAL)
|
|
clkcache->has_local = 1;
|
|
}
|
|
if (has_aes_in)
|
|
/* already will have picked up index 0 above */
|
|
for (j = 1; j < 8; j++) {
|
|
if (hpi_sample_clock_query_source_index(hSC,
|
|
j, HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT,
|
|
&source))
|
|
break;
|
|
clkcache->s[i].source =
|
|
HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT;
|
|
clkcache->s[i].index = j;
|
|
clkcache->s[i].name = sampleclock_sources[
|
|
j+HPI_SAMPLECLOCK_SOURCE_LAST];
|
|
i++;
|
|
}
|
|
clkcache->count = i;
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Source");
|
|
snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE ;
|
|
snd_control.info = snd_asihpi_clksrc_info;
|
|
snd_control.get = snd_asihpi_clksrc_get;
|
|
snd_control.put = snd_asihpi_clksrc_put;
|
|
if (ctl_add(card, &snd_control, asihpi) < 0)
|
|
return -EINVAL;
|
|
|
|
|
|
if (clkcache->has_local) {
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Localrate");
|
|
snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE ;
|
|
snd_control.info = snd_asihpi_clklocal_info;
|
|
snd_control.get = snd_asihpi_clklocal_get;
|
|
snd_control.put = snd_asihpi_clklocal_put;
|
|
|
|
|
|
if (ctl_add(card, &snd_control, asihpi) < 0)
|
|
return -EINVAL;
|
|
}
|
|
|
|
asihpi_ctl_init(&snd_control, hpi_ctl, "Rate");
|
|
snd_control.access =
|
|
SNDRV_CTL_ELEM_ACCESS_VOLATILE | SNDRV_CTL_ELEM_ACCESS_READ;
|
|
snd_control.info = snd_asihpi_clkrate_info;
|
|
snd_control.get = snd_asihpi_clkrate_get;
|
|
|
|
return ctl_add(card, &snd_control, asihpi);
|
|
}
|
|
/*------------------------------------------------------------
|
|
Mixer
|
|
------------------------------------------------------------*/
|
|
|
|
static int __devinit snd_card_asihpi_mixer_new(struct snd_card_asihpi *asihpi)
|
|
{
|
|
struct snd_card *card = asihpi->card;
|
|
unsigned int idx = 0;
|
|
unsigned int subindex = 0;
|
|
int err;
|
|
struct hpi_control hpi_ctl, prev_ctl;
|
|
|
|
if (snd_BUG_ON(!asihpi))
|
|
return -EINVAL;
|
|
strcpy(card->mixername, "Asihpi Mixer");
|
|
|
|
err =
|
|
hpi_mixer_open(asihpi->hpi->adapter->index,
|
|
&asihpi->h_mixer);
|
|
hpi_handle_error(err);
|
|
if (err)
|
|
return -err;
|
|
|
|
memset(&prev_ctl, 0, sizeof(prev_ctl));
|
|
prev_ctl.control_type = -1;
|
|
|
|
for (idx = 0; idx < 2000; idx++) {
|
|
err = hpi_mixer_get_control_by_index(
|
|
asihpi->h_mixer,
|
|
idx,
|
|
&hpi_ctl.src_node_type,
|
|
&hpi_ctl.src_node_index,
|
|
&hpi_ctl.dst_node_type,
|
|
&hpi_ctl.dst_node_index,
|
|
&hpi_ctl.control_type,
|
|
&hpi_ctl.h_control);
|
|
if (err) {
|
|
if (err == HPI_ERROR_CONTROL_DISABLED) {
|
|
if (mixer_dump)
|
|
snd_printk(KERN_INFO
|
|
"Disabled HPI Control(%d)\n",
|
|
idx);
|
|
continue;
|
|
} else
|
|
break;
|
|
|
|
}
|
|
|
|
hpi_ctl.src_node_type -= HPI_SOURCENODE_NONE;
|
|
hpi_ctl.dst_node_type -= HPI_DESTNODE_NONE;
|
|
|
|
/* ASI50xx in SSX mode has multiple meters on the same node.
|
|
Use subindex to create distinct ALSA controls
|
|
for any duplicated controls.
|
|
*/
|
|
if ((hpi_ctl.control_type == prev_ctl.control_type) &&
|
|
(hpi_ctl.src_node_type == prev_ctl.src_node_type) &&
|
|
(hpi_ctl.src_node_index == prev_ctl.src_node_index) &&
|
|
(hpi_ctl.dst_node_type == prev_ctl.dst_node_type) &&
|
|
(hpi_ctl.dst_node_index == prev_ctl.dst_node_index))
|
|
subindex++;
|
|
else
|
|
subindex = 0;
|
|
|
|
prev_ctl = hpi_ctl;
|
|
|
|
switch (hpi_ctl.control_type) {
|
|
case HPI_CONTROL_VOLUME:
|
|
err = snd_asihpi_volume_add(asihpi, &hpi_ctl);
|
|
break;
|
|
case HPI_CONTROL_LEVEL:
|
|
err = snd_asihpi_level_add(asihpi, &hpi_ctl);
|
|
break;
|
|
case HPI_CONTROL_MULTIPLEXER:
|
|
err = snd_asihpi_mux_add(asihpi, &hpi_ctl);
|
|
break;
|
|
case HPI_CONTROL_CHANNEL_MODE:
|
|
err = snd_asihpi_cmode_add(asihpi, &hpi_ctl);
|
|
break;
|
|
case HPI_CONTROL_METER:
|
|
err = snd_asihpi_meter_add(asihpi, &hpi_ctl, subindex);
|
|
break;
|
|
case HPI_CONTROL_SAMPLECLOCK:
|
|
err = snd_asihpi_sampleclock_add(
|
|
asihpi, &hpi_ctl);
|
|
break;
|
|
case HPI_CONTROL_CONNECTION: /* ignore these */
|
|
continue;
|
|
case HPI_CONTROL_TUNER:
|
|
err = snd_asihpi_tuner_add(asihpi, &hpi_ctl);
|
|
break;
|
|
case HPI_CONTROL_AESEBU_TRANSMITTER:
|
|
err = snd_asihpi_aesebu_tx_add(asihpi, &hpi_ctl);
|
|
break;
|
|
case HPI_CONTROL_AESEBU_RECEIVER:
|
|
err = snd_asihpi_aesebu_rx_add(asihpi, &hpi_ctl);
|
|
break;
|
|
case HPI_CONTROL_VOX:
|
|
case HPI_CONTROL_BITSTREAM:
|
|
case HPI_CONTROL_MICROPHONE:
|
|
case HPI_CONTROL_PARAMETRIC_EQ:
|
|
case HPI_CONTROL_COMPANDER:
|
|
default:
|
|
if (mixer_dump)
|
|
snd_printk(KERN_INFO
|
|
"Untranslated HPI Control"
|
|
"(%d) %d %d %d %d %d\n",
|
|
idx,
|
|
hpi_ctl.control_type,
|
|
hpi_ctl.src_node_type,
|
|
hpi_ctl.src_node_index,
|
|
hpi_ctl.dst_node_type,
|
|
hpi_ctl.dst_node_index);
|
|
continue;
|
|
};
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
if (HPI_ERROR_INVALID_OBJ_INDEX != err)
|
|
hpi_handle_error(err);
|
|
|
|
snd_printk(KERN_INFO "%d mixer controls found\n", idx);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
/proc interface
|
|
------------------------------------------------------------*/
|
|
|
|
static void
|
|
snd_asihpi_proc_read(struct snd_info_entry *entry,
|
|
struct snd_info_buffer *buffer)
|
|
{
|
|
struct snd_card_asihpi *asihpi = entry->private_data;
|
|
u32 h_control;
|
|
u32 rate = 0;
|
|
u16 source = 0;
|
|
|
|
u16 num_outstreams;
|
|
u16 num_instreams;
|
|
u16 version;
|
|
u32 serial_number;
|
|
u16 type;
|
|
|
|
int err;
|
|
|
|
snd_iprintf(buffer, "ASIHPI driver proc file\n");
|
|
|
|
hpi_handle_error(hpi_adapter_get_info(asihpi->hpi->adapter->index,
|
|
&num_outstreams, &num_instreams,
|
|
&version, &serial_number, &type));
|
|
|
|
snd_iprintf(buffer,
|
|
"Adapter type ASI%4X\nHardware Index %d\n"
|
|
"%d outstreams\n%d instreams\n",
|
|
type, asihpi->hpi->adapter->index,
|
|
num_outstreams, num_instreams);
|
|
|
|
snd_iprintf(buffer,
|
|
"Serial#%d\nHardware version %c%d\nDSP code version %03d\n",
|
|
serial_number, ((version >> 3) & 0xf) + 'A', version & 0x7,
|
|
((version >> 13) * 100) + ((version >> 7) & 0x3f));
|
|
|
|
err = hpi_mixer_get_control(asihpi->h_mixer,
|
|
HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
|
|
HPI_CONTROL_SAMPLECLOCK, &h_control);
|
|
|
|
if (!err) {
|
|
err = hpi_sample_clock_get_sample_rate(h_control, &rate);
|
|
err += hpi_sample_clock_get_source(h_control, &source);
|
|
|
|
if (!err)
|
|
snd_iprintf(buffer, "Sample Clock %dHz, source %s\n",
|
|
rate, sampleclock_sources[source]);
|
|
}
|
|
}
|
|
|
|
static void __devinit snd_asihpi_proc_init(struct snd_card_asihpi *asihpi)
|
|
{
|
|
struct snd_info_entry *entry;
|
|
|
|
if (!snd_card_proc_new(asihpi->card, "info", &entry))
|
|
snd_info_set_text_ops(entry, asihpi, snd_asihpi_proc_read);
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
HWDEP
|
|
------------------------------------------------------------*/
|
|
|
|
static int snd_asihpi_hpi_open(struct snd_hwdep *hw, struct file *file)
|
|
{
|
|
if (enable_hpi_hwdep)
|
|
return 0;
|
|
else
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
static int snd_asihpi_hpi_release(struct snd_hwdep *hw, struct file *file)
|
|
{
|
|
if (enable_hpi_hwdep)
|
|
return asihpi_hpi_release(file);
|
|
else
|
|
return -ENODEV;
|
|
}
|
|
|
|
static int snd_asihpi_hpi_ioctl(struct snd_hwdep *hw, struct file *file,
|
|
unsigned int cmd, unsigned long arg)
|
|
{
|
|
if (enable_hpi_hwdep)
|
|
return asihpi_hpi_ioctl(file, cmd, arg);
|
|
else
|
|
return -ENODEV;
|
|
}
|
|
|
|
|
|
/* results in /dev/snd/hwC#D0 file for each card with index #
|
|
also /proc/asound/hwdep will contain '#-00: asihpi (HPI) for each card'
|
|
*/
|
|
static int __devinit snd_asihpi_hpi_new(struct snd_card_asihpi *asihpi,
|
|
int device, struct snd_hwdep **rhwdep)
|
|
{
|
|
struct snd_hwdep *hw;
|
|
int err;
|
|
|
|
if (rhwdep)
|
|
*rhwdep = NULL;
|
|
err = snd_hwdep_new(asihpi->card, "HPI", device, &hw);
|
|
if (err < 0)
|
|
return err;
|
|
strcpy(hw->name, "asihpi (HPI)");
|
|
hw->iface = SNDRV_HWDEP_IFACE_LAST;
|
|
hw->ops.open = snd_asihpi_hpi_open;
|
|
hw->ops.ioctl = snd_asihpi_hpi_ioctl;
|
|
hw->ops.release = snd_asihpi_hpi_release;
|
|
hw->private_data = asihpi;
|
|
if (rhwdep)
|
|
*rhwdep = hw;
|
|
return 0;
|
|
}
|
|
|
|
/*------------------------------------------------------------
|
|
CARD
|
|
------------------------------------------------------------*/
|
|
static int __devinit snd_asihpi_probe(struct pci_dev *pci_dev,
|
|
const struct pci_device_id *pci_id)
|
|
{
|
|
int err;
|
|
struct hpi_adapter *hpi;
|
|
struct snd_card *card;
|
|
struct snd_card_asihpi *asihpi;
|
|
|
|
u32 h_control;
|
|
u32 h_stream;
|
|
u32 adapter_index;
|
|
|
|
static int dev;
|
|
if (dev >= SNDRV_CARDS)
|
|
return -ENODEV;
|
|
|
|
/* Should this be enable[hpi->index] ? */
|
|
if (!enable[dev]) {
|
|
dev++;
|
|
return -ENOENT;
|
|
}
|
|
|
|
/* Initialise low-level HPI driver */
|
|
err = asihpi_adapter_probe(pci_dev, pci_id);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
hpi = pci_get_drvdata(pci_dev);
|
|
adapter_index = hpi->adapter->index;
|
|
/* first try to give the card the same index as its hardware index */
|
|
err = snd_card_create(adapter_index,
|
|
id[adapter_index], THIS_MODULE,
|
|
sizeof(struct snd_card_asihpi),
|
|
&card);
|
|
if (err < 0) {
|
|
/* if that fails, try the default index==next available */
|
|
err =
|
|
snd_card_create(index[dev], id[dev],
|
|
THIS_MODULE,
|
|
sizeof(struct snd_card_asihpi),
|
|
&card);
|
|
if (err < 0)
|
|
return err;
|
|
snd_printk(KERN_WARNING
|
|
"**** WARNING **** Adapter index %d->ALSA index %d\n",
|
|
adapter_index, card->number);
|
|
}
|
|
|
|
snd_card_set_dev(card, &pci_dev->dev);
|
|
|
|
asihpi = card->private_data;
|
|
asihpi->card = card;
|
|
asihpi->pci = pci_dev;
|
|
asihpi->hpi = hpi;
|
|
|
|
snd_printk(KERN_INFO "adapter ID=%4X index=%d\n",
|
|
asihpi->hpi->adapter->type, adapter_index);
|
|
|
|
err = hpi_adapter_get_property(adapter_index,
|
|
HPI_ADAPTER_PROPERTY_CAPS1,
|
|
NULL, &asihpi->support_grouping);
|
|
if (err)
|
|
asihpi->support_grouping = 0;
|
|
|
|
err = hpi_adapter_get_property(adapter_index,
|
|
HPI_ADAPTER_PROPERTY_CAPS2,
|
|
&asihpi->support_mrx, NULL);
|
|
if (err)
|
|
asihpi->support_mrx = 0;
|
|
|
|
err = hpi_adapter_get_property(adapter_index,
|
|
HPI_ADAPTER_PROPERTY_INTERVAL,
|
|
NULL, &asihpi->update_interval_frames);
|
|
if (err)
|
|
asihpi->update_interval_frames = 512;
|
|
|
|
if (!asihpi->can_dma)
|
|
asihpi->update_interval_frames *= 2;
|
|
|
|
hpi_handle_error(hpi_instream_open(adapter_index,
|
|
0, &h_stream));
|
|
|
|
err = hpi_instream_host_buffer_free(h_stream);
|
|
asihpi->can_dma = (!err);
|
|
|
|
hpi_handle_error(hpi_instream_close(h_stream));
|
|
|
|
err = hpi_adapter_get_property(adapter_index,
|
|
HPI_ADAPTER_PROPERTY_CURCHANNELS,
|
|
&asihpi->in_max_chans, &asihpi->out_max_chans);
|
|
if (err) {
|
|
asihpi->in_max_chans = 2;
|
|
asihpi->out_max_chans = 2;
|
|
}
|
|
|
|
if (asihpi->out_max_chans > 2) { /* assume LL mode */
|
|
asihpi->out_min_chans = asihpi->out_max_chans;
|
|
asihpi->in_min_chans = asihpi->in_max_chans;
|
|
asihpi->support_grouping = 0;
|
|
} else {
|
|
asihpi->out_min_chans = 1;
|
|
asihpi->in_min_chans = 1;
|
|
}
|
|
|
|
snd_printk(KERN_INFO "Has dma:%d, grouping:%d, mrx:%d\n",
|
|
asihpi->can_dma,
|
|
asihpi->support_grouping,
|
|
asihpi->support_mrx
|
|
);
|
|
|
|
err = snd_card_asihpi_pcm_new(asihpi, 0);
|
|
if (err < 0) {
|
|
snd_printk(KERN_ERR "pcm_new failed\n");
|
|
goto __nodev;
|
|
}
|
|
err = snd_card_asihpi_mixer_new(asihpi);
|
|
if (err < 0) {
|
|
snd_printk(KERN_ERR "mixer_new failed\n");
|
|
goto __nodev;
|
|
}
|
|
|
|
err = hpi_mixer_get_control(asihpi->h_mixer,
|
|
HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
|
|
HPI_CONTROL_SAMPLECLOCK, &h_control);
|
|
|
|
if (!err)
|
|
err = hpi_sample_clock_set_local_rate(
|
|
h_control, adapter_fs);
|
|
|
|
snd_asihpi_proc_init(asihpi);
|
|
|
|
/* always create, can be enabled or disabled dynamically
|
|
by enable_hwdep module param*/
|
|
snd_asihpi_hpi_new(asihpi, 0, NULL);
|
|
|
|
strcpy(card->driver, "ASIHPI");
|
|
|
|
sprintf(card->shortname, "AudioScience ASI%4X",
|
|
asihpi->hpi->adapter->type);
|
|
sprintf(card->longname, "%s %i",
|
|
card->shortname, adapter_index);
|
|
err = snd_card_register(card);
|
|
|
|
if (!err) {
|
|
hpi->snd_card = card;
|
|
dev++;
|
|
return 0;
|
|
}
|
|
__nodev:
|
|
snd_card_free(card);
|
|
snd_printk(KERN_ERR "snd_asihpi_probe error %d\n", err);
|
|
return err;
|
|
|
|
}
|
|
|
|
static void __devexit snd_asihpi_remove(struct pci_dev *pci_dev)
|
|
{
|
|
struct hpi_adapter *hpi = pci_get_drvdata(pci_dev);
|
|
snd_card_free(hpi->snd_card);
|
|
hpi->snd_card = NULL;
|
|
asihpi_adapter_remove(pci_dev);
|
|
}
|
|
|
|
static DEFINE_PCI_DEVICE_TABLE(asihpi_pci_tbl) = {
|
|
{HPI_PCI_VENDOR_ID_TI, HPI_PCI_DEV_ID_DSP6205,
|
|
HPI_PCI_VENDOR_ID_AUDIOSCIENCE, PCI_ANY_ID, 0, 0,
|
|
(kernel_ulong_t)HPI_6205},
|
|
{HPI_PCI_VENDOR_ID_TI, HPI_PCI_DEV_ID_PCI2040,
|
|
HPI_PCI_VENDOR_ID_AUDIOSCIENCE, PCI_ANY_ID, 0, 0,
|
|
(kernel_ulong_t)HPI_6000},
|
|
{0,}
|
|
};
|
|
MODULE_DEVICE_TABLE(pci, asihpi_pci_tbl);
|
|
|
|
static struct pci_driver driver = {
|
|
.name = KBUILD_MODNAME,
|
|
.id_table = asihpi_pci_tbl,
|
|
.probe = snd_asihpi_probe,
|
|
.remove = __devexit_p(snd_asihpi_remove),
|
|
#ifdef CONFIG_PM
|
|
/* .suspend = snd_asihpi_suspend,
|
|
.resume = snd_asihpi_resume, */
|
|
#endif
|
|
};
|
|
|
|
static int __init snd_asihpi_init(void)
|
|
{
|
|
asihpi_init();
|
|
return pci_register_driver(&driver);
|
|
}
|
|
|
|
static void __exit snd_asihpi_exit(void)
|
|
{
|
|
|
|
pci_unregister_driver(&driver);
|
|
asihpi_exit();
|
|
}
|
|
|
|
module_init(snd_asihpi_init)
|
|
module_exit(snd_asihpi_exit)
|
|
|