sound/pci/asihpi/asihpi.c

   1 /*
   2  *  Asihpi soundcard
   3  *  Copyright (c) by AudioScience Inc <alsa@audioscience.com>
   4  *
   5  *   This program is free software; you can redistribute it and/or modify
   6  *   it under the terms of version 2 of the GNU General Public License as
   7  *   published by the Free Software Foundation;
   8  *
   9  *   This program is distributed in the hope that it will be useful,
  10  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  *   GNU General Public License for more details.
  13  *
  14  *   You should have received a copy of the GNU General Public License
  15  *   along with this program; if not, write to the Free Software
  16  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  17  *
  18  *
  19  *  The following is not a condition of use, merely a request:
  20  *  If you modify this program, particularly if you fix errors, AudioScience Inc
  21  *  would appreciate it if you grant us the right to use those modifications
  22  *  for any purpose including commercial applications.
  23  */
  24
  25 #include "hpi_internal.h"
  26 #include "hpi_version.h"
  27 #include "hpimsginit.h"
  28 #include "hpioctl.h"
  29 #include "hpicmn.h"
  30
  31
  32 #include <linux/pci.h>
  33 #include <linux/init.h>
  34 #include <linux/jiffies.h>
  35 #include <linux/slab.h>
  36 #include <linux/time.h>
  37 #include <linux/wait.h>
  38 #include <linux/module.h>
  39 #include <sound/core.h>
  40 #include <sound/control.h>
  41 #include <sound/pcm.h>
  42 #include <sound/pcm_params.h>
  43 #include <sound/info.h>
  44 #include <sound/initval.h>
  45 #include <sound/tlv.h>
  46 #include <sound/hwdep.h>
  47
  48 MODULE_LICENSE("GPL");
  49 MODULE_AUTHOR("AudioScience inc. <support@audioscience.com>");
  50 MODULE_DESCRIPTION("AudioScience ALSA ASI5000 ASI6000 ASI87xx ASI89xx "
  51                         HPI_VER_STRING);
  52
  53 #if defined CONFIG_SND_DEBUG_VERBOSE
  54 /**
  55  * snd_printddd - very verbose debug printk
  56  * @format: format string
  57  *
  58  * Works like snd_printk() for debugging purposes.
  59  * Ignored when CONFIG_SND_DEBUG_VERBOSE is not set.
  60  * Must set snd module debug parameter to 3 to enable at runtime.
  61  */
  62 #define snd_printddd(format, args...) \
  63         __snd_printk(3, __FILE__, __LINE__, format, ##args)
  64 #else
  65 #define snd_printddd(format, args...) do { } while (0)
  66 #endif
  67
  68 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;      /* index 0-MAX */
  69 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;       /* ID for this card */
  70 static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
  71 static bool enable_hpi_hwdep = 1;
  72
  73 module_param_array(index, int, NULL, S_IRUGO);
  74 MODULE_PARM_DESC(index, "ALSA index value for AudioScience soundcard.");
  75
  76 module_param_array(id, charp, NULL, S_IRUGO);
  77 MODULE_PARM_DESC(id, "ALSA ID string for AudioScience soundcard.");
  78
  79 module_param_array(enable, bool, NULL, S_IRUGO);
  80 MODULE_PARM_DESC(enable, "ALSA enable AudioScience soundcard.");
  81
  82 module_param(enable_hpi_hwdep, bool, S_IRUGO|S_IWUSR);
  83 MODULE_PARM_DESC(enable_hpi_hwdep,
  84                 "ALSA enable HPI hwdep for AudioScience soundcard ");
  85
  86 /* identify driver */
  87 #ifdef KERNEL_ALSA_BUILD
  88 static char *build_info = "Built using headers from kernel source";
  89 module_param(build_info, charp, S_IRUGO);
  90 MODULE_PARM_DESC(build_info, "built using headers from kernel source");
  91 #else
  92 static char *build_info = "Built within ALSA source";
  93 module_param(build_info, charp, S_IRUGO);
  94 MODULE_PARM_DESC(build_info, "built within ALSA source");
  95 #endif
  96
  97 /* set to 1 to dump every control from adapter to log */
  98 static const int mixer_dump;
  99
 100 #define DEFAULT_SAMPLERATE 44100
 101 static int adapter_fs = DEFAULT_SAMPLERATE;
 102
 103 /* defaults */
 104 #define PERIODS_MIN 2
 105 #define PERIOD_BYTES_MIN  2048
 106 #define BUFFER_BYTES_MAX (512 * 1024)
 107
 108 #define MAX_CLOCKSOURCES (HPI_SAMPLECLOCK_SOURCE_LAST + 1 + 7)
 109
 110 struct clk_source {
 111         int source;
 112         int index;
 113         char *name;
 114 };
 115
 116 struct clk_cache {
 117         int count;
 118         int has_local;
 119         struct clk_source s[MAX_CLOCKSOURCES];
 120 };
 121
 122 /* Per card data */
 123 struct snd_card_asihpi {
 124         struct snd_card *card;
 125         struct pci_dev *pci;
 126         struct hpi_adapter *hpi;
 127
 128         u32 h_mixer;
 129         struct clk_cache cc;
 130
 131         u16 can_dma;
 132         u16 support_grouping;
 133         u16 support_mrx;
 134         u16 update_interval_frames;
 135         u16 in_max_chans;
 136         u16 out_max_chans;
 137         u16 in_min_chans;
 138         u16 out_min_chans;
 139 };
 140
 141 /* Per stream data */
 142 struct snd_card_asihpi_pcm {
 143         struct timer_list timer;
 144         unsigned int respawn_timer;
 145         unsigned int hpi_buffer_attached;
 146         unsigned int buffer_bytes;
 147         unsigned int period_bytes;
 148         unsigned int bytes_per_sec;
 149         unsigned int pcm_buf_host_rw_ofs; /* Host R/W pos */
 150         unsigned int pcm_buf_dma_ofs;   /* DMA R/W offset in buffer */
 151         unsigned int pcm_buf_elapsed_dma_ofs;   /* DMA R/W offset in buffer */
 152         unsigned int drained_count;
 153         struct snd_pcm_substream *substream;
 154         u32 h_stream;
 155         struct hpi_format format;
 156 };
 157
 158 /* universal stream verbs work with out or in stream handles */
 159
 160 /* Functions to allow driver to give a buffer to HPI for busmastering */
 161
 162 static u16 hpi_stream_host_buffer_attach(
 163         u32 h_stream,   /* handle to outstream. */
 164         u32 size_in_bytes, /* size in bytes of bus mastering buffer */
 165         u32 pci_address
 166 )
 167 {
 168         struct hpi_message hm;
 169         struct hpi_response hr;
 170         unsigned int obj = hpi_handle_object(h_stream);
 171
 172         if (!h_stream)
 173                 return HPI_ERROR_INVALID_OBJ;
 174         hpi_init_message_response(&hm, &hr, obj,
 175                         obj == HPI_OBJ_OSTREAM ?
 176                                 HPI_OSTREAM_HOSTBUFFER_ALLOC :
 177                                 HPI_ISTREAM_HOSTBUFFER_ALLOC);
 178
 179         hpi_handle_to_indexes(h_stream, &hm.adapter_index,
 180                                 &hm.obj_index);
 181
 182         hm.u.d.u.buffer.buffer_size = size_in_bytes;
 183         hm.u.d.u.buffer.pci_address = pci_address;
 184         hm.u.d.u.buffer.command = HPI_BUFFER_CMD_INTERNAL_GRANTADAPTER;
 185         hpi_send_recv(&hm, &hr);
 186         return hr.error;
 187 }
 188
 189 static u16 hpi_stream_host_buffer_detach(u32  h_stream)
 190 {
 191         struct hpi_message hm;
 192         struct hpi_response hr;
 193         unsigned int obj = hpi_handle_object(h_stream);
 194
 195         if (!h_stream)
 196                 return HPI_ERROR_INVALID_OBJ;
 197
 198         hpi_init_message_response(&hm, &hr,  obj,
 199                         obj == HPI_OBJ_OSTREAM ?
 200                                 HPI_OSTREAM_HOSTBUFFER_FREE :
 201                                 HPI_ISTREAM_HOSTBUFFER_FREE);
 202
 203         hpi_handle_to_indexes(h_stream, &hm.adapter_index,
 204                                 &hm.obj_index);
 205         hm.u.d.u.buffer.command = HPI_BUFFER_CMD_INTERNAL_REVOKEADAPTER;
 206         hpi_send_recv(&hm, &hr);
 207         return hr.error;
 208 }
 209
 210 static inline u16 hpi_stream_start(u32 h_stream)
 211 {
 212         if (hpi_handle_object(h_stream) ==  HPI_OBJ_OSTREAM)
 213                 return hpi_outstream_start(h_stream);
 214         else
 215                 return hpi_instream_start(h_stream);
 216 }
 217
 218 static inline u16 hpi_stream_stop(u32 h_stream)
 219 {
 220         if (hpi_handle_object(h_stream) ==  HPI_OBJ_OSTREAM)
 221                 return hpi_outstream_stop(h_stream);
 222         else
 223                 return hpi_instream_stop(h_stream);
 224 }
 225
 226 static inline u16 hpi_stream_get_info_ex(
 227     u32 h_stream,
 228     u16        *pw_state,
 229     u32        *pbuffer_size,
 230     u32        *pdata_in_buffer,
 231     u32        *psample_count,
 232     u32        *pauxiliary_data
 233 )
 234 {
 235         u16 e;
 236         if (hpi_handle_object(h_stream)  ==  HPI_OBJ_OSTREAM)
 237                 e = hpi_outstream_get_info_ex(h_stream, pw_state,
 238                                         pbuffer_size, pdata_in_buffer,
 239                                         psample_count, pauxiliary_data);
 240         else
 241                 e = hpi_instream_get_info_ex(h_stream, pw_state,
 242                                         pbuffer_size, pdata_in_buffer,
 243                                         psample_count, pauxiliary_data);
 244         return e;
 245 }
 246
 247 static inline u16 hpi_stream_group_add(
 248                                         u32 h_master,
 249                                         u32 h_stream)
 250 {
 251         if (hpi_handle_object(h_master) ==  HPI_OBJ_OSTREAM)
 252                 return hpi_outstream_group_add(h_master, h_stream);
 253         else
 254                 return hpi_instream_group_add(h_master, h_stream);
 255 }
 256
 257 static inline u16 hpi_stream_group_reset(u32 h_stream)
 258 {
 259         if (hpi_handle_object(h_stream) ==  HPI_OBJ_OSTREAM)
 260                 return hpi_outstream_group_reset(h_stream);
 261         else
 262                 return hpi_instream_group_reset(h_stream);
 263 }
 264
 265 static inline u16 hpi_stream_group_get_map(
 266                                 u32 h_stream, u32 *mo, u32 *mi)
 267 {
 268         if (hpi_handle_object(h_stream) ==  HPI_OBJ_OSTREAM)
 269                 return hpi_outstream_group_get_map(h_stream, mo, mi);
 270         else
 271                 return hpi_instream_group_get_map(h_stream, mo, mi);
 272 }
 273
 274 static u16 handle_error(u16 err, int line, char *filename)
 275 {
 276         if (err)
 277                 printk(KERN_WARNING
 278                         "in file %s, line %d: HPI error %d\n",
 279                         filename, line, err);
 280         return err;
 281 }
 282
 283 #define hpi_handle_error(x)  handle_error(x, __LINE__, __FILE__)
 284
 285 /***************************** GENERAL PCM ****************/
 286
 287 static void print_hwparams(struct snd_pcm_substream *substream,
 288                                 struct snd_pcm_hw_params *p)
 289 {
 290         char name[16];
 291         snd_pcm_debug_name(substream, name, sizeof(name));
 292         snd_printd("%s HWPARAMS\n", name);
 293         snd_printd(" samplerate %d Hz\n", params_rate(p));
 294         snd_printd(" channels %d\n", params_channels(p));
 295         snd_printd(" format %d\n", params_format(p));
 296         snd_printd(" subformat %d\n", params_subformat(p));
 297         snd_printd(" buffer %d B\n", params_buffer_bytes(p));
 298         snd_printd(" period %d B\n", params_period_bytes(p));
 299         snd_printd(" access %d\n", params_access(p));
 300         snd_printd(" period_size %d\n", params_period_size(p));
 301         snd_printd(" periods %d\n", params_periods(p));
 302         snd_printd(" buffer_size %d\n", params_buffer_size(p));
 303         snd_printd(" %d B/s\n", params_rate(p) *
 304                 params_channels(p) *
 305                 snd_pcm_format_width(params_format(p)) / 8);
 306
 307 }
 308
 309 static snd_pcm_format_t hpi_to_alsa_formats[] = {
 310         -1,                     /* INVALID */
 311         SNDRV_PCM_FORMAT_U8,    /* HPI_FORMAT_PCM8_UNSIGNED        1 */
 312         SNDRV_PCM_FORMAT_S16,   /* HPI_FORMAT_PCM16_SIGNED         2 */
 313         -1,                     /* HPI_FORMAT_MPEG_L1              3 */
 314         SNDRV_PCM_FORMAT_MPEG,  /* HPI_FORMAT_MPEG_L2              4 */
 315         SNDRV_PCM_FORMAT_MPEG,  /* HPI_FORMAT_MPEG_L3              5 */
 316         -1,                     /* HPI_FORMAT_DOLBY_AC2            6 */
 317         -1,                     /* HPI_FORMAT_DOLBY_AC3            7 */
 318         SNDRV_PCM_FORMAT_S16_BE,/* HPI_FORMAT_PCM16_BIGENDIAN      8 */
 319         -1,                     /* HPI_FORMAT_AA_TAGIT1_HITS       9 */
 320         -1,                     /* HPI_FORMAT_AA_TAGIT1_INSERTS   10 */
 321         SNDRV_PCM_FORMAT_S32,   /* HPI_FORMAT_PCM32_SIGNED        11 */
 322         -1,                     /* HPI_FORMAT_RAW_BITSTREAM       12 */
 323         -1,                     /* HPI_FORMAT_AA_TAGIT1_HITS_EX1  13 */
 324         SNDRV_PCM_FORMAT_FLOAT, /* HPI_FORMAT_PCM32_FLOAT         14 */
 325 #if 1
 326         /* ALSA can't handle 3 byte sample size together with power-of-2
 327          *  constraint on buffer_bytes, so disable this format
 328          */
 329         -1
 330 #else
 331         /* SNDRV_PCM_FORMAT_S24_3LE */ /* HPI_FORMAT_PCM24_SIGNED 15 */
 332 #endif
 333 };
 334
 335
 336 static int snd_card_asihpi_format_alsa2hpi(snd_pcm_format_t alsa_format,
 337                                            u16 *hpi_format)
 338 {
 339         u16 format;
 340
 341         for (format = HPI_FORMAT_PCM8_UNSIGNED;
 342              format <= HPI_FORMAT_PCM24_SIGNED; format++) {
 343                 if (hpi_to_alsa_formats[format] == alsa_format) {
 344                         *hpi_format = format;
 345                         return 0;
 346                 }
 347         }
 348
 349         snd_printd(KERN_WARNING "failed match for alsa format %d\n",
 350                    alsa_format);
 351         *hpi_format = 0;
 352         return -EINVAL;
 353 }
 354
 355 static void snd_card_asihpi_pcm_samplerates(struct snd_card_asihpi *asihpi,
 356                                          struct snd_pcm_hardware *pcmhw)
 357 {
 358         u16 err;
 359         u32 h_control;
 360         u32 sample_rate;
 361         int idx;
 362         unsigned int rate_min = 200000;
 363         unsigned int rate_max = 0;
 364         unsigned int rates = 0;
 365
 366         if (asihpi->support_mrx) {
 367                 rates |= SNDRV_PCM_RATE_CONTINUOUS;
 368                 rates |= SNDRV_PCM_RATE_8000_96000;
 369                 rate_min = 8000;
 370                 rate_max = 100000;
 371         } else {
 372                 /* on cards without SRC,
 373                    valid rates are determined by sampleclock */
 374                 err = hpi_mixer_get_control(asihpi->h_mixer,
 375                                           HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
 376                                           HPI_CONTROL_SAMPLECLOCK, &h_control);
 377                 if (err) {
 378                         snd_printk(KERN_ERR
 379                                 "No local sampleclock, err %d\n", err);
 380                 }
 381
 382                 for (idx = -1; idx < 100; idx++) {
 383                         if (idx == -1) {
 384                                 if (hpi_sample_clock_get_sample_rate(h_control,
 385                                                                 &sample_rate))
 386                                         continue;
 387                         } else if (hpi_sample_clock_query_local_rate(h_control,
 388                                                         idx, &sample_rate)) {
 389                                 break;
 390                         }
 391
 392                         rate_min = min(rate_min, sample_rate);
 393                         rate_max = max(rate_max, sample_rate);
 394
 395                         switch (sample_rate) {
 396                         case 5512:
 397                                 rates |= SNDRV_PCM_RATE_5512;
 398                                 break;
 399                         case 8000:
 400                                 rates |= SNDRV_PCM_RATE_8000;
 401                                 break;
 402                         case 11025:
 403                                 rates |= SNDRV_PCM_RATE_11025;
 404                                 break;
 405                         case 16000:
 406                                 rates |= SNDRV_PCM_RATE_16000;
 407                                 break;
 408                         case 22050:
 409                                 rates |= SNDRV_PCM_RATE_22050;
 410                                 break;
 411                         case 32000:
 412                                 rates |= SNDRV_PCM_RATE_32000;
 413                                 break;
 414                         case 44100:
 415                                 rates |= SNDRV_PCM_RATE_44100;
 416                                 break;
 417                         case 48000:
 418                                 rates |= SNDRV_PCM_RATE_48000;
 419                                 break;
 420                         case 64000:
 421                                 rates |= SNDRV_PCM_RATE_64000;
 422                                 break;
 423                         case 88200:
 424                                 rates |= SNDRV_PCM_RATE_88200;
 425                                 break;
 426                         case 96000:
 427                                 rates |= SNDRV_PCM_RATE_96000;
 428                                 break;
 429                         case 176400:
 430                                 rates |= SNDRV_PCM_RATE_176400;
 431                                 break;
 432                         case 192000:
 433                                 rates |= SNDRV_PCM_RATE_192000;
 434                                 break;
 435                         default: /* some other rate */
 436                                 rates |= SNDRV_PCM_RATE_KNOT;
 437                         }
 438                 }
 439         }
 440
 441         pcmhw->rates = rates;
 442         pcmhw->rate_min = rate_min;
 443         pcmhw->rate_max = rate_max;
 444 }
 445
 446 static int snd_card_asihpi_pcm_hw_params(struct snd_pcm_substream *substream,
 447                                          struct snd_pcm_hw_params *params)
 448 {
 449         struct snd_pcm_runtime *runtime = substream->runtime;
 450         struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
 451         struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
 452         int err;
 453         u16 format;
 454         int width;
 455         unsigned int bytes_per_sec;
 456
 457         print_hwparams(substream, params);
 458         err = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
 459         if (err < 0)
 460                 return err;
 461         err = snd_card_asihpi_format_alsa2hpi(params_format(params), &format);
 462         if (err)
 463                 return err;
 464
 465         hpi_handle_error(hpi_format_create(&dpcm->format,
 466                         params_channels(params),
 467                         format, params_rate(params), 0, 0));
 468
 469         if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
 470                 if (hpi_instream_reset(dpcm->h_stream) != 0)
 471                         return -EINVAL;
 472
 473                 if (hpi_instream_set_format(
 474                         dpcm->h_stream, &dpcm->format) != 0)
 475                         return -EINVAL;
 476         }
 477
 478         dpcm->hpi_buffer_attached = 0;
 479         if (card->can_dma) {
 480                 err = hpi_stream_host_buffer_attach(dpcm->h_stream,
 481                         params_buffer_bytes(params),  runtime->dma_addr);
 482                 if (err == 0) {
 483                         snd_printdd(
 484                                 "stream_host_buffer_attach succeeded %u %lu\n",
 485                                 params_buffer_bytes(params),
 486                                 (unsigned long)runtime->dma_addr);
 487                 } else {
 488                         snd_printd("stream_host_buffer_attach error %d\n",
 489                                         err);
 490                         return -ENOMEM;
 491                 }
 492
 493                 err = hpi_stream_get_info_ex(dpcm->h_stream, NULL,
 494                                                 &dpcm->hpi_buffer_attached,
 495                                                 NULL, NULL, NULL);
 496
 497                 snd_printdd("stream_host_buffer_attach status 0x%x\n",
 498                                 dpcm->hpi_buffer_attached);
 499
 500         }
 501         bytes_per_sec = params_rate(params) * params_channels(params);
 502         width = snd_pcm_format_width(params_format(params));
 503         bytes_per_sec *= width;
 504         bytes_per_sec /= 8;
 505         if (width < 0 || bytes_per_sec == 0)
 506                 return -EINVAL;
 507
 508         dpcm->bytes_per_sec = bytes_per_sec;
 509         dpcm->buffer_bytes = params_buffer_bytes(params);
 510         dpcm->period_bytes = params_period_bytes(params);
 511
 512         return 0;
 513 }
 514
 515 static int
 516 snd_card_asihpi_hw_free(struct snd_pcm_substream *substream)
 517 {
 518         struct snd_pcm_runtime *runtime = substream->runtime;
 519         struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
 520         if (dpcm->hpi_buffer_attached)
 521                 hpi_stream_host_buffer_detach(dpcm->h_stream);
 522
 523         snd_pcm_lib_free_pages(substream);
 524         return 0;
 525 }
 526
 527 static void snd_card_asihpi_runtime_free(struct snd_pcm_runtime *runtime)
 528 {
 529         struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
 530         kfree(dpcm);
 531 }
 532
 533 static void snd_card_asihpi_pcm_timer_start(struct snd_pcm_substream *
 534                                             substream)
 535 {
 536         struct snd_pcm_runtime *runtime = substream->runtime;
 537         struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
 538         int expiry;
 539
 540         expiry = HZ / 200;
 541         /*? (dpcm->period_bytes * HZ / dpcm->bytes_per_sec); */
 542         expiry = max(expiry, 1); /* don't let it be zero! */
 543         dpcm->timer.expires = jiffies + expiry;
 544         dpcm->respawn_timer = 1;
 545         add_timer(&dpcm->timer);
 546 }
 547
 548 static void snd_card_asihpi_pcm_timer_stop(struct snd_pcm_substream *substream)
 549 {
 550         struct snd_pcm_runtime *runtime = substream->runtime;
 551         struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
 552
 553         dpcm->respawn_timer = 0;
 554         del_timer(&dpcm->timer);
 555 }
 556
 557 static int snd_card_asihpi_trigger(struct snd_pcm_substream *substream,
 558                                            int cmd)
 559 {
 560         struct snd_card_asihpi_pcm *dpcm = substream->runtime->private_data;
 561         struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
 562         struct snd_pcm_substream *s;
 563         u16 e;
 564         char name[16];
 565
 566         snd_pcm_debug_name(substream, name, sizeof(name));
 567         snd_printdd("%s trigger\n", name);
 568
 569         switch (cmd) {
 570         case SNDRV_PCM_TRIGGER_START:
 571                 snd_pcm_group_for_each_entry(s, substream) {
 572                         struct snd_pcm_runtime *runtime = s->runtime;
 573                         struct snd_card_asihpi_pcm *ds = runtime->private_data;
 574
 575                         if (snd_pcm_substream_chip(s) != card)
 576                                 continue;
 577
 578                         /* don't link Cap and Play */
 579                         if (substream->stream != s->stream)
 580                                 continue;
 581
 582                         ds->drained_count = 0;
 583                         if (s->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 584                                 /* How do I know how much valid data is present
 585                                 * in buffer? Must be at least one period!
 586                                 * Guessing 2 periods, but if
 587                                 * buffer is bigger it may contain even more
 588                                 * data??
 589                                 */
 590                                 unsigned int preload = ds->period_bytes * 1;
 591                                 snd_printddd("%d preload x%x\n", s->number, preload);
 592                                 hpi_handle_error(hpi_outstream_write_buf(
 593                                                 ds->h_stream,
 594                                                 &runtime->dma_area[0],
 595                                                 preload,
 596                                                 &ds->format));
 597                                 ds->pcm_buf_host_rw_ofs = preload;
 598                         }
 599
 600                         if (card->support_grouping) {
 601                                 snd_printdd("%d group\n", s->number);
 602                                 e = hpi_stream_group_add(
 603                                         dpcm->h_stream,
 604                                         ds->h_stream);
 605                                 if (!e) {
 606                                         snd_pcm_trigger_done(s, substream);
 607                                 } else {
 608                                         hpi_handle_error(e);
 609                                         break;
 610                                 }
 611                         } else
 612                                 break;
 613                 }
 614                 snd_printdd("start\n");
 615                 /* start the master stream */
 616                 snd_card_asihpi_pcm_timer_start(substream);
 617                 if ((substream->stream == SNDRV_PCM_STREAM_CAPTURE) ||
 618                         !card->can_dma)
 619                         hpi_handle_error(hpi_stream_start(dpcm->h_stream));
 620                 break;
 621
 622         case SNDRV_PCM_TRIGGER_STOP:
 623                 snd_card_asihpi_pcm_timer_stop(substream);
 624                 snd_pcm_group_for_each_entry(s, substream) {
 625                         if (snd_pcm_substream_chip(s) != card)
 626                                 continue;
 627                         /* don't link Cap and Play */
 628                         if (substream->stream != s->stream)
 629                                 continue;
 630
 631                         /*? workaround linked streams don't
 632                         transition to SETUP 20070706*/
 633                         s->runtime->status->state = SNDRV_PCM_STATE_SETUP;
 634
 635                         if (card->support_grouping) {
 636                                 snd_printdd("%d group\n", s->number);
 637                                 snd_pcm_trigger_done(s, substream);
 638                         } else
 639                                 break;
 640                 }
 641                 snd_printdd("stop\n");
 642
 643                 /* _prepare and _hwparams reset the stream */
 644                 hpi_handle_error(hpi_stream_stop(dpcm->h_stream));
 645                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 646                         hpi_handle_error(
 647                                 hpi_outstream_reset(dpcm->h_stream));
 648
 649                 if (card->support_grouping)
 650                         hpi_handle_error(hpi_stream_group_reset(dpcm->h_stream));
 651                 break;
 652
 653         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 654                 snd_printdd("pause release\n");
 655                 hpi_handle_error(hpi_stream_start(dpcm->h_stream));
 656                 snd_card_asihpi_pcm_timer_start(substream);
 657                 break;
 658         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 659                 snd_printdd("pause\n");
 660                 snd_card_asihpi_pcm_timer_stop(substream);
 661                 hpi_handle_error(hpi_stream_stop(dpcm->h_stream));
 662                 break;
 663         default:
 664                 snd_printd(KERN_ERR "\tINVALID\n");
 665                 return -EINVAL;
 666         }
 667
 668         return 0;
 669 }
 670
 671 /*algorithm outline
 672  Without linking degenerates to getting single stream pos etc
 673  Without mmap 2nd loop degenerates to snd_pcm_period_elapsed
 674 */
 675 /*
 676 pcm_buf_dma_ofs=get_buf_pos(s);
 677 for_each_linked_stream(s) {
 678         pcm_buf_dma_ofs=get_buf_pos(s);
 679         min_buf_pos = modulo_min(min_buf_pos, pcm_buf_dma_ofs, buffer_bytes)
 680         new_data = min(new_data, calc_new_data(pcm_buf_dma_ofs,irq_pos)
 681 }
 682 timer.expires = jiffies + predict_next_period_ready(min_buf_pos);
 683 for_each_linked_stream(s) {
 684         s->pcm_buf_dma_ofs = min_buf_pos;
 685         if (new_data > period_bytes) {
 686                 if (mmap) {
 687                         irq_pos = (irq_pos + period_bytes) % buffer_bytes;
 688                         if (playback) {
 689                                 write(period_bytes);
 690                         } else {
 691                                 read(period_bytes);
 692                         }
 693                 }
 694                 snd_pcm_period_elapsed(s);
 695         }
 696 }
 697 */
 698
 699 /** Minimum of 2 modulo values.  Works correctly when the difference between
 700 * the values is less than half the modulus
 701 */
 702 static inline unsigned int modulo_min(unsigned int a, unsigned int b,
 703                                         unsigned long int modulus)
 704 {
 705         unsigned int result;
 706         if (((a-b) % modulus) < (modulus/2))
 707                 result = b;
 708         else
 709                 result = a;
 710
 711         return result;
 712 }
 713
 714 /** Timer function, equivalent to interrupt service routine for cards
 715 */
 716 static void snd_card_asihpi_timer_function(unsigned long data)
 717 {
 718         struct snd_card_asihpi_pcm *dpcm = (struct snd_card_asihpi_pcm *)data;
 719         struct snd_pcm_substream *substream = dpcm->substream;
 720         struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
 721         struct snd_pcm_runtime *runtime;
 722         struct snd_pcm_substream *s;
 723         unsigned int newdata = 0;
 724         unsigned int pcm_buf_dma_ofs, min_buf_pos = 0;
 725         unsigned int remdata, xfercount, next_jiffies;
 726         int first = 1;
 727         int loops = 0;
 728         u16 state;
 729         u32 buffer_size, bytes_avail, samples_played, on_card_bytes;
 730         char name[16];
 731
 732         snd_pcm_debug_name(substream, name, sizeof(name));
 733
 734         snd_printdd("%s snd_card_asihpi_timer_function\n", name);
 735
 736         /* find minimum newdata and buffer pos in group */
 737         snd_pcm_group_for_each_entry(s, substream) {
 738                 struct snd_card_asihpi_pcm *ds = s->runtime->private_data;
 739                 runtime = s->runtime;
 740
 741                 if (snd_pcm_substream_chip(s) != card)
 742                         continue;
 743
 744                 /* don't link Cap and Play */
 745                 if (substream->stream != s->stream)
 746                         continue;
 747
 748                 hpi_handle_error(hpi_stream_get_info_ex(
 749                                         ds->h_stream, &state,
 750                                         &buffer_size, &bytes_avail,
 751                                         &samples_played, &on_card_bytes));
 752
 753                 /* number of bytes in on-card buffer */
 754                 runtime->delay = on_card_bytes;
 755
 756                 if (!card->can_dma)
 757                         on_card_bytes = bytes_avail;
 758
 759                 if (s->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 760                         pcm_buf_dma_ofs = ds->pcm_buf_host_rw_ofs - bytes_avail;
 761                         if (state == HPI_STATE_STOPPED) {
 762                                 if (bytes_avail == 0) {
 763                                         hpi_handle_error(hpi_stream_start(ds->h_stream));
 764                                         snd_printdd("P%d start\n", s->number);
 765                                         ds->drained_count = 0;
 766                                 }
 767                         } else if (state == HPI_STATE_DRAINED) {
 768                                 snd_printd(KERN_WARNING "P%d drained\n",
 769                                                 s->number);
 770                                 ds->drained_count++;
 771                                 if (ds->drained_count > 20) {
 772                                         snd_pcm_stop(s, SNDRV_PCM_STATE_XRUN);
 773                                         continue;
 774                                 }
 775                         } else {
 776                                 ds->drained_count = 0;
 777                         }
 778                 } else
 779                         pcm_buf_dma_ofs = bytes_avail + ds->pcm_buf_host_rw_ofs;
 780
 781                 if (first) {
 782                         /* can't statically init min when wrap is involved */
 783                         min_buf_pos = pcm_buf_dma_ofs;
 784                         newdata = (pcm_buf_dma_ofs - ds->pcm_buf_elapsed_dma_ofs) % ds->buffer_bytes;
 785                         first = 0;
 786                 } else {
 787                         min_buf_pos =
 788                                 modulo_min(min_buf_pos, pcm_buf_dma_ofs, UINT_MAX+1L);
 789                         newdata = min(
 790                                 (pcm_buf_dma_ofs - ds->pcm_buf_elapsed_dma_ofs) % ds->buffer_bytes,
 791                                 newdata);
 792                 }
 793
 794                 snd_printdd("hw_ptr 0x%04lX, appl_ptr 0x%04lX\n",
 795                         (unsigned long)frames_to_bytes(runtime,
 796                                                 runtime->status->hw_ptr),
 797                         (unsigned long)frames_to_bytes(runtime,
 798                                                 runtime->control->appl_ptr));
 799
 800                 snd_printdd("%d S=%d, "
 801                         "rw=0x%04X, dma=0x%04X, left=0x%04X, "
 802                         "aux=0x%04X space=0x%04X\n",
 803                         s->number, state,
 804                         ds->pcm_buf_host_rw_ofs, pcm_buf_dma_ofs,
 805                         (int)bytes_avail,
 806                         (int)on_card_bytes, buffer_size-bytes_avail);
 807                 loops++;
 808         }
 809         pcm_buf_dma_ofs = min_buf_pos;
 810
 811         remdata = newdata % dpcm->period_bytes;
 812         xfercount = newdata - remdata; /* a multiple of period_bytes */
 813         /* come back when on_card_bytes has decreased enough to allow
 814            write to happen, or when data has been consumed to make another
 815            period
 816         */
 817         if (xfercount && (on_card_bytes  > dpcm->period_bytes))
 818                 next_jiffies = ((on_card_bytes - dpcm->period_bytes) * HZ / dpcm->bytes_per_sec);
 819         else
 820                 next_jiffies = ((dpcm->period_bytes - remdata) * HZ / dpcm->bytes_per_sec);
 821
 822         next_jiffies = max(next_jiffies, 1U);
 823         dpcm->timer.expires = jiffies + next_jiffies;
 824         snd_printdd("jif %d buf pos 0x%04X newdata 0x%04X xfer 0x%04X\n",
 825                         next_jiffies, pcm_buf_dma_ofs, newdata, xfercount);
 826
 827         snd_pcm_group_for_each_entry(s, substream) {
 828                 struct snd_card_asihpi_pcm *ds = s->runtime->private_data;
 829
 830                 /* don't link Cap and Play */
 831                 if (substream->stream != s->stream)
 832                         continue;
 833
 834                 ds->pcm_buf_dma_ofs = pcm_buf_dma_ofs;
 835
 836                 if (xfercount &&
 837                         /* Limit use of on card fifo for playback */
 838                         ((on_card_bytes <= ds->period_bytes) ||
 839                         (s->stream == SNDRV_PCM_STREAM_CAPTURE)))
 840
 841                 {
 842
 843                         unsigned int buf_ofs = ds->pcm_buf_host_rw_ofs % ds->buffer_bytes;
 844                         unsigned int xfer1, xfer2;
 845                         char *pd = &s->runtime->dma_area[buf_ofs];
 846
 847                         if (card->can_dma) { /* buffer wrap is handled at lower level */
 848                                 xfer1 = xfercount;
 849                                 xfer2 = 0;
 850                         } else {
 851                                 xfer1 = min(xfercount, ds->buffer_bytes - buf_ofs);
 852                                 xfer2 = xfercount - xfer1;
 853                         }
 854
 855                         if (s->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 856                                 snd_printddd("P%d write1 0x%04X 0x%04X\n",
 857                                         s->number, xfer1, buf_ofs);
 858                                 hpi_handle_error(
 859                                         hpi_outstream_write_buf(
 860                                                 ds->h_stream, pd, xfer1,
 861                                                 &ds->format));
 862
 863                                 if (xfer2) {
 864                                         pd = s->runtime->dma_area;
 865
 866                                         snd_printddd("P%d write2 0x%04X 0x%04X\n",
 867                                                         s->number,
 868                                                         xfercount - xfer1, buf_ofs);
 869                                         hpi_handle_error(
 870                                                 hpi_outstream_write_buf(
 871                                                         ds->h_stream, pd,
 872                                                         xfercount - xfer1,
 873                                                         &ds->format));
 874                                 }
 875                         } else {
 876                                 snd_printddd("C%d read1 0x%04x\n",
 877                                         s->number, xfer1);
 878                                 hpi_handle_error(
 879                                         hpi_instream_read_buf(
 880                                                 ds->h_stream,
 881                                                 pd, xfer1));
 882                                 if (xfer2) {
 883                                         pd = s->runtime->dma_area;
 884                                         snd_printddd("C%d read2 0x%04x\n",
 885                                                 s->number, xfer2);
 886                                         hpi_handle_error(
 887                                                 hpi_instream_read_buf(
 888                                                         ds->h_stream,
 889                                                         pd, xfer2));
 890                                 }
 891                         }
 892                         ds->pcm_buf_host_rw_ofs += xfercount;
 893                         ds->pcm_buf_elapsed_dma_ofs += xfercount;
 894                         snd_pcm_period_elapsed(s);
 895                 }
 896         }
 897
 898         if (dpcm->respawn_timer)
 899                 add_timer(&dpcm->timer);
 900 }
 901
 902 /***************************** PLAYBACK OPS ****************/
 903 static int snd_card_asihpi_playback_ioctl(struct snd_pcm_substream *substream,
 904                                           unsigned int cmd, void *arg)
 905 {
 906         char name[16];
 907         snd_pcm_debug_name(substream, name, sizeof(name));
 908         snd_printddd(KERN_INFO "%s ioctl %d\n", name, cmd);
 909         return snd_pcm_lib_ioctl(substream, cmd, arg);
 910 }
 911
 912 static int snd_card_asihpi_playback_prepare(struct snd_pcm_substream *
 913                                             substream)
 914 {
 915         struct snd_pcm_runtime *runtime = substream->runtime;
 916         struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
 917
 918         snd_printdd("P%d prepare\n", substream->number);
 919
 920         hpi_handle_error(hpi_outstream_reset(dpcm->h_stream));
 921         dpcm->pcm_buf_host_rw_ofs = 0;
 922         dpcm->pcm_buf_dma_ofs = 0;
 923         dpcm->pcm_buf_elapsed_dma_ofs = 0;
 924         return 0;
 925 }
 926
 927 static snd_pcm_uframes_t
 928 snd_card_asihpi_playback_pointer(struct snd_pcm_substream *substream)
 929 {
 930         struct snd_pcm_runtime *runtime = substream->runtime;
 931         struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
 932         snd_pcm_uframes_t ptr;
 933         char name[16];
 934         snd_pcm_debug_name(substream, name, sizeof(name));
 935
 936         ptr = bytes_to_frames(runtime, dpcm->pcm_buf_dma_ofs  % dpcm->buffer_bytes);
 937         snd_printddd("%s pointer = 0x%04lx\n", name, (unsigned long)ptr);
 938         return ptr;
 939 }
 940
 941 static u64 snd_card_asihpi_playback_formats(struct snd_card_asihpi *asihpi,
 942                                                 u32 h_stream)
 943 {
 944         struct hpi_format hpi_format;
 945         u16 format;
 946         u16 err;
 947         u32 h_control;
 948         u32 sample_rate = 48000;
 949         u64 formats = 0;
 950
 951         /* on cards without SRC, must query at valid rate,
 952         * maybe set by external sync
 953         */
 954         err = hpi_mixer_get_control(asihpi->h_mixer,
 955                                   HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
 956                                   HPI_CONTROL_SAMPLECLOCK, &h_control);
 957
 958         if (!err)
 959                 err = hpi_sample_clock_get_sample_rate(h_control,
 960                                 &sample_rate);
 961
 962         for (format = HPI_FORMAT_PCM8_UNSIGNED;
 963              format <= HPI_FORMAT_PCM24_SIGNED; format++) {
 964                 err = hpi_format_create(&hpi_format, asihpi->out_max_chans,
 965                                         format, sample_rate, 128000, 0);
 966                 if (!err)
 967                         err = hpi_outstream_query_format(h_stream, &hpi_format);
 968                 if (!err && (hpi_to_alsa_formats[format] != -1))
 969                         formats |= (1ULL << hpi_to_alsa_formats[format]);
 970         }
 971         return formats;
 972 }
 973
 974 static int snd_card_asihpi_playback_open(struct snd_pcm_substream *substream)
 975 {
 976         struct snd_pcm_runtime *runtime = substream->runtime;
 977         struct snd_card_asihpi_pcm *dpcm;
 978         struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
 979         struct snd_pcm_hardware snd_card_asihpi_playback;
 980         int err;
 981
 982         dpcm = kzalloc(sizeof(*dpcm), GFP_KERNEL);
 983         if (dpcm == NULL)
 984                 return -ENOMEM;
 985
 986         err = hpi_outstream_open(card->hpi->adapter->index,
 987                               substream->number, &dpcm->h_stream);
 988         hpi_handle_error(err);
 989         if (err)
 990                 kfree(dpcm);
 991         if (err == HPI_ERROR_OBJ_ALREADY_OPEN)
 992                 return -EBUSY;
 993         if (err)
 994                 return -EIO;
 995
 996         /*? also check ASI5000 samplerate source
 997             If external, only support external rate.
 998             If internal and other stream playing, can't switch
 999         */
1000
1001         init_timer(&dpcm->timer);
1002         dpcm->timer.data = (unsigned long) dpcm;
1003         dpcm->timer.function = snd_card_asihpi_timer_function;
1004         dpcm->substream = substream;
1005         runtime->private_data = dpcm;
1006         runtime->private_free = snd_card_asihpi_runtime_free;
1007
1008         memset(&snd_card_asihpi_playback, 0, sizeof(snd_card_asihpi_playback));
1009         snd_card_asihpi_playback.buffer_bytes_max = BUFFER_BYTES_MAX;
1010         snd_card_asihpi_playback.period_bytes_min = PERIOD_BYTES_MIN;
1011         /*?snd_card_asihpi_playback.period_bytes_min =
1012         card->out_max_chans * 4096; */
1013         snd_card_asihpi_playback.period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN;
1014         snd_card_asihpi_playback.periods_min = PERIODS_MIN;
1015         snd_card_asihpi_playback.periods_max = BUFFER_BYTES_MAX / PERIOD_BYTES_MIN;
1016         /* snd_card_asihpi_playback.fifo_size = 0; */
1017         snd_card_asihpi_playback.channels_max = card->out_max_chans;
1018         snd_card_asihpi_playback.channels_min = card->out_min_chans;
1019         snd_card_asihpi_playback.formats =
1020                         snd_card_asihpi_playback_formats(card, dpcm->h_stream);
1021
1022         snd_card_asihpi_pcm_samplerates(card,  &snd_card_asihpi_playback);
1023
1024         snd_card_asihpi_playback.info = SNDRV_PCM_INFO_INTERLEAVED |
1025                                         SNDRV_PCM_INFO_DOUBLE |
1026                                         SNDRV_PCM_INFO_BATCH |
1027                                         SNDRV_PCM_INFO_BLOCK_TRANSFER |
1028                                         SNDRV_PCM_INFO_PAUSE |
1029                                         SNDRV_PCM_INFO_MMAP |
1030                                         SNDRV_PCM_INFO_MMAP_VALID;
1031
1032         if (card->support_grouping) {
1033                 snd_card_asihpi_playback.info |= SNDRV_PCM_INFO_SYNC_START;
1034                 snd_pcm_set_sync(substream);
1035         }
1036
1037         /* struct is copied, so can create initializer dynamically */
1038         runtime->hw = snd_card_asihpi_playback;
1039
1040         if (card->can_dma)
1041                 err = snd_pcm_hw_constraint_pow2(runtime, 0,
1042                                         SNDRV_PCM_HW_PARAM_BUFFER_BYTES);
1043         if (err < 0)
1044                 return err;
1045
1046         snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1047                 card->update_interval_frames);
1048
1049         snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1050                 card->update_interval_frames * 2, UINT_MAX);
1051
1052         snd_printdd("playback open\n");
1053
1054         return 0;
1055 }
1056
1057 static int snd_card_asihpi_playback_close(struct snd_pcm_substream *substream)
1058 {
1059         struct snd_pcm_runtime *runtime = substream->runtime;
1060         struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
1061
1062         hpi_handle_error(hpi_outstream_close(dpcm->h_stream));
1063         snd_printdd("playback close\n");
1064
1065         return 0;
1066 }
1067
1068 static struct snd_pcm_ops snd_card_asihpi_playback_mmap_ops = {
1069         .open = snd_card_asihpi_playback_open,
1070         .close = snd_card_asihpi_playback_close,
1071         .ioctl = snd_card_asihpi_playback_ioctl,
1072         .hw_params = snd_card_asihpi_pcm_hw_params,
1073         .hw_free = snd_card_asihpi_hw_free,
1074         .prepare = snd_card_asihpi_playback_prepare,
1075         .trigger = snd_card_asihpi_trigger,
1076         .pointer = snd_card_asihpi_playback_pointer,
1077 };
1078
1079 /***************************** CAPTURE OPS ****************/
1080 static snd_pcm_uframes_t
1081 snd_card_asihpi_capture_pointer(struct snd_pcm_substream *substream)
1082 {
1083         struct snd_pcm_runtime *runtime = substream->runtime;
1084         struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
1085
1086         snd_printddd("capture pointer %d=%d\n",
1087                         substream->number, dpcm->pcm_buf_dma_ofs);
1088         /* NOTE Unlike playback can't use actual samples_played
1089                 for the capture position, because those samples aren't yet in
1090                 the local buffer available for reading.
1091         */
1092         return bytes_to_frames(runtime, dpcm->pcm_buf_dma_ofs % dpcm->buffer_bytes);
1093 }
1094
1095 static int snd_card_asihpi_capture_ioctl(struct snd_pcm_substream *substream,
1096                                          unsigned int cmd, void *arg)
1097 {
1098         return snd_pcm_lib_ioctl(substream, cmd, arg);
1099 }
1100
1101 static int snd_card_asihpi_capture_prepare(struct snd_pcm_substream *substream)
1102 {
1103         struct snd_pcm_runtime *runtime = substream->runtime;
1104         struct snd_card_asihpi_pcm *dpcm = runtime->private_data;
1105
1106         hpi_handle_error(hpi_instream_reset(dpcm->h_stream));
1107         dpcm->pcm_buf_host_rw_ofs = 0;
1108         dpcm->pcm_buf_dma_ofs = 0;
1109         dpcm->pcm_buf_elapsed_dma_ofs = 0;
1110
1111         snd_printdd("Capture Prepare %d\n", substream->number);
1112         return 0;
1113 }
1114
1115
1116
1117 static u64 snd_card_asihpi_capture_formats(struct snd_card_asihpi *asihpi,
1118                                         u32 h_stream)
1119 {
1120   struct hpi_format hpi_format;
1121         u16 format;
1122         u16 err;
1123         u32 h_control;
1124         u32 sample_rate = 48000;
1125         u64 formats = 0;
1126
1127         /* on cards without SRC, must query at valid rate,
1128                 maybe set by external sync */
1129         err = hpi_mixer_get_control(asihpi->h_mixer,
1130                                   HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
1131                                   HPI_CONTROL_SAMPLECLOCK, &h_control);
1132
1133         if (!err)
1134                 err = hpi_sample_clock_get_sample_rate(h_control,
1135                         &sample_rate);
1136
1137         for (format = HPI_FORMAT_PCM8_UNSIGNED;
1138                 format <= HPI_FORMAT_PCM24_SIGNED; format++) {
1139
1140                 err = hpi_format_create(&hpi_format, asihpi->in_max_chans,
1141                                         format, sample_rate, 128000, 0);
1142                 if (!err)
1143                         err = hpi_instream_query_format(h_stream, &hpi_format);
1144                 if (!err)
1145                         formats |= (1ULL << hpi_to_alsa_formats[format]);
1146         }
1147         return formats;
1148 }
1149
1150 static int snd_card_asihpi_capture_open(struct snd_pcm_substream *substream)
1151 {
1152         struct snd_pcm_runtime *runtime = substream->runtime;
1153         struct snd_card_asihpi *card = snd_pcm_substream_chip(substream);
1154         struct snd_card_asihpi_pcm *dpcm;
1155         struct snd_pcm_hardware snd_card_asihpi_capture;
1156         int err;
1157
1158         dpcm = kzalloc(sizeof(*dpcm), GFP_KERNEL);
1159         if (dpcm == NULL)
1160                 return -ENOMEM;
1161
1162         snd_printdd("capture open adapter %d stream %d\n",
1163                         card->hpi->adapter->index, substream->number);
1164
1165         err = hpi_handle_error(
1166             hpi_instream_open(card->hpi->adapter->index,
1167                              substream->number, &dpcm->h_stream));
1168         if (err)
1169                 kfree(dpcm);
1170         if (err == HPI_ERROR_OBJ_ALREADY_OPEN)
1171                 return -EBUSY;
1172         if (err)
1173                 return -EIO;
1174
1175         init_timer(&dpcm->timer);
1176         dpcm->timer.data = (unsigned long) dpcm;
1177         dpcm->timer.function = snd_card_asihpi_timer_function;
1178         dpcm->substream = substream;
1179         runtime->private_data = dpcm;
1180         runtime->private_free = snd_card_asihpi_runtime_free;
1181
1182         memset(&snd_card_asihpi_capture, 0, sizeof(snd_card_asihpi_capture));
1183         snd_card_asihpi_capture.buffer_bytes_max = BUFFER_BYTES_MAX;
1184         snd_card_asihpi_capture.period_bytes_min = PERIOD_BYTES_MIN;
1185         snd_card_asihpi_capture.period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN;
1186         snd_card_asihpi_capture.periods_min = PERIODS_MIN;
1187         snd_card_asihpi_capture.periods_max = BUFFER_BYTES_MAX / PERIOD_BYTES_MIN;
1188         /* snd_card_asihpi_capture.fifo_size = 0; */
1189         snd_card_asihpi_capture.channels_max = card->in_max_chans;
1190         snd_card_asihpi_capture.channels_min = card->in_min_chans;
1191         snd_card_asihpi_capture.formats =
1192                 snd_card_asihpi_capture_formats(card, dpcm->h_stream);
1193         snd_card_asihpi_pcm_samplerates(card,  &snd_card_asihpi_capture);
1194         snd_card_asihpi_capture.info = SNDRV_PCM_INFO_INTERLEAVED |
1195                                         SNDRV_PCM_INFO_MMAP |
1196                                         SNDRV_PCM_INFO_MMAP_VALID;
1197
1198         if (card->support_grouping)
1199                 snd_card_asihpi_capture.info |= SNDRV_PCM_INFO_SYNC_START;
1200
1201         runtime->hw = snd_card_asihpi_capture;
1202
1203         if (card->can_dma)
1204                 err = snd_pcm_hw_constraint_pow2(runtime, 0,
1205                                         SNDRV_PCM_HW_PARAM_BUFFER_BYTES);
1206         if (err < 0)
1207                 return err;
1208
1209         snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1210                 card->update_interval_frames);
1211         snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1212                 card->update_interval_frames * 2, UINT_MAX);
1213
1214         snd_pcm_set_sync(substream);
1215
1216         return 0;
1217 }
1218
1219 static int snd_card_asihpi_capture_close(struct snd_pcm_substream *substream)
1220 {
1221         struct snd_card_asihpi_pcm *dpcm = substream->runtime->private_data;
1222
1223         hpi_handle_error(hpi_instream_close(dpcm->h_stream));
1224         return 0;
1225 }
1226
1227 static struct snd_pcm_ops snd_card_asihpi_capture_mmap_ops = {
1228         .open = snd_card_asihpi_capture_open,
1229         .close = snd_card_asihpi_capture_close,
1230         .ioctl = snd_card_asihpi_capture_ioctl,
1231         .hw_params = snd_card_asihpi_pcm_hw_params,
1232         .hw_free = snd_card_asihpi_hw_free,
1233         .prepare = snd_card_asihpi_capture_prepare,
1234         .trigger = snd_card_asihpi_trigger,
1235         .pointer = snd_card_asihpi_capture_pointer,
1236 };
1237
1238 static int snd_card_asihpi_pcm_new(struct snd_card_asihpi *asihpi, int device)
1239 {
1240         struct snd_pcm *pcm;
1241         int err;
1242         u16 num_instreams, num_outstreams, x16;
1243         u32 x32;
1244
1245         err = hpi_adapter_get_info(asihpi->hpi->adapter->index,
1246                         &num_outstreams, &num_instreams,
1247                         &x16, &x32, &x16);
1248
1249         err = snd_pcm_new(asihpi->card, "Asihpi PCM", device,
1250                         num_outstreams, num_instreams, &pcm);
1251         if (err < 0)
1252                 return err;
1253         /* pointer to ops struct is stored, dont change ops afterwards! */
1254                 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
1255                                 &snd_card_asihpi_playback_mmap_ops);
1256                 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
1257                                 &snd_card_asihpi_capture_mmap_ops);
1258
1259         pcm->private_data = asihpi;
1260         pcm->info_flags = 0;
1261         strcpy(pcm->name, "Asihpi PCM");
1262
1263         /*? do we want to emulate MMAP for non-BBM cards?
1264         Jack doesn't work with ALSAs MMAP emulation - WHY NOT? */
1265         snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
1266                                                 snd_dma_pci_data(asihpi->pci),
1267                                                 64*1024, BUFFER_BYTES_MAX);
1268
1269         return 0;
1270 }
1271
1272 /***************************** MIXER CONTROLS ****************/
1273 struct hpi_control {
1274         u32 h_control;
1275         u16 control_type;
1276         u16 src_node_type;
1277         u16 src_node_index;
1278         u16 dst_node_type;
1279         u16 dst_node_index;
1280         u16 band;
1281         char name[44]; /* copied to snd_ctl_elem_id.name[44]; */
1282 };
1283
1284 static const char * const asihpi_tuner_band_names[] = {
1285         "invalid",
1286         "AM",
1287         "FM mono",
1288         "TV NTSC-M",
1289         "FM stereo",
1290         "AUX",
1291         "TV PAL BG",
1292         "TV PAL I",
1293         "TV PAL DK",
1294         "TV SECAM",
1295 };
1296
1297 compile_time_assert(
1298         (ARRAY_SIZE(asihpi_tuner_band_names) ==
1299                 (HPI_TUNER_BAND_LAST+1)),
1300         assert_tuner_band_names_size);
1301
1302 static const char * const asihpi_src_names[] = {
1303         "no source",
1304         "PCM",
1305         "Line",
1306         "Digital",
1307         "Tuner",
1308         "RF",
1309         "Clock",
1310         "Bitstream",
1311         "Mic",
1312         "Net",
1313         "Analog",
1314         "Adapter",
1315         "RTP",
1316         "Internal"
1317 };
1318
1319 compile_time_assert(
1320         (ARRAY_SIZE(asihpi_src_names) ==
1321                 (HPI_SOURCENODE_LAST_INDEX-HPI_SOURCENODE_NONE+1)),
1322         assert_src_names_size);
1323
1324 static const char * const asihpi_dst_names[] = {
1325         "no destination",
1326         "PCM",
1327         "Line",
1328         "Digital",
1329         "RF",
1330         "Speaker",
1331         "Net",
1332         "Analog",
1333         "RTP",
1334 };
1335
1336 compile_time_assert(
1337         (ARRAY_SIZE(asihpi_dst_names) ==
1338                 (HPI_DESTNODE_LAST_INDEX-HPI_DESTNODE_NONE+1)),
1339         assert_dst_names_size);
1340
1341 static inline int ctl_add(struct snd_card *card, struct snd_kcontrol_new *ctl,
1342                                 struct snd_card_asihpi *asihpi)
1343 {
1344         int err;
1345
1346         err = snd_ctl_add(card, snd_ctl_new1(ctl, asihpi));
1347         if (err < 0)
1348                 return err;
1349         else if (mixer_dump)
1350                 snd_printk(KERN_INFO "added %s(%d)\n", ctl->name, ctl->index);
1351
1352         return 0;
1353 }
1354
1355 /* Convert HPI control name and location into ALSA control name */
1356 static void asihpi_ctl_init(struct snd_kcontrol_new *snd_control,
1357                                 struct hpi_control *hpi_ctl,
1358                                 char *name)
1359 {
1360         char *dir;
1361         memset(snd_control, 0, sizeof(*snd_control));
1362         snd_control->name = hpi_ctl->name;
1363         snd_control->private_value = hpi_ctl->h_control;
1364         snd_control->iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1365         snd_control->index = 0;
1366
1367         if (hpi_ctl->src_node_type + HPI_SOURCENODE_NONE == HPI_SOURCENODE_CLOCK_SOURCE)
1368                 dir = ""; /* clock is neither capture nor playback */
1369         else if (hpi_ctl->dst_node_type + HPI_DESTNODE_NONE == HPI_DESTNODE_ISTREAM)
1370                 dir = "Capture ";  /* On or towards a PCM capture destination*/
1371         else if ((hpi_ctl->src_node_type + HPI_SOURCENODE_NONE != HPI_SOURCENODE_OSTREAM) &&
1372                 (!hpi_ctl->dst_node_type))
1373                 dir = "Capture "; /* On a source node that is not PCM playback */
1374         else if (hpi_ctl->src_node_type &&
1375                 (hpi_ctl->src_node_type + HPI_SOURCENODE_NONE != HPI_SOURCENODE_OSTREAM) &&
1376                 (hpi_ctl->dst_node_type))
1377                 dir = "Monitor Playback "; /* Between an input and an output */
1378         else
1379                 dir = "Playback "; /* PCM Playback source, or  output node */
1380
1381         if (hpi_ctl->src_node_type && hpi_ctl->dst_node_type)
1382                 sprintf(hpi_ctl->name, "%s %d %s %d %s%s",
1383                         asihpi_src_names[hpi_ctl->src_node_type],
1384                         hpi_ctl->src_node_index,
1385                         asihpi_dst_names[hpi_ctl->dst_node_type],
1386                         hpi_ctl->dst_node_index,
1387                         dir, name);
1388         else if (hpi_ctl->dst_node_type) {
1389                 sprintf(hpi_ctl->name, "%s %d %s%s",
1390                 asihpi_dst_names[hpi_ctl->dst_node_type],
1391                 hpi_ctl->dst_node_index,
1392                 dir, name);
1393         } else {
1394                 sprintf(hpi_ctl->name, "%s %d %s%s",
1395                 asihpi_src_names[hpi_ctl->src_node_type],
1396                 hpi_ctl->src_node_index,
1397                 dir, name);
1398         }
1399         /* printk(KERN_INFO "Adding %s %d to %d ",  hpi_ctl->name,
1400                 hpi_ctl->wSrcNodeType, hpi_ctl->wDstNodeType); */
1401 }
1402
1403 /*------------------------------------------------------------
1404    Volume controls
1405  ------------------------------------------------------------*/
1406 #define VOL_STEP_mB 1
1407 static int snd_asihpi_volume_info(struct snd_kcontrol *kcontrol,
1408                                   struct snd_ctl_elem_info *uinfo)
1409 {
1410         u32 h_control = kcontrol->private_value;
1411         u32 count;
1412         u16 err;
1413         /* native gains are in millibels */
1414         short min_gain_mB;
1415         short max_gain_mB;
1416         short step_gain_mB;
1417
1418         err = hpi_volume_query_range(h_control,
1419                         &min_gain_mB, &max_gain_mB, &step_gain_mB);
1420         if (err) {
1421                 max_gain_mB = 0;
1422                 min_gain_mB = -10000;
1423                 step_gain_mB = VOL_STEP_mB;
1424         }
1425
1426         err = hpi_meter_query_channels(h_control, &count);
1427         if (err)
1428                 count = HPI_MAX_CHANNELS;
1429
1430         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1431         uinfo->count = count;
1432         uinfo->value.integer.min = min_gain_mB / VOL_STEP_mB;
1433         uinfo->value.integer.max = max_gain_mB / VOL_STEP_mB;
1434         uinfo->value.integer.step = step_gain_mB / VOL_STEP_mB;
1435         return 0;
1436 }
1437
1438 static int snd_asihpi_volume_get(struct snd_kcontrol *kcontrol,
1439                                  struct snd_ctl_elem_value *ucontrol)
1440 {
1441         u32 h_control = kcontrol->private_value;
1442         short an_gain_mB[HPI_MAX_CHANNELS];
1443
1444         hpi_handle_error(hpi_volume_get_gain(h_control, an_gain_mB));
1445         ucontrol->value.integer.value[0] = an_gain_mB[0] / VOL_STEP_mB;
1446         ucontrol->value.integer.value[1] = an_gain_mB[1] / VOL_STEP_mB;
1447
1448         return 0;
1449 }
1450
1451 static int snd_asihpi_volume_put(struct snd_kcontrol *kcontrol,
1452                                  struct snd_ctl_elem_value *ucontrol)
1453 {
1454         int change;
1455         u32 h_control = kcontrol->private_value;
1456         short an_gain_mB[HPI_MAX_CHANNELS];
1457
1458         an_gain_mB[0] =
1459             (ucontrol->value.integer.value[0]) * VOL_STEP_mB;
1460         an_gain_mB[1] =
1461             (ucontrol->value.integer.value[1]) * VOL_STEP_mB;
1462         /*  change = asihpi->mixer_volume[addr][0] != left ||
1463            asihpi->mixer_volume[addr][1] != right;
1464          */
1465         change = 1;
1466         hpi_handle_error(hpi_volume_set_gain(h_control, an_gain_mB));
1467         return change;
1468 }
1469
1470 static const DECLARE_TLV_DB_SCALE(db_scale_100, -10000, VOL_STEP_mB, 0);
1471
1472 #define snd_asihpi_volume_mute_info     snd_ctl_boolean_mono_info
1473
1474 static int snd_asihpi_volume_mute_get(struct snd_kcontrol *kcontrol,
1475                                  struct snd_ctl_elem_value *ucontrol)
1476 {
1477         u32 h_control = kcontrol->private_value;
1478         u32 mute;
1479
1480         hpi_handle_error(hpi_volume_get_mute(h_control, &mute));
1481         ucontrol->value.integer.value[0] = mute ? 0 : 1;
1482
1483         return 0;
1484 }
1485
1486 static int snd_asihpi_volume_mute_put(struct snd_kcontrol *kcontrol,
1487                                  struct snd_ctl_elem_value *ucontrol)
1488 {
1489         u32 h_control = kcontrol->private_value;
1490         int change = 1;
1491         /* HPI currently only supports all or none muting of multichannel volume
1492         ALSA Switch element has opposite sense to HPI mute: on==unmuted, off=muted
1493         */
1494         int mute =  ucontrol->value.integer.value[0] ? 0 : HPI_BITMASK_ALL_CHANNELS;
1495         hpi_handle_error(hpi_volume_set_mute(h_control, mute));
1496         return change;
1497 }
1498
1499 static int snd_asihpi_volume_add(struct snd_card_asihpi *asihpi,
1500                                  struct hpi_control *hpi_ctl)
1501 {
1502         struct snd_card *card = asihpi->card;
1503         struct snd_kcontrol_new snd_control;
1504         int err;
1505         u32 mute;
1506
1507         asihpi_ctl_init(&snd_control, hpi_ctl, "Volume");
1508         snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE |
1509                                 SNDRV_CTL_ELEM_ACCESS_TLV_READ;
1510         snd_control.info = snd_asihpi_volume_info;
1511         snd_control.get = snd_asihpi_volume_get;
1512         snd_control.put = snd_asihpi_volume_put;
1513         snd_control.tlv.p = db_scale_100;
1514
1515         err = ctl_add(card, &snd_control, asihpi);
1516         if (err)
1517                 return err;
1518
1519         if (hpi_volume_get_mute(hpi_ctl->h_control, &mute) == 0) {
1520                 asihpi_ctl_init(&snd_control, hpi_ctl, "Switch");
1521                 snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
1522                 snd_control.info = snd_asihpi_volume_mute_info;
1523                 snd_control.get = snd_asihpi_volume_mute_get;
1524                 snd_control.put = snd_asihpi_volume_mute_put;
1525                 err = ctl_add(card, &snd_control, asihpi);
1526         }
1527         return err;
1528 }
1529
1530 /*------------------------------------------------------------
1531    Level controls
1532  ------------------------------------------------------------*/
1533 static int snd_asihpi_level_info(struct snd_kcontrol *kcontrol,
1534                                  struct snd_ctl_elem_info *uinfo)
1535 {
1536         u32 h_control = kcontrol->private_value;
1537         u16 err;
1538         short min_gain_mB;
1539         short max_gain_mB;
1540         short step_gain_mB;
1541
1542         err =
1543             hpi_level_query_range(h_control, &min_gain_mB,
1544                                &max_gain_mB, &step_gain_mB);
1545         if (err) {
1546                 max_gain_mB = 2400;
1547                 min_gain_mB = -1000;
1548                 step_gain_mB = 100;
1549         }
1550
1551         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1552         uinfo->count = 2;
1553         uinfo->value.integer.min = min_gain_mB / HPI_UNITS_PER_dB;
1554         uinfo->value.integer.max = max_gain_mB / HPI_UNITS_PER_dB;
1555         uinfo->value.integer.step = step_gain_mB / HPI_UNITS_PER_dB;
1556         return 0;
1557 }
1558
1559 static int snd_asihpi_level_get(struct snd_kcontrol *kcontrol,
1560                                 struct snd_ctl_elem_value *ucontrol)
1561 {
1562         u32 h_control = kcontrol->private_value;
1563         short an_gain_mB[HPI_MAX_CHANNELS];
1564
1565         hpi_handle_error(hpi_level_get_gain(h_control, an_gain_mB));
1566         ucontrol->value.integer.value[0] =
1567             an_gain_mB[0] / HPI_UNITS_PER_dB;
1568         ucontrol->value.integer.value[1] =
1569             an_gain_mB[1] / HPI_UNITS_PER_dB;
1570
1571         return 0;
1572 }
1573
1574 static int snd_asihpi_level_put(struct snd_kcontrol *kcontrol,
1575                                 struct snd_ctl_elem_value *ucontrol)
1576 {
1577         int change;
1578         u32 h_control = kcontrol->private_value;
1579         short an_gain_mB[HPI_MAX_CHANNELS];
1580
1581         an_gain_mB[0] =
1582             (ucontrol->value.integer.value[0]) * HPI_UNITS_PER_dB;
1583         an_gain_mB[1] =
1584             (ucontrol->value.integer.value[1]) * HPI_UNITS_PER_dB;
1585         /*  change = asihpi->mixer_level[addr][0] != left ||
1586            asihpi->mixer_level[addr][1] != right;
1587          */
1588         change = 1;
1589         hpi_handle_error(hpi_level_set_gain(h_control, an_gain_mB));
1590         return change;
1591 }
1592
1593 static const DECLARE_TLV_DB_SCALE(db_scale_level, -1000, 100, 0);
1594
1595 static int snd_asihpi_level_add(struct snd_card_asihpi *asihpi,
1596                                 struct hpi_control *hpi_ctl)
1597 {
1598         struct snd_card *card = asihpi->card;
1599         struct snd_kcontrol_new snd_control;
1600
1601         /* can't use 'volume' cos some nodes have volume as well */
1602         asihpi_ctl_init(&snd_control, hpi_ctl, "Level");
1603         snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE |
1604                                 SNDRV_CTL_ELEM_ACCESS_TLV_READ;
1605         snd_control.info = snd_asihpi_level_info;
1606         snd_control.get = snd_asihpi_level_get;
1607         snd_control.put = snd_asihpi_level_put;
1608         snd_control.tlv.p = db_scale_level;
1609
1610         return ctl_add(card, &snd_control, asihpi);
1611 }
1612
1613 /*------------------------------------------------------------
1614    AESEBU controls
1615  ------------------------------------------------------------*/
1616
1617 /* AESEBU format */
1618 static const char * const asihpi_aesebu_format_names[] = {
1619         "N/A", "S/PDIF", "AES/EBU" };
1620
1621 static int snd_asihpi_aesebu_format_info(struct snd_kcontrol *kcontrol,
1622                                   struct snd_ctl_elem_info *uinfo)
1623 {
1624         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
1625         uinfo->count = 1;
1626         uinfo->value.enumerated.items = 3;
1627
1628         if (uinfo->value.enumerated.item >= uinfo->value.enumerated.items)
1629                 uinfo->value.enumerated.item =
1630                         uinfo->value.enumerated.items - 1;
1631
1632         strcpy(uinfo->value.enumerated.name,
1633                 asihpi_aesebu_format_names[uinfo->value.enumerated.item]);
1634
1635         return 0;
1636 }
1637
1638 static int snd_asihpi_aesebu_format_get(struct snd_kcontrol *kcontrol,
1639                         struct snd_ctl_elem_value *ucontrol,
1640                         u16 (*func)(u32, u16 *))
1641 {
1642         u32 h_control = kcontrol->private_value;
1643         u16 source, err;
1644
1645         err = func(h_control, &source);
1646
1647         /* default to N/A */
1648         ucontrol->value.enumerated.item[0] = 0;
1649         /* return success but set the control to N/A */
1650         if (err)
1651                 return 0;
1652         if (source == HPI_AESEBU_FORMAT_SPDIF)
1653                 ucontrol->value.enumerated.item[0] = 1;
1654         if (source == HPI_AESEBU_FORMAT_AESEBU)
1655                 ucontrol->value.enumerated.item[0] = 2;
1656
1657         return 0;
1658 }
1659
1660 static int snd_asihpi_aesebu_format_put(struct snd_kcontrol *kcontrol,
1661                         struct snd_ctl_elem_value *ucontrol,
1662                          u16 (*func)(u32, u16))
1663 {
1664         u32 h_control = kcontrol->private_value;
1665
1666         /* default to S/PDIF */
1667         u16 source = HPI_AESEBU_FORMAT_SPDIF;
1668
1669         if (ucontrol->value.enumerated.item[0] == 1)
1670                 source = HPI_AESEBU_FORMAT_SPDIF;
1671         if (ucontrol->value.enumerated.item[0] == 2)
1672                 source = HPI_AESEBU_FORMAT_AESEBU;
1673
1674         if (func(h_control, source) != 0)
1675                 return -EINVAL;
1676
1677         return 1;
1678 }
1679
1680 static int snd_asihpi_aesebu_rx_format_get(struct snd_kcontrol *kcontrol,
1681                                  struct snd_ctl_elem_value *ucontrol) {
1682         return snd_asihpi_aesebu_format_get(kcontrol, ucontrol,
1683                                         hpi_aesebu_receiver_get_format);
1684 }
1685
1686 static int snd_asihpi_aesebu_rx_format_put(struct snd_kcontrol *kcontrol,
1687                                  struct snd_ctl_elem_value *ucontrol) {
1688         return snd_asihpi_aesebu_format_put(kcontrol, ucontrol,
1689                                         hpi_aesebu_receiver_set_format);
1690 }
1691
1692 static int snd_asihpi_aesebu_rxstatus_info(struct snd_kcontrol *kcontrol,
1693                                   struct snd_ctl_elem_info *uinfo)
1694 {
1695         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1696         uinfo->count = 1;
1697
1698         uinfo->value.integer.min = 0;
1699         uinfo->value.integer.max = 0X1F;
1700         uinfo->value.integer.step = 1;
1701
1702         return 0;
1703 }
1704
1705 static int snd_asihpi_aesebu_rxstatus_get(struct snd_kcontrol *kcontrol,
1706                                  struct snd_ctl_elem_value *ucontrol) {
1707
1708         u32 h_control = kcontrol->private_value;
1709         u16 status;
1710
1711         hpi_handle_error(hpi_aesebu_receiver_get_error_status(
1712                                          h_control, &status));
1713         ucontrol->value.integer.value[0] = status;
1714         return 0;
1715 }
1716
1717 static int snd_asihpi_aesebu_rx_add(struct snd_card_asihpi *asihpi,
1718                                     struct hpi_control *hpi_ctl)
1719 {
1720         struct snd_card *card = asihpi->card;
1721         struct snd_kcontrol_new snd_control;
1722
1723         asihpi_ctl_init(&snd_control, hpi_ctl, "Format");
1724         snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
1725         snd_control.info = snd_asihpi_aesebu_format_info;
1726         snd_control.get = snd_asihpi_aesebu_rx_format_get;
1727         snd_control.put = snd_asihpi_aesebu_rx_format_put;
1728
1729
1730         if (ctl_add(card, &snd_control, asihpi) < 0)
1731                 return -EINVAL;
1732
1733         asihpi_ctl_init(&snd_control, hpi_ctl, "Status");
1734         snd_control.access =
1735             SNDRV_CTL_ELEM_ACCESS_VOLATILE | SNDRV_CTL_ELEM_ACCESS_READ;
1736         snd_control.info = snd_asihpi_aesebu_rxstatus_info;
1737         snd_control.get = snd_asihpi_aesebu_rxstatus_get;
1738
1739         return ctl_add(card, &snd_control, asihpi);
1740 }
1741
1742 static int snd_asihpi_aesebu_tx_format_get(struct snd_kcontrol *kcontrol,
1743                                  struct snd_ctl_elem_value *ucontrol) {
1744         return snd_asihpi_aesebu_format_get(kcontrol, ucontrol,
1745                                         hpi_aesebu_transmitter_get_format);
1746 }
1747
1748 static int snd_asihpi_aesebu_tx_format_put(struct snd_kcontrol *kcontrol,
1749                                  struct snd_ctl_elem_value *ucontrol) {
1750         return snd_asihpi_aesebu_format_put(kcontrol, ucontrol,
1751                                         hpi_aesebu_transmitter_set_format);
1752 }
1753
1754
1755 static int snd_asihpi_aesebu_tx_add(struct snd_card_asihpi *asihpi,
1756                                     struct hpi_control *hpi_ctl)
1757 {
1758         struct snd_card *card = asihpi->card;
1759         struct snd_kcontrol_new snd_control;
1760
1761         asihpi_ctl_init(&snd_control, hpi_ctl, "Format");
1762         snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
1763         snd_control.info = snd_asihpi_aesebu_format_info;
1764         snd_control.get = snd_asihpi_aesebu_tx_format_get;
1765         snd_control.put = snd_asihpi_aesebu_tx_format_put;
1766
1767         return ctl_add(card, &snd_control, asihpi);
1768 }
1769
1770 /*------------------------------------------------------------
1771    Tuner controls
1772  ------------------------------------------------------------*/
1773
1774 /* Gain */
1775
1776 static int snd_asihpi_tuner_gain_info(struct snd_kcontrol *kcontrol,
1777                                   struct snd_ctl_elem_info *uinfo)
1778 {
1779         u32 h_control = kcontrol->private_value;
1780         u16 err;
1781         short idx;
1782         u16 gain_range[3];
1783
1784         for (idx = 0; idx < 3; idx++) {
1785                 err = hpi_tuner_query_gain(h_control,
1786                                           idx, &gain_range[idx]);
1787                 if (err != 0)
1788                         return err;
1789         }
1790
1791         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1792         uinfo->count = 1;
1793         uinfo->value.integer.min = ((int)gain_range[0]) / HPI_UNITS_PER_dB;
1794         uinfo->value.integer.max = ((int)gain_range[1]) / HPI_UNITS_PER_dB;
1795         uinfo->value.integer.step = ((int) gain_range[2]) / HPI_UNITS_PER_dB;
1796         return 0;
1797 }
1798
1799 static int snd_asihpi_tuner_gain_get(struct snd_kcontrol *kcontrol,
1800                                  struct snd_ctl_elem_value *ucontrol)
1801 {
1802         /*
1803         struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
1804         */
1805         u32 h_control = kcontrol->private_value;
1806         short gain;
1807
1808         hpi_handle_error(hpi_tuner_get_gain(h_control, &gain));
1809         ucontrol->value.integer.value[0] = gain / HPI_UNITS_PER_dB;
1810
1811         return 0;
1812 }
1813
1814 static int snd_asihpi_tuner_gain_put(struct snd_kcontrol *kcontrol,
1815                                  struct snd_ctl_elem_value *ucontrol)
1816 {
1817         /*
1818         struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
1819         */
1820         u32 h_control = kcontrol->private_value;
1821         short gain;
1822
1823         gain = (ucontrol->value.integer.value[0]) * HPI_UNITS_PER_dB;
1824         hpi_handle_error(hpi_tuner_set_gain(h_control, gain));
1825
1826         return 1;
1827 }
1828
1829 /* Band  */
1830
1831 static int asihpi_tuner_band_query(struct snd_kcontrol *kcontrol,
1832                                         u16 *band_list, u32 len) {
1833         u32 h_control = kcontrol->private_value;
1834         u16 err = 0;
1835         u32 i;
1836
1837         for (i = 0; i < len; i++) {
1838                 err = hpi_tuner_query_band(
1839                                 h_control, i, &band_list[i]);
1840                 if (err != 0)
1841                         break;
1842         }
1843
1844         if (err && (err != HPI_ERROR_INVALID_OBJ_INDEX))
1845                 return -EIO;
1846
1847         return i;
1848 }
1849
1850 static int snd_asihpi_tuner_band_info(struct snd_kcontrol *kcontrol,
1851                                   struct snd_ctl_elem_info *uinfo)
1852 {
1853         u16 tuner_bands[HPI_TUNER_BAND_LAST];
1854         int num_bands = 0;
1855
1856         num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
1857                                 HPI_TUNER_BAND_LAST);
1858
1859         if (num_bands < 0)
1860                 return num_bands;
1861
1862         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
1863         uinfo->count = 1;
1864         uinfo->value.enumerated.items = num_bands;
1865
1866         if (num_bands > 0) {
1867                 if (uinfo->value.enumerated.item >=
1868                                         uinfo->value.enumerated.items)
1869                         uinfo->value.enumerated.item =
1870                                 uinfo->value.enumerated.items - 1;
1871
1872                 strcpy(uinfo->value.enumerated.name,
1873                         asihpi_tuner_band_names[
1874                                 tuner_bands[uinfo->value.enumerated.item]]);
1875
1876         }
1877         return 0;
1878 }
1879
1880 static int snd_asihpi_tuner_band_get(struct snd_kcontrol *kcontrol,
1881                                  struct snd_ctl_elem_value *ucontrol)
1882 {
1883         u32 h_control = kcontrol->private_value;
1884         /*
1885         struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
1886         */
1887         u16 band, idx;
1888         u16 tuner_bands[HPI_TUNER_BAND_LAST];
1889         u32 num_bands = 0;
1890
1891         num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
1892                                 HPI_TUNER_BAND_LAST);
1893
1894         hpi_handle_error(hpi_tuner_get_band(h_control, &band));
1895
1896         ucontrol->value.enumerated.item[0] = -1;
1897         for (idx = 0; idx < HPI_TUNER_BAND_LAST; idx++)
1898                 if (tuner_bands[idx] == band) {
1899                         ucontrol->value.enumerated.item[0] = idx;
1900                         break;
1901                 }
1902
1903         return 0;
1904 }
1905
1906 static int snd_asihpi_tuner_band_put(struct snd_kcontrol *kcontrol,
1907                                  struct snd_ctl_elem_value *ucontrol)
1908 {
1909         /*
1910         struct snd_card_asihpi *asihpi = snd_kcontrol_chip(kcontrol);
1911         */
1912         u32 h_control = kcontrol->private_value;
1913         u16 band;
1914         u16 tuner_bands[HPI_TUNER_BAND_LAST];
1915         u32 num_bands = 0;
1916
1917         num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
1918                         HPI_TUNER_BAND_LAST);
1919
1920         band = tuner_bands[ucontrol->value.enumerated.item[0]];
1921         hpi_handle_error(hpi_tuner_set_band(h_control, band));
1922
1923         return 1;
1924 }
1925
1926 /* Freq */
1927
1928 static int snd_asihpi_tuner_freq_info(struct snd_kcontrol *kcontrol,
1929                                   struct snd_ctl_elem_info *uinfo)
1930 {
1931         u32 h_control = kcontrol->private_value;
1932         u16 err;
1933         u16 tuner_bands[HPI_TUNER_BAND_LAST];
1934         u16 num_bands = 0, band_iter, idx;
1935         u32 freq_range[3], temp_freq_range[3];
1936
1937         num_bands = asihpi_tuner_band_query(kcontrol, tuner_bands,
1938                         HPI_TUNER_BAND_LAST);
1939
1940         freq_range[0] = INT_MAX;
1941         freq_range[1] = 0;
1942         freq_range[2] = INT_MAX;
1943
1944         for (band_iter = 0; band_iter < num_bands; band_iter++) {
1945                 for (idx = 0; idx < 3; idx++) {
1946                         err = hpi_tuner_query_frequency(h_control,
1947                                 idx, tuner_bands[band_iter],
1948                                 &temp_freq_range[idx]);
1949                         if (err != 0)
1950                                 return err;
1951                 }
1952
1953                 /* skip band with bogus stepping */
1954                 if (temp_freq_range[2] <= 0)
1955                         continue;
1956
1957                 if (temp_freq_range[0] < freq_range[0])
1958                         freq_range[0] = temp_freq_range[0];
1959                 if (temp_freq_range[1] > freq_range[1])
1960                         freq_range[1] = temp_freq_range[1];
1961                 if (temp_freq_range[2] < freq_range[2])
1962                         freq_range[2] = temp_freq_range[2];
1963         }
1964
1965         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1966         uinfo->count = 1;
1967         uinfo->value.integer.min = ((int)freq_range[0]);
1968         uinfo->value.integer.max = ((int)freq_range[1]);
1969         uinfo->value.integer.step = ((int)freq_range[2]);
1970         return 0;
1971 }
1972
1973 static int snd_asihpi_tuner_freq_get(struct snd_kcontrol *kcontrol,
1974                                  struct snd_ctl_elem_value *ucontrol)
1975 {
1976         u32 h_control = kcontrol->private_value;
1977         u32 freq;
1978
1979         hpi_handle_error(hpi_tuner_get_frequency(h_control, &freq));
1980         ucontrol->value.integer.value[0] = freq;
1981
1982         return 0;
1983 }
1984
1985 static int snd_asihpi_tuner_freq_put(struct snd_kcontrol *kcontrol,
1986                                  struct snd_ctl_elem_value *ucontrol)
1987 {
1988         u32 h_control = kcontrol->private_value;
1989         u32 freq;
1990
1991         freq = ucontrol->value.integer.value[0];
1992         hpi_handle_error(hpi_tuner_set_frequency(h_control, freq));
1993
1994         return 1;
1995 }
1996
1997 /* Tuner control group initializer  */
1998 static int snd_asihpi_tuner_add(struct snd_card_asihpi *asihpi,
1999                                 struct hpi_control *hpi_ctl)
2000 {
2001         struct snd_card *card = asihpi->card;
2002         struct snd_kcontrol_new snd_control;
2003
2004         snd_control.private_value = hpi_ctl->h_control;
2005         snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
2006
2007         if (!hpi_tuner_get_gain(hpi_ctl->h_control, NULL)) {
2008                 asihpi_ctl_init(&snd_control, hpi_ctl, "Gain");
2009                 snd_control.info = snd_asihpi_tuner_gain_info;
2010                 snd_control.get = snd_asihpi_tuner_gain_get;
2011                 snd_control.put = snd_asihpi_tuner_gain_put;
2012
2013                 if (ctl_add(card, &snd_control, asihpi) < 0)
2014                         return -EINVAL;
2015         }
2016
2017         asihpi_ctl_init(&snd_control, hpi_ctl, "Band");
2018         snd_control.info = snd_asihpi_tuner_band_info;
2019         snd_control.get = snd_asihpi_tuner_band_get;
2020         snd_control.put = snd_asihpi_tuner_band_put;
2021
2022         if (ctl_add(card, &snd_control, asihpi) < 0)
2023                 return -EINVAL;
2024
2025         asihpi_ctl_init(&snd_control, hpi_ctl, "Freq");
2026         snd_control.info = snd_asihpi_tuner_freq_info;
2027         snd_control.get = snd_asihpi_tuner_freq_get;
2028         snd_control.put = snd_asihpi_tuner_freq_put;
2029
2030         return ctl_add(card, &snd_control, asihpi);
2031 }
2032
2033 /*------------------------------------------------------------
2034    Meter controls
2035  ------------------------------------------------------------*/
2036 static int snd_asihpi_meter_info(struct snd_kcontrol *kcontrol,
2037                                  struct snd_ctl_elem_info *uinfo)
2038 {
2039         u32 h_control = kcontrol->private_value;
2040         u32 count;
2041         u16 err;
2042         err = hpi_meter_query_channels(h_control, &count);
2043         if (err)
2044                 count = HPI_MAX_CHANNELS;
2045
2046         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2047         uinfo->count = count;
2048         uinfo->value.integer.min = 0;
2049         uinfo->value.integer.max = 0x7FFFFFFF;
2050         return 0;
2051 }
2052
2053 /* linear values for 10dB steps */
2054 static int log2lin[] = {
2055         0x7FFFFFFF, /* 0dB */
2056         679093956,
2057         214748365,
2058          67909396,
2059          21474837,
2060           6790940,
2061           2147484, /* -60dB */
2062            679094,
2063            214748, /* -80 */
2064             67909,
2065             21475, /* -100 */
2066              6791,
2067              2147,
2068               679,
2069               214,
2070                68,
2071                21,
2072                 7,
2073                 2
2074 };
2075
2076 static int snd_asihpi_meter_get(struct snd_kcontrol *kcontrol,
2077                                 struct snd_ctl_elem_value *ucontrol)
2078 {
2079         u32 h_control = kcontrol->private_value;
2080         short an_gain_mB[HPI_MAX_CHANNELS], i;
2081         u16 err;
2082
2083         err = hpi_meter_get_peak(h_control, an_gain_mB);
2084
2085         for (i = 0; i < HPI_MAX_CHANNELS; i++) {
2086                 if (err) {
2087                         ucontrol->value.integer.value[i] = 0;
2088                 } else if (an_gain_mB[i] >= 0) {
2089                         ucontrol->value.integer.value[i] =
2090                                 an_gain_mB[i] << 16;
2091                 } else {
2092                         /* -ve is log value in millibels < -60dB,
2093                         * convert to (roughly!) linear,
2094                         */
2095                         ucontrol->value.integer.value[i] =
2096                                         log2lin[an_gain_mB[i] / -1000];
2097                 }
2098         }
2099         return 0;
2100 }
2101
2102 static int snd_asihpi_meter_add(struct snd_card_asihpi *asihpi,
2103                                 struct hpi_control *hpi_ctl, int subidx)
2104 {
2105         struct snd_card *card = asihpi->card;
2106         struct snd_kcontrol_new snd_control;
2107
2108         asihpi_ctl_init(&snd_control, hpi_ctl, "Meter");
2109         snd_control.access =
2110             SNDRV_CTL_ELEM_ACCESS_VOLATILE | SNDRV_CTL_ELEM_ACCESS_READ;
2111         snd_control.info = snd_asihpi_meter_info;
2112         snd_control.get = snd_asihpi_meter_get;
2113
2114         snd_control.index = subidx;
2115
2116         return ctl_add(card, &snd_control, asihpi);
2117 }
2118
2119 /*------------------------------------------------------------
2120    Multiplexer controls
2121  ------------------------------------------------------------*/
2122 static int snd_card_asihpi_mux_count_sources(struct snd_kcontrol *snd_control)
2123 {
2124         u32 h_control = snd_control->private_value;
2125         struct hpi_control hpi_ctl;
2126         int s, err;
2127         for (s = 0; s < 32; s++) {
2128                 err = hpi_multiplexer_query_source(h_control, s,
2129                                                   &hpi_ctl.
2130                                                   src_node_type,
2131                                                   &hpi_ctl.
2132                                                   src_node_index);
2133                 if (err)
2134                         break;
2135         }
2136         return s;
2137 }
2138
2139 static int snd_asihpi_mux_info(struct snd_kcontrol *kcontrol,
2140                                struct snd_ctl_elem_info *uinfo)
2141 {
2142         int err;
2143         u16 src_node_type, src_node_index;
2144         u32 h_control = kcontrol->private_value;
2145
2146         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2147         uinfo->count = 1;
2148         uinfo->value.enumerated.items =
2149             snd_card_asihpi_mux_count_sources(kcontrol);
2150
2151         if (uinfo->value.enumerated.item >= uinfo->value.enumerated.items)
2152                 uinfo->value.enumerated.item =
2153                     uinfo->value.enumerated.items - 1;
2154
2155         err =
2156             hpi_multiplexer_query_source(h_control,
2157                                         uinfo->value.enumerated.item,
2158                                         &src_node_type, &src_node_index);
2159
2160         sprintf(uinfo->value.enumerated.name, "%s %d",
2161                 asihpi_src_names[src_node_type - HPI_SOURCENODE_NONE],
2162                 src_node_index);
2163         return 0;
2164 }
2165
2166 static int snd_asihpi_mux_get(struct snd_kcontrol *kcontrol,
2167                               struct snd_ctl_elem_value *ucontrol)
2168 {
2169         u32 h_control = kcontrol->private_value;
2170         u16 source_type, source_index;
2171         u16 src_node_type, src_node_index;
2172         int s;
2173
2174         hpi_handle_error(hpi_multiplexer_get_source(h_control,
2175                                 &source_type, &source_index));
2176         /* Should cache this search result! */
2177         for (s = 0; s < 256; s++) {
2178                 if (hpi_multiplexer_query_source(h_control, s,
2179                                             &src_node_type, &src_node_index))
2180                         break;
2181
2182                 if ((source_type == src_node_type)
2183                     && (source_index == src_node_index)) {
2184                         ucontrol->value.enumerated.item[0] = s;
2185                         return 0;
2186                 }
2187         }
2188         snd_printd(KERN_WARNING
2189                 "Control %x failed to match mux source %hu %hu\n",
2190                 h_control, source_type, source_index);
2191         ucontrol->value.enumerated.item[0] = 0;
2192         return 0;
2193 }
2194
2195 static int snd_asihpi_mux_put(struct snd_kcontrol *kcontrol,
2196                               struct snd_ctl_elem_value *ucontrol)
2197 {
2198         int change;
2199         u32 h_control = kcontrol->private_value;
2200         u16 source_type, source_index;
2201         u16 e;
2202
2203         change = 1;
2204
2205         e = hpi_multiplexer_query_source(h_control,
2206                                     ucontrol->value.enumerated.item[0],
2207                                     &source_type, &source_index);
2208         if (!e)
2209                 hpi_handle_error(
2210                         hpi_multiplexer_set_source(h_control,
2211                                                 source_type, source_index));
2212         return change;
2213 }
2214
2215
2216 static int  snd_asihpi_mux_add(struct snd_card_asihpi *asihpi,
2217                                struct hpi_control *hpi_ctl)
2218 {
2219         struct snd_card *card = asihpi->card;
2220         struct snd_kcontrol_new snd_control;
2221
2222         asihpi_ctl_init(&snd_control, hpi_ctl, "Route");
2223         snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
2224         snd_control.info = snd_asihpi_mux_info;
2225         snd_control.get = snd_asihpi_mux_get;
2226         snd_control.put = snd_asihpi_mux_put;
2227
2228         return ctl_add(card, &snd_control, asihpi);
2229
2230 }
2231
2232 /*------------------------------------------------------------
2233    Channel mode controls
2234  ------------------------------------------------------------*/
2235 static int snd_asihpi_cmode_info(struct snd_kcontrol *kcontrol,
2236                                  struct snd_ctl_elem_info *uinfo)
2237 {
2238         static const char * const mode_names[HPI_CHANNEL_MODE_LAST + 1] = {
2239                 "invalid",
2240                 "Normal", "Swap",
2241                 "From Left", "From Right",
2242                 "To Left", "To Right"
2243         };
2244
2245         u32 h_control = kcontrol->private_value;
2246         u16 mode;
2247         int i;
2248         u16 mode_map[6];
2249         int valid_modes = 0;
2250
2251         /* HPI channel mode values can be from 1 to 6
2252         Some adapters only support a contiguous subset
2253         */
2254         for (i = 0; i < HPI_CHANNEL_MODE_LAST; i++)
2255                 if (!hpi_channel_mode_query_mode(
2256                         h_control, i, &mode)) {
2257                         mode_map[valid_modes] = mode;
2258                         valid_modes++;
2259                         }
2260
2261         if (!valid_modes)
2262                 return -EINVAL;
2263
2264         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2265         uinfo->count = 1;
2266         uinfo->value.enumerated.items = valid_modes;
2267
2268         if (uinfo->value.enumerated.item >= valid_modes)
2269                 uinfo->value.enumerated.item = valid_modes - 1;
2270
2271         strcpy(uinfo->value.enumerated.name,
2272                mode_names[mode_map[uinfo->value.enumerated.item]]);
2273
2274         return 0;
2275 }
2276
2277 static int snd_asihpi_cmode_get(struct snd_kcontrol *kcontrol,
2278                                 struct snd_ctl_elem_value *ucontrol)
2279 {
2280         u32 h_control = kcontrol->private_value;
2281         u16 mode;
2282
2283         if (hpi_channel_mode_get(h_control, &mode))
2284                 mode = 1;
2285
2286         ucontrol->value.enumerated.item[0] = mode - 1;
2287
2288         return 0;
2289 }
2290
2291 static int snd_asihpi_cmode_put(struct snd_kcontrol *kcontrol,
2292                                 struct snd_ctl_elem_value *ucontrol)
2293 {
2294         int change;
2295         u32 h_control = kcontrol->private_value;
2296
2297         change = 1;
2298
2299         hpi_handle_error(hpi_channel_mode_set(h_control,
2300                            ucontrol->value.enumerated.item[0] + 1));
2301         return change;
2302 }
2303
2304
2305 static int snd_asihpi_cmode_add(struct snd_card_asihpi *asihpi,
2306                                 struct hpi_control *hpi_ctl)
2307 {
2308         struct snd_card *card = asihpi->card;
2309         struct snd_kcontrol_new snd_control;
2310
2311         asihpi_ctl_init(&snd_control, hpi_ctl, "Mode");
2312         snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
2313         snd_control.info = snd_asihpi_cmode_info;
2314         snd_control.get = snd_asihpi_cmode_get;
2315         snd_control.put = snd_asihpi_cmode_put;
2316
2317         return ctl_add(card, &snd_control, asihpi);
2318 }
2319
2320 /*------------------------------------------------------------
2321    Sampleclock source  controls
2322  ------------------------------------------------------------*/
2323 static char *sampleclock_sources[MAX_CLOCKSOURCES] = {
2324         "N/A", "Local PLL", "Digital Sync", "Word External", "Word Header",
2325         "SMPTE", "Digital1", "Auto", "Network", "Invalid",
2326         "Prev Module",
2327         "Digital2", "Digital3", "Digital4", "Digital5",
2328         "Digital6", "Digital7", "Digital8"};
2329
2330 static int snd_asihpi_clksrc_info(struct snd_kcontrol *kcontrol,
2331                                   struct snd_ctl_elem_info *uinfo)
2332 {
2333         struct snd_card_asihpi *asihpi =
2334                         (struct snd_card_asihpi *)(kcontrol->private_data);
2335         struct clk_cache *clkcache = &asihpi->cc;
2336         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2337         uinfo->count = 1;
2338         uinfo->value.enumerated.items = clkcache->count;
2339
2340         if (uinfo->value.enumerated.item >= uinfo->value.enumerated.items)
2341                 uinfo->value.enumerated.item =
2342                                 uinfo->value.enumerated.items - 1;
2343
2344         strcpy(uinfo->value.enumerated.name,
2345                clkcache->s[uinfo->value.enumerated.item].name);
2346         return 0;
2347 }
2348
2349 static int snd_asihpi_clksrc_get(struct snd_kcontrol *kcontrol,
2350                                  struct snd_ctl_elem_value *ucontrol)
2351 {
2352         struct snd_card_asihpi *asihpi =
2353                         (struct snd_card_asihpi *)(kcontrol->private_data);
2354         struct clk_cache *clkcache = &asihpi->cc;
2355         u32 h_control = kcontrol->private_value;
2356         u16 source, srcindex = 0;
2357         int i;
2358
2359         ucontrol->value.enumerated.item[0] = 0;
2360         if (hpi_sample_clock_get_source(h_control, &source))
2361                 source = 0;
2362
2363         if (source == HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT)
2364                 if (hpi_sample_clock_get_source_index(h_control, &srcindex))
2365                         srcindex = 0;
2366
2367         for (i = 0; i < clkcache->count; i++)
2368                 if ((clkcache->s[i].source == source) &&
2369                         (clkcache->s[i].index == srcindex))
2370                         break;
2371
2372         ucontrol->value.enumerated.item[0] = i;
2373
2374         return 0;
2375 }
2376
2377 static int snd_asihpi_clksrc_put(struct snd_kcontrol *kcontrol,
2378                                  struct snd_ctl_elem_value *ucontrol)
2379 {
2380         struct snd_card_asihpi *asihpi =
2381                         (struct snd_card_asihpi *)(kcontrol->private_data);
2382         struct clk_cache *clkcache = &asihpi->cc;
2383         int change, item;
2384         u32 h_control = kcontrol->private_value;
2385
2386         change = 1;
2387         item = ucontrol->value.enumerated.item[0];
2388         if (item >= clkcache->count)
2389                 item = clkcache->count-1;
2390
2391         hpi_handle_error(hpi_sample_clock_set_source(
2392                                 h_control, clkcache->s[item].source));
2393
2394         if (clkcache->s[item].source == HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT)
2395                 hpi_handle_error(hpi_sample_clock_set_source_index(
2396                                 h_control, clkcache->s[item].index));
2397         return change;
2398 }
2399
2400 /*------------------------------------------------------------
2401    Clkrate controls
2402  ------------------------------------------------------------*/
2403 /* Need to change this to enumerated control with list of rates */
2404 static int snd_asihpi_clklocal_info(struct snd_kcontrol *kcontrol,
2405                                    struct snd_ctl_elem_info *uinfo)
2406 {
2407         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2408         uinfo->count = 1;
2409         uinfo->value.integer.min = 8000;
2410         uinfo->value.integer.max = 192000;
2411         uinfo->value.integer.step = 100;
2412
2413         return 0;
2414 }
2415
2416 static int snd_asihpi_clklocal_get(struct snd_kcontrol *kcontrol,
2417                                   struct snd_ctl_elem_value *ucontrol)
2418 {
2419         u32 h_control = kcontrol->private_value;
2420         u32 rate;
2421         u16 e;
2422
2423         e = hpi_sample_clock_get_local_rate(h_control, &rate);
2424         if (!e)
2425                 ucontrol->value.integer.value[0] = rate;
2426         else
2427                 ucontrol->value.integer.value[0] = 0;
2428         return 0;
2429 }
2430
2431 static int snd_asihpi_clklocal_put(struct snd_kcontrol *kcontrol,
2432                                   struct snd_ctl_elem_value *ucontrol)
2433 {
2434         int change;
2435         u32 h_control = kcontrol->private_value;
2436
2437         /*  change = asihpi->mixer_clkrate[addr][0] != left ||
2438            asihpi->mixer_clkrate[addr][1] != right;
2439          */
2440         change = 1;
2441         hpi_handle_error(hpi_sample_clock_set_local_rate(h_control,
2442                                       ucontrol->value.integer.value[0]));
2443         return change;
2444 }
2445
2446 static int snd_asihpi_clkrate_info(struct snd_kcontrol *kcontrol,
2447                                    struct snd_ctl_elem_info *uinfo)
2448 {
2449         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2450         uinfo->count = 1;
2451         uinfo->value.integer.min = 8000;
2452         uinfo->value.integer.max = 192000;
2453         uinfo->value.integer.step = 100;
2454
2455         return 0;
2456 }
2457
2458 static int snd_asihpi_clkrate_get(struct snd_kcontrol *kcontrol,
2459                                   struct snd_ctl_elem_value *ucontrol)
2460 {
2461         u32 h_control = kcontrol->private_value;
2462         u32 rate;
2463         u16 e;
2464
2465         e = hpi_sample_clock_get_sample_rate(h_control, &rate);
2466         if (!e)
2467                 ucontrol->value.integer.value[0] = rate;
2468         else
2469                 ucontrol->value.integer.value[0] = 0;
2470         return 0;
2471 }
2472
2473 static int snd_asihpi_sampleclock_add(struct snd_card_asihpi *asihpi,
2474                                       struct hpi_control *hpi_ctl)
2475 {
2476         struct snd_card *card = asihpi->card;
2477         struct snd_kcontrol_new snd_control;
2478
2479         struct clk_cache *clkcache = &asihpi->cc;
2480         u32 hSC =  hpi_ctl->h_control;
2481         int has_aes_in = 0;
2482         int i, j;
2483         u16 source;
2484
2485         snd_control.private_value = hpi_ctl->h_control;
2486
2487         clkcache->has_local = 0;
2488
2489         for (i = 0; i <= HPI_SAMPLECLOCK_SOURCE_LAST; i++) {
2490                 if  (hpi_sample_clock_query_source(hSC,
2491                                 i, &source))
2492                         break;
2493                 clkcache->s[i].source = source;
2494                 clkcache->s[i].index = 0;
2495                 clkcache->s[i].name = sampleclock_sources[source];
2496                 if (source == HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT)
2497                         has_aes_in = 1;
2498                 if (source == HPI_SAMPLECLOCK_SOURCE_LOCAL)
2499                         clkcache->has_local = 1;
2500         }
2501         if (has_aes_in)
2502                 /* already will have picked up index 0 above */
2503                 for (j = 1; j < 8; j++) {
2504                         if (hpi_sample_clock_query_source_index(hSC,
2505                                 j, HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT,
2506                                 &source))
2507                                 break;
2508                         clkcache->s[i].source =
2509                                 HPI_SAMPLECLOCK_SOURCE_AESEBU_INPUT;
2510                         clkcache->s[i].index = j;
2511                         clkcache->s[i].name = sampleclock_sources[
2512                                         j+HPI_SAMPLECLOCK_SOURCE_LAST];
2513                         i++;
2514                 }
2515         clkcache->count = i;
2516
2517         asihpi_ctl_init(&snd_control, hpi_ctl, "Source");
2518         snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE ;
2519         snd_control.info = snd_asihpi_clksrc_info;
2520         snd_control.get = snd_asihpi_clksrc_get;
2521         snd_control.put = snd_asihpi_clksrc_put;
2522         if (ctl_add(card, &snd_control, asihpi) < 0)
2523                 return -EINVAL;
2524
2525
2526         if (clkcache->has_local) {
2527                 asihpi_ctl_init(&snd_control, hpi_ctl, "Localrate");
2528                 snd_control.access = SNDRV_CTL_ELEM_ACCESS_READWRITE ;
2529                 snd_control.info = snd_asihpi_clklocal_info;
2530                 snd_control.get = snd_asihpi_clklocal_get;
2531                 snd_control.put = snd_asihpi_clklocal_put;
2532
2533
2534                 if (ctl_add(card, &snd_control, asihpi) < 0)
2535                         return -EINVAL;
2536         }
2537
2538         asihpi_ctl_init(&snd_control, hpi_ctl, "Rate");
2539         snd_control.access =
2540             SNDRV_CTL_ELEM_ACCESS_VOLATILE | SNDRV_CTL_ELEM_ACCESS_READ;
2541         snd_control.info = snd_asihpi_clkrate_info;
2542         snd_control.get = snd_asihpi_clkrate_get;
2543
2544         return ctl_add(card, &snd_control, asihpi);
2545 }
2546 /*------------------------------------------------------------
2547    Mixer
2548  ------------------------------------------------------------*/
2549
2550 static int snd_card_asihpi_mixer_new(struct snd_card_asihpi *asihpi)
2551 {
2552         struct snd_card *card = asihpi->card;
2553         unsigned int idx = 0;
2554         unsigned int subindex = 0;
2555         int err;
2556         struct hpi_control hpi_ctl, prev_ctl;
2557
2558         if (snd_BUG_ON(!asihpi))
2559                 return -EINVAL;
2560         strcpy(card->mixername, "Asihpi Mixer");
2561
2562         err =
2563             hpi_mixer_open(asihpi->hpi->adapter->index,
2564                           &asihpi->h_mixer);
2565         hpi_handle_error(err);
2566         if (err)
2567                 return -err;
2568
2569         memset(&prev_ctl, 0, sizeof(prev_ctl));
2570         prev_ctl.control_type = -1;
2571
2572         for (idx = 0; idx < 2000; idx++) {
2573                 err = hpi_mixer_get_control_by_index(
2574                                 asihpi->h_mixer,
2575                                 idx,
2576                                 &hpi_ctl.src_node_type,
2577                                 &hpi_ctl.src_node_index,
2578                                 &hpi_ctl.dst_node_type,
2579                                 &hpi_ctl.dst_node_index,
2580                                 &hpi_ctl.control_type,
2581                                 &hpi_ctl.h_control);
2582                 if (err) {
2583                         if (err == HPI_ERROR_CONTROL_DISABLED) {
2584                                 if (mixer_dump)
2585                                         snd_printk(KERN_INFO
2586                                                    "Disabled HPI Control(%d)\n",
2587                                                    idx);
2588                                 continue;
2589                         } else
2590                                 break;
2591
2592                 }
2593
2594                 hpi_ctl.src_node_type -= HPI_SOURCENODE_NONE;
2595                 hpi_ctl.dst_node_type -= HPI_DESTNODE_NONE;
2596
2597                 /* ASI50xx in SSX mode has multiple meters on the same node.
2598                    Use subindex to create distinct ALSA controls
2599                    for any duplicated controls.
2600                 */
2601                 if ((hpi_ctl.control_type == prev_ctl.control_type) &&
2602                     (hpi_ctl.src_node_type == prev_ctl.src_node_type) &&
2603                     (hpi_ctl.src_node_index == prev_ctl.src_node_index) &&
2604                     (hpi_ctl.dst_node_type == prev_ctl.dst_node_type) &&
2605                     (hpi_ctl.dst_node_index == prev_ctl.dst_node_index))
2606                         subindex++;
2607                 else
2608                         subindex = 0;
2609
2610                 prev_ctl = hpi_ctl;
2611
2612                 switch (hpi_ctl.control_type) {
2613                 case HPI_CONTROL_VOLUME:
2614                         err = snd_asihpi_volume_add(asihpi, &hpi_ctl);
2615                         break;
2616                 case HPI_CONTROL_LEVEL:
2617                         err = snd_asihpi_level_add(asihpi, &hpi_ctl);
2618                         break;
2619                 case HPI_CONTROL_MULTIPLEXER:
2620                         err = snd_asihpi_mux_add(asihpi, &hpi_ctl);
2621                         break;
2622                 case HPI_CONTROL_CHANNEL_MODE:
2623                         err = snd_asihpi_cmode_add(asihpi, &hpi_ctl);
2624                         break;
2625                 case HPI_CONTROL_METER:
2626                         err = snd_asihpi_meter_add(asihpi, &hpi_ctl, subindex);
2627                         break;
2628                 case HPI_CONTROL_SAMPLECLOCK:
2629                         err = snd_asihpi_sampleclock_add(
2630                                                 asihpi, &hpi_ctl);
2631                         break;
2632                 case HPI_CONTROL_CONNECTION:    /* ignore these */
2633                         continue;
2634                 case HPI_CONTROL_TUNER:
2635                         err = snd_asihpi_tuner_add(asihpi, &hpi_ctl);
2636                         break;
2637                 case HPI_CONTROL_AESEBU_TRANSMITTER:
2638                         err = snd_asihpi_aesebu_tx_add(asihpi, &hpi_ctl);
2639                         break;
2640                 case HPI_CONTROL_AESEBU_RECEIVER:
2641                         err = snd_asihpi_aesebu_rx_add(asihpi, &hpi_ctl);
2642                         break;
2643                 case HPI_CONTROL_VOX:
2644                 case HPI_CONTROL_BITSTREAM:
2645                 case HPI_CONTROL_MICROPHONE:
2646                 case HPI_CONTROL_PARAMETRIC_EQ:
2647                 case HPI_CONTROL_COMPANDER:
2648                 default:
2649                         if (mixer_dump)
2650                                 snd_printk(KERN_INFO
2651                                         "Untranslated HPI Control"
2652                                         "(%d) %d %d %d %d %d\n",
2653                                         idx,
2654                                         hpi_ctl.control_type,
2655                                         hpi_ctl.src_node_type,
2656                                         hpi_ctl.src_node_index,
2657                                         hpi_ctl.dst_node_type,
2658                                         hpi_ctl.dst_node_index);
2659                         continue;
2660                 }
2661                 if (err < 0)
2662                         return err;
2663         }
2664         if (HPI_ERROR_INVALID_OBJ_INDEX != err)
2665                 hpi_handle_error(err);
2666
2667         snd_printk(KERN_INFO "%d mixer controls found\n", idx);
2668
2669         return 0;
2670 }
2671
2672 /*------------------------------------------------------------
2673    /proc interface
2674  ------------------------------------------------------------*/
2675
2676 static void
2677 snd_asihpi_proc_read(struct snd_info_entry *entry,
2678                         struct snd_info_buffer *buffer)
2679 {
2680         struct snd_card_asihpi *asihpi = entry->private_data;
2681         u32 h_control;
2682         u32 rate = 0;
2683         u16 source = 0;
2684
2685         u16 num_outstreams;
2686         u16 num_instreams;
2687         u16 version;
2688         u32 serial_number;
2689         u16 type;
2690
2691         int err;
2692
2693         snd_iprintf(buffer, "ASIHPI driver proc file\n");
2694
2695         hpi_handle_error(hpi_adapter_get_info(asihpi->hpi->adapter->index,
2696                         &num_outstreams, &num_instreams,
2697                         &version, &serial_number, &type));
2698
2699         snd_iprintf(buffer,
2700                         "Adapter type ASI%4X\nHardware Index %d\n"
2701                         "%d outstreams\n%d instreams\n",
2702                         type, asihpi->hpi->adapter->index,
2703                         num_outstreams, num_instreams);
2704
2705         snd_iprintf(buffer,
2706                 "Serial#%d\nHardware version %c%d\nDSP code version %03d\n",
2707                 serial_number, ((version >> 3) & 0xf) + 'A', version & 0x7,
2708                 ((version >> 13) * 100) + ((version >> 7) & 0x3f));
2709
2710         err = hpi_mixer_get_control(asihpi->h_mixer,
2711                                   HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
2712                                   HPI_CONTROL_SAMPLECLOCK, &h_control);
2713
2714         if (!err) {
2715                 err = hpi_sample_clock_get_sample_rate(h_control, &rate);
2716                 err += hpi_sample_clock_get_source(h_control, &source);
2717
2718                 if (!err)
2719                         snd_iprintf(buffer, "Sample Clock %dHz, source %s\n",
2720                         rate, sampleclock_sources[source]);
2721         }
2722 }
2723
2724 static void snd_asihpi_proc_init(struct snd_card_asihpi *asihpi)
2725 {
2726         struct snd_info_entry *entry;
2727
2728         if (!snd_card_proc_new(asihpi->card, "info", &entry))
2729                 snd_info_set_text_ops(entry, asihpi, snd_asihpi_proc_read);
2730 }
2731
2732 /*------------------------------------------------------------
2733    HWDEP
2734  ------------------------------------------------------------*/
2735
2736 static int snd_asihpi_hpi_open(struct snd_hwdep *hw, struct file *file)
2737 {
2738         if (enable_hpi_hwdep)
2739                 return 0;
2740         else
2741                 return -ENODEV;
2742
2743 }
2744
2745 static int snd_asihpi_hpi_release(struct snd_hwdep *hw, struct file *file)
2746 {
2747         if (enable_hpi_hwdep)
2748                 return asihpi_hpi_release(file);
2749         else
2750                 return -ENODEV;
2751 }
2752
2753 static int snd_asihpi_hpi_ioctl(struct snd_hwdep *hw, struct file *file,
2754                                 unsigned int cmd, unsigned long arg)
2755 {
2756         if (enable_hpi_hwdep)
2757                 return asihpi_hpi_ioctl(file, cmd, arg);
2758         else
2759                 return -ENODEV;
2760 }
2761
2762
2763 /* results in /dev/snd/hwC#D0 file for each card with index #
2764    also /proc/asound/hwdep will contain '#-00: asihpi (HPI) for each card'
2765 */
2766 static int snd_asihpi_hpi_new(struct snd_card_asihpi *asihpi,
2767                               int device, struct snd_hwdep **rhwdep)
2768 {
2769         struct snd_hwdep *hw;
2770         int err;
2771
2772         if (rhwdep)
2773                 *rhwdep = NULL;
2774         err = snd_hwdep_new(asihpi->card, "HPI", device, &hw);
2775         if (err < 0)
2776                 return err;
2777         strcpy(hw->name, "asihpi (HPI)");
2778         hw->iface = SNDRV_HWDEP_IFACE_LAST;
2779         hw->ops.open = snd_asihpi_hpi_open;
2780         hw->ops.ioctl = snd_asihpi_hpi_ioctl;
2781         hw->ops.release = snd_asihpi_hpi_release;
2782         hw->private_data = asihpi;
2783         if (rhwdep)
2784                 *rhwdep = hw;
2785         return 0;
2786 }
2787
2788 /*------------------------------------------------------------
2789    CARD
2790  ------------------------------------------------------------*/
2791 static int snd_asihpi_probe(struct pci_dev *pci_dev,
2792                             const struct pci_device_id *pci_id)
2793 {
2794         int err;
2795         struct hpi_adapter *hpi;
2796         struct snd_card *card;
2797         struct snd_card_asihpi *asihpi;
2798
2799         u32 h_control;
2800         u32 h_stream;
2801         u32 adapter_index;
2802
2803         static int dev;
2804         if (dev >= SNDRV_CARDS)
2805                 return -ENODEV;
2806
2807         /* Should this be enable[hpi->index] ? */
2808         if (!enable[dev]) {
2809                 dev++;
2810                 return -ENOENT;
2811         }
2812
2813         /* Initialise low-level HPI driver */
2814         err = asihpi_adapter_probe(pci_dev, pci_id);
2815         if (err < 0)
2816                 return err;
2817
2818         hpi = pci_get_drvdata(pci_dev);
2819         adapter_index = hpi->adapter->index;
2820         /* first try to give the card the same index as its hardware index */
2821         err = snd_card_create(adapter_index,
2822                               id[adapter_index], THIS_MODULE,
2823                               sizeof(struct snd_card_asihpi),
2824                               &card);
2825         if (err < 0) {
2826                 /* if that fails, try the default index==next available */
2827                 err =
2828                     snd_card_create(index[dev], id[dev],
2829                                     THIS_MODULE,
2830                                     sizeof(struct snd_card_asihpi),
2831                                     &card);
2832                 if (err < 0)
2833                         return err;
2834                 snd_printk(KERN_WARNING
2835                         "**** WARNING **** Adapter index %d->ALSA index %d\n",
2836                         adapter_index, card->number);
2837         }
2838
2839         snd_card_set_dev(card, &pci_dev->dev);
2840
2841         asihpi = card->private_data;
2842         asihpi->card = card;
2843         asihpi->pci = pci_dev;
2844         asihpi->hpi = hpi;
2845
2846         snd_printk(KERN_INFO "adapter ID=%4X index=%d\n",
2847                         asihpi->hpi->adapter->type, adapter_index);
2848
2849         err = hpi_adapter_get_property(adapter_index,
2850                 HPI_ADAPTER_PROPERTY_CAPS1,
2851                 NULL, &asihpi->support_grouping);
2852         if (err)
2853                 asihpi->support_grouping = 0;
2854
2855         err = hpi_adapter_get_property(adapter_index,
2856                 HPI_ADAPTER_PROPERTY_CAPS2,
2857                 &asihpi->support_mrx, NULL);
2858         if (err)
2859                 asihpi->support_mrx = 0;
2860
2861         err = hpi_adapter_get_property(adapter_index,
2862                 HPI_ADAPTER_PROPERTY_INTERVAL,
2863                 NULL, &asihpi->update_interval_frames);
2864         if (err)
2865                 asihpi->update_interval_frames = 512;
2866
2867         if (!asihpi->can_dma)
2868                 asihpi->update_interval_frames *= 2;
2869
2870         hpi_handle_error(hpi_instream_open(adapter_index,
2871                              0, &h_stream));
2872
2873         err = hpi_instream_host_buffer_free(h_stream);
2874         asihpi->can_dma = (!err);
2875
2876         hpi_handle_error(hpi_instream_close(h_stream));
2877
2878         err = hpi_adapter_get_property(adapter_index,
2879                 HPI_ADAPTER_PROPERTY_CURCHANNELS,
2880                 &asihpi->in_max_chans, &asihpi->out_max_chans);
2881         if (err) {
2882                 asihpi->in_max_chans = 2;
2883                 asihpi->out_max_chans = 2;
2884         }
2885
2886         if (asihpi->out_max_chans > 2) { /* assume LL mode */
2887                 asihpi->out_min_chans = asihpi->out_max_chans;
2888                 asihpi->in_min_chans = asihpi->in_max_chans;
2889                 asihpi->support_grouping = 0;
2890         } else {
2891                 asihpi->out_min_chans = 1;
2892                 asihpi->in_min_chans = 1;
2893         }
2894
2895         snd_printk(KERN_INFO "Has dma:%d, grouping:%d, mrx:%d\n",
2896                         asihpi->can_dma,
2897                         asihpi->support_grouping,
2898                         asihpi->support_mrx
2899               );
2900
2901         err = snd_card_asihpi_pcm_new(asihpi, 0);
2902         if (err < 0) {
2903                 snd_printk(KERN_ERR "pcm_new failed\n");
2904                 goto __nodev;
2905         }
2906         err = snd_card_asihpi_mixer_new(asihpi);
2907         if (err < 0) {
2908                 snd_printk(KERN_ERR "mixer_new failed\n");
2909                 goto __nodev;
2910         }
2911
2912         err = hpi_mixer_get_control(asihpi->h_mixer,
2913                                   HPI_SOURCENODE_CLOCK_SOURCE, 0, 0, 0,
2914                                   HPI_CONTROL_SAMPLECLOCK, &h_control);
2915
2916         if (!err)
2917                 err = hpi_sample_clock_set_local_rate(
2918                         h_control, adapter_fs);
2919
2920         snd_asihpi_proc_init(asihpi);
2921
2922         /* always create, can be enabled or disabled dynamically
2923             by enable_hwdep  module param*/
2924         snd_asihpi_hpi_new(asihpi, 0, NULL);
2925
2926         strcpy(card->driver, "ASIHPI");
2927
2928         sprintf(card->shortname, "AudioScience ASI%4X",
2929                         asihpi->hpi->adapter->type);
2930         sprintf(card->longname, "%s %i",
2931                         card->shortname, adapter_index);
2932         err = snd_card_register(card);
2933
2934         if (!err) {
2935                 hpi->snd_card = card;
2936                 dev++;
2937                 return 0;
2938         }
2939 __nodev:
2940         snd_card_free(card);
2941         snd_printk(KERN_ERR "snd_asihpi_probe error %d\n", err);
2942         return err;
2943
2944 }
2945
2946 static void snd_asihpi_remove(struct pci_dev *pci_dev)
2947 {
2948         struct hpi_adapter *hpi = pci_get_drvdata(pci_dev);
2949         snd_card_free(hpi->snd_card);
2950         hpi->snd_card = NULL;
2951         asihpi_adapter_remove(pci_dev);
2952 }
2953
2954 static DEFINE_PCI_DEVICE_TABLE(asihpi_pci_tbl) = {
2955         {HPI_PCI_VENDOR_ID_TI, HPI_PCI_DEV_ID_DSP6205,
2956                 HPI_PCI_VENDOR_ID_AUDIOSCIENCE, PCI_ANY_ID, 0, 0,
2957                 (kernel_ulong_t)HPI_6205},
2958         {HPI_PCI_VENDOR_ID_TI, HPI_PCI_DEV_ID_PCI2040,
2959                 HPI_PCI_VENDOR_ID_AUDIOSCIENCE, PCI_ANY_ID, 0, 0,
2960                 (kernel_ulong_t)HPI_6000},
2961         {0,}
2962 };
2963 MODULE_DEVICE_TABLE(pci, asihpi_pci_tbl);
2964
2965 static struct pci_driver driver = {
2966         .name = KBUILD_MODNAME,
2967         .id_table = asihpi_pci_tbl,
2968         .probe = snd_asihpi_probe,
2969         .remove = snd_asihpi_remove,
2970 #ifdef CONFIG_PM_SLEEP
2971 /*      .suspend = snd_asihpi_suspend,
2972         .resume = snd_asihpi_resume, */
2973 #endif
2974 };
2975
2976 static int __init snd_asihpi_init(void)
2977 {
2978         asihpi_init();
2979         return pci_register_driver(&driver);
2980 }
2981
2982 static void __exit snd_asihpi_exit(void)
2983 {
2984
2985         pci_unregister_driver(&driver);
2986         asihpi_exit();
2987 }
2988
2989 module_init(snd_asihpi_init)
2990 module_exit(snd_asihpi_exit)
2991