sound/pci/lx6464es/lx6464es.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /* -*- linux-c -*- *
   3  *
   4  * ALSA driver for the digigram lx6464es interface
   5  *
   6  * Copyright (c) 2008, 2009 Tim Blechmann <tim@klingt.org>
   7  */
   8
   9 #include <linux/module.h>
  10 #include <linux/init.h>
  11 #include <linux/pci.h>
  12 #include <linux/delay.h>
  13 #include <linux/slab.h>
  14
  15 #include <sound/initval.h>
  16 #include <sound/control.h>
  17 #include <sound/info.h>
  18
  19 #include "lx6464es.h"
  20
  21 MODULE_AUTHOR("Tim Blechmann");
  22 MODULE_LICENSE("GPL");
  23 MODULE_DESCRIPTION("digigram lx6464es");
  24 MODULE_SUPPORTED_DEVICE("{digigram lx6464es{}}");
  25
  26
  27 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
  28 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
  29 static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
  30
  31 module_param_array(index, int, NULL, 0444);
  32 MODULE_PARM_DESC(index, "Index value for Digigram LX6464ES interface.");
  33 module_param_array(id, charp, NULL, 0444);
  34 MODULE_PARM_DESC(id, "ID string for  Digigram LX6464ES interface.");
  35 module_param_array(enable, bool, NULL, 0444);
  36 MODULE_PARM_DESC(enable, "Enable/disable specific Digigram LX6464ES soundcards.");
  37
  38 static const char card_name[] = "LX6464ES";
  39
  40
  41 #define PCI_DEVICE_ID_PLX_LX6464ES              PCI_DEVICE_ID_PLX_9056
  42
  43 static const struct pci_device_id snd_lx6464es_ids[] = {
  44         { PCI_DEVICE_SUB(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_LX6464ES,
  45                          PCI_VENDOR_ID_DIGIGRAM,
  46                          PCI_SUBDEVICE_ID_DIGIGRAM_LX6464ES_SERIAL_SUBSYSTEM),
  47         },                      /* LX6464ES */
  48         { PCI_DEVICE_SUB(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_LX6464ES,
  49                          PCI_VENDOR_ID_DIGIGRAM,
  50                          PCI_SUBDEVICE_ID_DIGIGRAM_LX6464ES_CAE_SERIAL_SUBSYSTEM),
  51         },                      /* LX6464ES-CAE */
  52         { PCI_DEVICE_SUB(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_LX6464ES,
  53                          PCI_VENDOR_ID_DIGIGRAM,
  54                          PCI_SUBDEVICE_ID_DIGIGRAM_LX6464ESE_SERIAL_SUBSYSTEM),
  55         },                      /* LX6464ESe */
  56         { PCI_DEVICE_SUB(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_LX6464ES,
  57                          PCI_VENDOR_ID_DIGIGRAM,
  58                          PCI_SUBDEVICE_ID_DIGIGRAM_LX6464ESE_CAE_SERIAL_SUBSYSTEM),
  59         },                      /* LX6464ESe-CAE */
  60         { 0, },
  61 };
  62
  63 MODULE_DEVICE_TABLE(pci, snd_lx6464es_ids);
  64
  65
  66
  67 /* PGO pour USERo dans le registre pci_0x06/loc_0xEC */
  68 #define CHIPSC_RESET_XILINX (1L<<16)
  69
  70
  71 /* alsa callbacks */
  72 static const struct snd_pcm_hardware lx_caps = {
  73         .info             = (SNDRV_PCM_INFO_MMAP |
  74                              SNDRV_PCM_INFO_INTERLEAVED |
  75                              SNDRV_PCM_INFO_MMAP_VALID |
  76                              SNDRV_PCM_INFO_SYNC_START),
  77         .formats          = (SNDRV_PCM_FMTBIT_S16_LE |
  78                              SNDRV_PCM_FMTBIT_S16_BE |
  79                              SNDRV_PCM_FMTBIT_S24_3LE |
  80                              SNDRV_PCM_FMTBIT_S24_3BE),
  81         .rates            = (SNDRV_PCM_RATE_CONTINUOUS |
  82                              SNDRV_PCM_RATE_8000_192000),
  83         .rate_min         = 8000,
  84         .rate_max         = 192000,
  85         .channels_min     = 2,
  86         .channels_max     = 64,
  87         .buffer_bytes_max = 64*2*3*MICROBLAZE_IBL_MAX*MAX_STREAM_BUFFER,
  88         .period_bytes_min = (2*2*MICROBLAZE_IBL_MIN*2),
  89         .period_bytes_max = (4*64*MICROBLAZE_IBL_MAX*MAX_STREAM_BUFFER),
  90         .periods_min      = 2,
  91         .periods_max      = MAX_STREAM_BUFFER,
  92 };
  93
  94 static int lx_set_granularity(struct lx6464es *chip, u32 gran);
  95
  96
  97 static int lx_hardware_open(struct lx6464es *chip,
  98                             struct snd_pcm_substream *substream)
  99 {
 100         int err = 0;
 101         struct snd_pcm_runtime *runtime = substream->runtime;
 102         int channels = runtime->channels;
 103         int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 104
 105         snd_pcm_uframes_t period_size = runtime->period_size;
 106
 107         dev_dbg(chip->card->dev, "allocating pipe for %d channels\n", channels);
 108         err = lx_pipe_allocate(chip, 0, is_capture, channels);
 109         if (err < 0) {
 110                 dev_err(chip->card->dev, LXP "allocating pipe failed\n");
 111                 return err;
 112         }
 113
 114         err = lx_set_granularity(chip, period_size);
 115         if (err < 0) {
 116                 dev_err(chip->card->dev, "setting granularity to %ld failed\n",
 117                            period_size);
 118                 return err;
 119         }
 120
 121         return 0;
 122 }
 123
 124 static int lx_hardware_start(struct lx6464es *chip,
 125                              struct snd_pcm_substream *substream)
 126 {
 127         int err = 0;
 128         struct snd_pcm_runtime *runtime = substream->runtime;
 129         int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 130
 131         dev_dbg(chip->card->dev, "setting stream format\n");
 132         err = lx_stream_set_format(chip, runtime, 0, is_capture);
 133         if (err < 0) {
 134                 dev_err(chip->card->dev, "setting stream format failed\n");
 135                 return err;
 136         }
 137
 138         dev_dbg(chip->card->dev, "starting pipe\n");
 139         err = lx_pipe_start(chip, 0, is_capture);
 140         if (err < 0) {
 141                 dev_err(chip->card->dev, "starting pipe failed\n");
 142                 return err;
 143         }
 144
 145         dev_dbg(chip->card->dev, "waiting for pipe to start\n");
 146         err = lx_pipe_wait_for_start(chip, 0, is_capture);
 147         if (err < 0) {
 148                 dev_err(chip->card->dev, "waiting for pipe failed\n");
 149                 return err;
 150         }
 151
 152         return err;
 153 }
 154
 155
 156 static int lx_hardware_stop(struct lx6464es *chip,
 157                             struct snd_pcm_substream *substream)
 158 {
 159         int err = 0;
 160         int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 161
 162         dev_dbg(chip->card->dev, "pausing pipe\n");
 163         err = lx_pipe_pause(chip, 0, is_capture);
 164         if (err < 0) {
 165                 dev_err(chip->card->dev, "pausing pipe failed\n");
 166                 return err;
 167         }
 168
 169         dev_dbg(chip->card->dev, "waiting for pipe to become idle\n");
 170         err = lx_pipe_wait_for_idle(chip, 0, is_capture);
 171         if (err < 0) {
 172                 dev_err(chip->card->dev, "waiting for pipe failed\n");
 173                 return err;
 174         }
 175
 176         dev_dbg(chip->card->dev, "stopping pipe\n");
 177         err = lx_pipe_stop(chip, 0, is_capture);
 178         if (err < 0) {
 179                 dev_err(chip->card->dev, "stopping pipe failed\n");
 180                 return err;
 181         }
 182
 183         return err;
 184 }
 185
 186
 187 static int lx_hardware_close(struct lx6464es *chip,
 188                              struct snd_pcm_substream *substream)
 189 {
 190         int err = 0;
 191         int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 192
 193         dev_dbg(chip->card->dev, "releasing pipe\n");
 194         err = lx_pipe_release(chip, 0, is_capture);
 195         if (err < 0) {
 196                 dev_err(chip->card->dev, "releasing pipe failed\n");
 197                 return err;
 198         }
 199
 200         return err;
 201 }
 202
 203
 204 static int lx_pcm_open(struct snd_pcm_substream *substream)
 205 {
 206         struct lx6464es *chip = snd_pcm_substream_chip(substream);
 207         struct snd_pcm_runtime *runtime = substream->runtime;
 208         int err = 0;
 209         int board_rate;
 210
 211         dev_dbg(chip->card->dev, "->lx_pcm_open\n");
 212         mutex_lock(&chip->setup_mutex);
 213
 214         /* copy the struct snd_pcm_hardware struct */
 215         runtime->hw = lx_caps;
 216
 217 #if 0
 218         /* buffer-size should better be multiple of period-size */
 219         err = snd_pcm_hw_constraint_integer(runtime,
 220                                             SNDRV_PCM_HW_PARAM_PERIODS);
 221         if (err < 0) {
 222                 dev_warn(chip->card->dev, "could not constrain periods\n");
 223                 goto exit;
 224         }
 225 #endif
 226
 227         /* the clock rate cannot be changed */
 228         board_rate = chip->board_sample_rate;
 229         err = snd_pcm_hw_constraint_single(runtime, SNDRV_PCM_HW_PARAM_RATE,
 230                                            board_rate);
 231
 232         if (err < 0) {
 233                 dev_warn(chip->card->dev, "could not constrain periods\n");
 234                 goto exit;
 235         }
 236
 237         /* constrain period size */
 238         err = snd_pcm_hw_constraint_minmax(runtime,
 239                                            SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
 240                                            MICROBLAZE_IBL_MIN,
 241                                            MICROBLAZE_IBL_MAX);
 242         if (err < 0) {
 243                 dev_warn(chip->card->dev,
 244                            "could not constrain period size\n");
 245                 goto exit;
 246         }
 247
 248         snd_pcm_hw_constraint_step(runtime, 0,
 249                                    SNDRV_PCM_HW_PARAM_BUFFER_SIZE, 32);
 250
 251         snd_pcm_set_sync(substream);
 252         err = 0;
 253
 254 exit:
 255         runtime->private_data = chip;
 256
 257         mutex_unlock(&chip->setup_mutex);
 258         dev_dbg(chip->card->dev, "<-lx_pcm_open, %d\n", err);
 259         return err;
 260 }
 261
 262 static int lx_pcm_close(struct snd_pcm_substream *substream)
 263 {
 264         dev_dbg(substream->pcm->card->dev, "->lx_pcm_close\n");
 265         return 0;
 266 }
 267
 268 static snd_pcm_uframes_t lx_pcm_stream_pointer(struct snd_pcm_substream
 269                                                *substream)
 270 {
 271         struct lx6464es *chip = snd_pcm_substream_chip(substream);
 272         snd_pcm_uframes_t pos;
 273         int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 274
 275         struct lx_stream *lx_stream = is_capture ? &chip->capture_stream :
 276                 &chip->playback_stream;
 277
 278         dev_dbg(chip->card->dev, "->lx_pcm_stream_pointer\n");
 279
 280         mutex_lock(&chip->lock);
 281         pos = lx_stream->frame_pos * substream->runtime->period_size;
 282         mutex_unlock(&chip->lock);
 283
 284         dev_dbg(chip->card->dev, "stream_pointer at %ld\n", pos);
 285         return pos;
 286 }
 287
 288 static int lx_pcm_prepare(struct snd_pcm_substream *substream)
 289 {
 290         struct lx6464es *chip = snd_pcm_substream_chip(substream);
 291         int err = 0;
 292         const int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 293
 294         dev_dbg(chip->card->dev, "->lx_pcm_prepare\n");
 295
 296         mutex_lock(&chip->setup_mutex);
 297
 298         if (chip->hardware_running[is_capture]) {
 299                 err = lx_hardware_stop(chip, substream);
 300                 if (err < 0) {
 301                         dev_err(chip->card->dev, "failed to stop hardware. "
 302                                    "Error code %d\n", err);
 303                         goto exit;
 304                 }
 305
 306                 err = lx_hardware_close(chip, substream);
 307                 if (err < 0) {
 308                         dev_err(chip->card->dev, "failed to close hardware. "
 309                                    "Error code %d\n", err);
 310                         goto exit;
 311                 }
 312         }
 313
 314         dev_dbg(chip->card->dev, "opening hardware\n");
 315         err = lx_hardware_open(chip, substream);
 316         if (err < 0) {
 317                 dev_err(chip->card->dev, "failed to open hardware. "
 318                            "Error code %d\n", err);
 319                 goto exit;
 320         }
 321
 322         err = lx_hardware_start(chip, substream);
 323         if (err < 0) {
 324                 dev_err(chip->card->dev, "failed to start hardware. "
 325                            "Error code %d\n", err);
 326                 goto exit;
 327         }
 328
 329         chip->hardware_running[is_capture] = 1;
 330
 331         if (chip->board_sample_rate != substream->runtime->rate) {
 332                 if (!err)
 333                         chip->board_sample_rate = substream->runtime->rate;
 334         }
 335
 336 exit:
 337         mutex_unlock(&chip->setup_mutex);
 338         return err;
 339 }
 340
 341 static int lx_pcm_hw_params(struct snd_pcm_substream *substream,
 342                             struct snd_pcm_hw_params *hw_params, int is_capture)
 343 {
 344         struct lx6464es *chip = snd_pcm_substream_chip(substream);
 345
 346         dev_dbg(chip->card->dev, "->lx_pcm_hw_params\n");
 347
 348         mutex_lock(&chip->setup_mutex);
 349
 350         if (is_capture)
 351                 chip->capture_stream.stream = substream;
 352         else
 353                 chip->playback_stream.stream = substream;
 354
 355         mutex_unlock(&chip->setup_mutex);
 356         return 0;
 357 }
 358
 359 static int lx_pcm_hw_params_playback(struct snd_pcm_substream *substream,
 360                                  struct snd_pcm_hw_params *hw_params)
 361 {
 362         return lx_pcm_hw_params(substream, hw_params, 0);
 363 }
 364
 365 static int lx_pcm_hw_params_capture(struct snd_pcm_substream *substream,
 366                                  struct snd_pcm_hw_params *hw_params)
 367 {
 368         return lx_pcm_hw_params(substream, hw_params, 1);
 369 }
 370
 371 static int lx_pcm_hw_free(struct snd_pcm_substream *substream)
 372 {
 373         struct lx6464es *chip = snd_pcm_substream_chip(substream);
 374         int err = 0;
 375         int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 376
 377         dev_dbg(chip->card->dev, "->lx_pcm_hw_free\n");
 378         mutex_lock(&chip->setup_mutex);
 379
 380         if (chip->hardware_running[is_capture]) {
 381                 err = lx_hardware_stop(chip, substream);
 382                 if (err < 0) {
 383                         dev_err(chip->card->dev, "failed to stop hardware. "
 384                                    "Error code %d\n", err);
 385                         goto exit;
 386                 }
 387
 388                 err = lx_hardware_close(chip, substream);
 389                 if (err < 0) {
 390                         dev_err(chip->card->dev, "failed to close hardware. "
 391                                    "Error code %d\n", err);
 392                         goto exit;
 393                 }
 394
 395                 chip->hardware_running[is_capture] = 0;
 396         }
 397
 398         if (is_capture)
 399                 chip->capture_stream.stream = NULL;
 400         else
 401                 chip->playback_stream.stream = NULL;
 402
 403 exit:
 404         mutex_unlock(&chip->setup_mutex);
 405         return err;
 406 }
 407
 408 static void lx_trigger_start(struct lx6464es *chip, struct lx_stream *lx_stream)
 409 {
 410         struct snd_pcm_substream *substream = lx_stream->stream;
 411         const unsigned int is_capture = lx_stream->is_capture;
 412
 413         int err;
 414
 415         const u32 channels = substream->runtime->channels;
 416         const u32 bytes_per_frame = channels * 3;
 417         const u32 period_size = substream->runtime->period_size;
 418         const u32 periods = substream->runtime->periods;
 419         const u32 period_bytes = period_size * bytes_per_frame;
 420
 421         dma_addr_t buf = substream->dma_buffer.addr;
 422         int i;
 423
 424         u32 needed, freed;
 425         u32 size_array[5];
 426
 427         for (i = 0; i != periods; ++i) {
 428                 u32 buffer_index = 0;
 429
 430                 err = lx_buffer_ask(chip, 0, is_capture, &needed, &freed,
 431                                     size_array);
 432                 dev_dbg(chip->card->dev, "starting: needed %d, freed %d\n",
 433                             needed, freed);
 434
 435                 err = lx_buffer_give(chip, 0, is_capture, period_bytes,
 436                                      lower_32_bits(buf), upper_32_bits(buf),
 437                                      &buffer_index);
 438
 439                 dev_dbg(chip->card->dev, "starting: buffer index %x on 0x%lx (%d bytes)\n",
 440                             buffer_index, (unsigned long)buf, period_bytes);
 441                 buf += period_bytes;
 442         }
 443
 444         err = lx_buffer_ask(chip, 0, is_capture, &needed, &freed, size_array);
 445         dev_dbg(chip->card->dev, "starting: needed %d, freed %d\n", needed, freed);
 446
 447         dev_dbg(chip->card->dev, "starting: starting stream\n");
 448         err = lx_stream_start(chip, 0, is_capture);
 449         if (err < 0)
 450                 dev_err(chip->card->dev, "couldn't start stream\n");
 451         else
 452                 lx_stream->status = LX_STREAM_STATUS_RUNNING;
 453
 454         lx_stream->frame_pos = 0;
 455 }
 456
 457 static void lx_trigger_stop(struct lx6464es *chip, struct lx_stream *lx_stream)
 458 {
 459         const unsigned int is_capture = lx_stream->is_capture;
 460         int err;
 461
 462         dev_dbg(chip->card->dev, "stopping: stopping stream\n");
 463         err = lx_stream_stop(chip, 0, is_capture);
 464         if (err < 0)
 465                 dev_err(chip->card->dev, "couldn't stop stream\n");
 466         else
 467                 lx_stream->status = LX_STREAM_STATUS_FREE;
 468
 469 }
 470
 471 static void lx_trigger_dispatch_stream(struct lx6464es *chip,
 472                                        struct lx_stream *lx_stream)
 473 {
 474         switch (lx_stream->status) {
 475         case LX_STREAM_STATUS_SCHEDULE_RUN:
 476                 lx_trigger_start(chip, lx_stream);
 477                 break;
 478
 479         case LX_STREAM_STATUS_SCHEDULE_STOP:
 480                 lx_trigger_stop(chip, lx_stream);
 481                 break;
 482
 483         default:
 484                 break;
 485         }
 486 }
 487
 488 static int lx_pcm_trigger_dispatch(struct lx6464es *chip,
 489                                    struct lx_stream *lx_stream, int cmd)
 490 {
 491         int err = 0;
 492
 493         mutex_lock(&chip->lock);
 494         switch (cmd) {
 495         case SNDRV_PCM_TRIGGER_START:
 496                 lx_stream->status = LX_STREAM_STATUS_SCHEDULE_RUN;
 497                 break;
 498
 499         case SNDRV_PCM_TRIGGER_STOP:
 500                 lx_stream->status = LX_STREAM_STATUS_SCHEDULE_STOP;
 501                 break;
 502
 503         default:
 504                 err = -EINVAL;
 505                 goto exit;
 506         }
 507
 508         lx_trigger_dispatch_stream(chip, &chip->capture_stream);
 509         lx_trigger_dispatch_stream(chip, &chip->playback_stream);
 510
 511 exit:
 512         mutex_unlock(&chip->lock);
 513         return err;
 514 }
 515
 516
 517 static int lx_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
 518 {
 519         struct lx6464es *chip = snd_pcm_substream_chip(substream);
 520         const int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 521         struct lx_stream *stream = is_capture ? &chip->capture_stream :
 522                 &chip->playback_stream;
 523
 524         dev_dbg(chip->card->dev, "->lx_pcm_trigger\n");
 525
 526         return lx_pcm_trigger_dispatch(chip, stream, cmd);
 527 }
 528
 529 static int snd_lx6464es_free(struct lx6464es *chip)
 530 {
 531         dev_dbg(chip->card->dev, "->snd_lx6464es_free\n");
 532
 533         lx_irq_disable(chip);
 534
 535         if (chip->irq >= 0)
 536                 free_irq(chip->irq, chip);
 537
 538         iounmap(chip->port_dsp_bar);
 539         ioport_unmap(chip->port_plx_remapped);
 540
 541         pci_release_regions(chip->pci);
 542         pci_disable_device(chip->pci);
 543
 544         kfree(chip);
 545
 546         return 0;
 547 }
 548
 549 static int snd_lx6464es_dev_free(struct snd_device *device)
 550 {
 551         return snd_lx6464es_free(device->device_data);
 552 }
 553
 554 /* reset the dsp during initialization */
 555 static int lx_init_xilinx_reset(struct lx6464es *chip)
 556 {
 557         int i;
 558         u32 plx_reg = lx_plx_reg_read(chip, ePLX_CHIPSC);
 559
 560         dev_dbg(chip->card->dev, "->lx_init_xilinx_reset\n");
 561
 562         /* activate reset of xilinx */
 563         plx_reg &= ~CHIPSC_RESET_XILINX;
 564
 565         lx_plx_reg_write(chip, ePLX_CHIPSC, plx_reg);
 566         msleep(1);
 567
 568         lx_plx_reg_write(chip, ePLX_MBOX3, 0);
 569         msleep(1);
 570
 571         plx_reg |= CHIPSC_RESET_XILINX;
 572         lx_plx_reg_write(chip, ePLX_CHIPSC, plx_reg);
 573
 574         /* deactivate reset of xilinx */
 575         for (i = 0; i != 100; ++i) {
 576                 u32 reg_mbox3;
 577                 msleep(10);
 578                 reg_mbox3 = lx_plx_reg_read(chip, ePLX_MBOX3);
 579                 if (reg_mbox3) {
 580                         dev_dbg(chip->card->dev, "xilinx reset done\n");
 581                         dev_dbg(chip->card->dev, "xilinx took %d loops\n", i);
 582                         break;
 583                 }
 584         }
 585
 586         /* todo: add some error handling? */
 587
 588         /* clear mr */
 589         lx_dsp_reg_write(chip, eReg_CSM, 0);
 590
 591         /* le xilinx ES peut ne pas etre encore pret, on attend. */
 592         msleep(600);
 593
 594         return 0;
 595 }
 596
 597 static int lx_init_xilinx_test(struct lx6464es *chip)
 598 {
 599         u32 reg;
 600
 601         dev_dbg(chip->card->dev, "->lx_init_xilinx_test\n");
 602
 603         /* TEST if we have access to Xilinx/MicroBlaze */
 604         lx_dsp_reg_write(chip, eReg_CSM, 0);
 605
 606         reg = lx_dsp_reg_read(chip, eReg_CSM);
 607
 608         if (reg) {
 609                 dev_err(chip->card->dev, "Problem: Reg_CSM %x.\n", reg);
 610
 611                 /* PCI9056_SPACE0_REMAP */
 612                 lx_plx_reg_write(chip, ePLX_PCICR, 1);
 613
 614                 reg = lx_dsp_reg_read(chip, eReg_CSM);
 615                 if (reg) {
 616                         dev_err(chip->card->dev, "Error: Reg_CSM %x.\n", reg);
 617                         return -EAGAIN; /* seems to be appropriate */
 618                 }
 619         }
 620
 621         dev_dbg(chip->card->dev, "Xilinx/MicroBlaze access test successful\n");
 622
 623         return 0;
 624 }
 625
 626 /* initialize ethersound */
 627 static int lx_init_ethersound_config(struct lx6464es *chip)
 628 {
 629         int i;
 630         u32 orig_conf_es = lx_dsp_reg_read(chip, eReg_CONFES);
 631
 632         /* configure 64 io channels */
 633         u32 conf_es = (orig_conf_es & CONFES_READ_PART_MASK) |
 634                 (64 << IOCR_INPUTS_OFFSET) |
 635                 (64 << IOCR_OUTPUTS_OFFSET) |
 636                 (FREQ_RATIO_SINGLE_MODE << FREQ_RATIO_OFFSET);
 637
 638         dev_dbg(chip->card->dev, "->lx_init_ethersound\n");
 639
 640         chip->freq_ratio = FREQ_RATIO_SINGLE_MODE;
 641
 642         /*
 643          * write it to the card !
 644          * this actually kicks the ES xilinx, the first time since poweron.
 645          * the MAC address in the Reg_ADMACESMSB Reg_ADMACESLSB registers
 646          * is not ready before this is done, and the bit 2 in Reg_CSES is set.
 647          * */
 648         lx_dsp_reg_write(chip, eReg_CONFES, conf_es);
 649
 650         for (i = 0; i != 1000; ++i) {
 651                 if (lx_dsp_reg_read(chip, eReg_CSES) & 4) {
 652                         dev_dbg(chip->card->dev, "ethersound initialized after %dms\n",
 653                                    i);
 654                         goto ethersound_initialized;
 655                 }
 656                 msleep(1);
 657         }
 658         dev_warn(chip->card->dev,
 659                    "ethersound could not be initialized after %dms\n", i);
 660         return -ETIMEDOUT;
 661
 662  ethersound_initialized:
 663         dev_dbg(chip->card->dev, "ethersound initialized\n");
 664         return 0;
 665 }
 666
 667 static int lx_init_get_version_features(struct lx6464es *chip)
 668 {
 669         u32 dsp_version;
 670
 671         int err;
 672
 673         dev_dbg(chip->card->dev, "->lx_init_get_version_features\n");
 674
 675         err = lx_dsp_get_version(chip, &dsp_version);
 676
 677         if (err == 0) {
 678                 u32 freq;
 679
 680                 dev_info(chip->card->dev, "DSP version: V%02d.%02d #%d\n",
 681                            (dsp_version>>16) & 0xff, (dsp_version>>8) & 0xff,
 682                            dsp_version & 0xff);
 683
 684                 /* later: what firmware version do we expect? */
 685
 686                 /* retrieve Play/Rec features */
 687                 /* done here because we may have to handle alternate
 688                  * DSP files. */
 689                 /* later */
 690
 691                 /* init the EtherSound sample rate */
 692                 err = lx_dsp_get_clock_frequency(chip, &freq);
 693                 if (err == 0)
 694                         chip->board_sample_rate = freq;
 695                 dev_dbg(chip->card->dev, "actual clock frequency %d\n", freq);
 696         } else {
 697                 dev_err(chip->card->dev, "DSP corrupted \n");
 698                 err = -EAGAIN;
 699         }
 700
 701         return err;
 702 }
 703
 704 static int lx_set_granularity(struct lx6464es *chip, u32 gran)
 705 {
 706         int err = 0;
 707         u32 snapped_gran = MICROBLAZE_IBL_MIN;
 708
 709         dev_dbg(chip->card->dev, "->lx_set_granularity\n");
 710
 711         /* blocksize is a power of 2 */
 712         while ((snapped_gran < gran) &&
 713                (snapped_gran < MICROBLAZE_IBL_MAX)) {
 714                 snapped_gran *= 2;
 715         }
 716
 717         if (snapped_gran == chip->pcm_granularity)
 718                 return 0;
 719
 720         err = lx_dsp_set_granularity(chip, snapped_gran);
 721         if (err < 0) {
 722                 dev_warn(chip->card->dev, "could not set granularity\n");
 723                 err = -EAGAIN;
 724         }
 725
 726         if (snapped_gran != gran)
 727                 dev_err(chip->card->dev, "snapped blocksize to %d\n", snapped_gran);
 728
 729         dev_dbg(chip->card->dev, "set blocksize on board %d\n", snapped_gran);
 730         chip->pcm_granularity = snapped_gran;
 731
 732         return err;
 733 }
 734
 735 /* initialize and test the xilinx dsp chip */
 736 static int lx_init_dsp(struct lx6464es *chip)
 737 {
 738         int err;
 739         int i;
 740
 741         dev_dbg(chip->card->dev, "->lx_init_dsp\n");
 742
 743         dev_dbg(chip->card->dev, "initialize board\n");
 744         err = lx_init_xilinx_reset(chip);
 745         if (err)
 746                 return err;
 747
 748         dev_dbg(chip->card->dev, "testing board\n");
 749         err = lx_init_xilinx_test(chip);
 750         if (err)
 751                 return err;
 752
 753         dev_dbg(chip->card->dev, "initialize ethersound configuration\n");
 754         err = lx_init_ethersound_config(chip);
 755         if (err)
 756                 return err;
 757
 758         lx_irq_enable(chip);
 759
 760         /** \todo the mac address should be ready by not, but it isn't,
 761          *  so we wait for it */
 762         for (i = 0; i != 1000; ++i) {
 763                 err = lx_dsp_get_mac(chip);
 764                 if (err)
 765                         return err;
 766                 if (chip->mac_address[0] || chip->mac_address[1] || chip->mac_address[2] ||
 767                     chip->mac_address[3] || chip->mac_address[4] || chip->mac_address[5])
 768                         goto mac_ready;
 769                 msleep(1);
 770         }
 771         return -ETIMEDOUT;
 772
 773 mac_ready:
 774         dev_dbg(chip->card->dev, "mac address ready read after: %dms\n", i);
 775         dev_info(chip->card->dev,
 776                  "mac address: %02X.%02X.%02X.%02X.%02X.%02X\n",
 777                    chip->mac_address[0], chip->mac_address[1], chip->mac_address[2],
 778                    chip->mac_address[3], chip->mac_address[4], chip->mac_address[5]);
 779
 780         err = lx_init_get_version_features(chip);
 781         if (err)
 782                 return err;
 783
 784         lx_set_granularity(chip, MICROBLAZE_IBL_DEFAULT);
 785
 786         chip->playback_mute = 0;
 787
 788         return err;
 789 }
 790
 791 static const struct snd_pcm_ops lx_ops_playback = {
 792         .open      = lx_pcm_open,
 793         .close     = lx_pcm_close,
 794         .prepare   = lx_pcm_prepare,
 795         .hw_params = lx_pcm_hw_params_playback,
 796         .hw_free   = lx_pcm_hw_free,
 797         .trigger   = lx_pcm_trigger,
 798         .pointer   = lx_pcm_stream_pointer,
 799 };
 800
 801 static const struct snd_pcm_ops lx_ops_capture = {
 802         .open      = lx_pcm_open,
 803         .close     = lx_pcm_close,
 804         .prepare   = lx_pcm_prepare,
 805         .hw_params = lx_pcm_hw_params_capture,
 806         .hw_free   = lx_pcm_hw_free,
 807         .trigger   = lx_pcm_trigger,
 808         .pointer   = lx_pcm_stream_pointer,
 809 };
 810
 811 static int lx_pcm_create(struct lx6464es *chip)
 812 {
 813         int err;
 814         struct snd_pcm *pcm;
 815
 816         u32 size = 64 *              /* channels */
 817                 3 *                  /* 24 bit samples */
 818                 MAX_STREAM_BUFFER *  /* periods */
 819                 MICROBLAZE_IBL_MAX * /* frames per period */
 820                 2;                   /* duplex */
 821
 822         size = PAGE_ALIGN(size);
 823
 824         /* hardcoded device name & channel count */
 825         err = snd_pcm_new(chip->card, (char *)card_name, 0,
 826                           1, 1, &pcm);
 827         if (err < 0)
 828                 return err;
 829
 830         pcm->private_data = chip;
 831
 832         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &lx_ops_playback);
 833         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &lx_ops_capture);
 834
 835         pcm->info_flags = 0;
 836         pcm->nonatomic = true;
 837         strcpy(pcm->name, card_name);
 838
 839         snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_DEV,
 840                                        &chip->pci->dev, size, size);
 841
 842         chip->pcm = pcm;
 843         chip->capture_stream.is_capture = 1;
 844
 845         return 0;
 846 }
 847
 848 static int lx_control_playback_info(struct snd_kcontrol *kcontrol,
 849                                     struct snd_ctl_elem_info *uinfo)
 850 {
 851         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
 852         uinfo->count = 1;
 853         uinfo->value.integer.min = 0;
 854         uinfo->value.integer.max = 1;
 855         return 0;
 856 }
 857
 858 static int lx_control_playback_get(struct snd_kcontrol *kcontrol,
 859                                    struct snd_ctl_elem_value *ucontrol)
 860 {
 861         struct lx6464es *chip = snd_kcontrol_chip(kcontrol);
 862         ucontrol->value.integer.value[0] = chip->playback_mute;
 863         return 0;
 864 }
 865
 866 static int lx_control_playback_put(struct snd_kcontrol *kcontrol,
 867                                    struct snd_ctl_elem_value *ucontrol)
 868 {
 869         struct lx6464es *chip = snd_kcontrol_chip(kcontrol);
 870         int changed = 0;
 871         int current_value = chip->playback_mute;
 872
 873         if (current_value != ucontrol->value.integer.value[0]) {
 874                 lx_level_unmute(chip, 0, !current_value);
 875                 chip->playback_mute = !current_value;
 876                 changed = 1;
 877         }
 878         return changed;
 879 }
 880
 881 static const struct snd_kcontrol_new lx_control_playback_switch = {
 882         .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 883         .name = "PCM Playback Switch",
 884         .index = 0,
 885         .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
 886         .private_value = 0,
 887         .info = lx_control_playback_info,
 888         .get = lx_control_playback_get,
 889         .put = lx_control_playback_put
 890 };
 891
 892
 893
 894 static void lx_proc_levels_read(struct snd_info_entry *entry,
 895                                 struct snd_info_buffer *buffer)
 896 {
 897         u32 levels[64];
 898         int err;
 899         int i, j;
 900         struct lx6464es *chip = entry->private_data;
 901
 902         snd_iprintf(buffer, "capture levels:\n");
 903         err = lx_level_peaks(chip, 1, 64, levels);
 904         if (err < 0)
 905                 return;
 906
 907         for (i = 0; i != 8; ++i) {
 908                 for (j = 0; j != 8; ++j)
 909                         snd_iprintf(buffer, "%08x ", levels[i*8+j]);
 910                 snd_iprintf(buffer, "\n");
 911         }
 912
 913         snd_iprintf(buffer, "\nplayback levels:\n");
 914
 915         err = lx_level_peaks(chip, 0, 64, levels);
 916         if (err < 0)
 917                 return;
 918
 919         for (i = 0; i != 8; ++i) {
 920                 for (j = 0; j != 8; ++j)
 921                         snd_iprintf(buffer, "%08x ", levels[i*8+j]);
 922                 snd_iprintf(buffer, "\n");
 923         }
 924
 925         snd_iprintf(buffer, "\n");
 926 }
 927
 928 static int lx_proc_create(struct snd_card *card, struct lx6464es *chip)
 929 {
 930         return snd_card_ro_proc_new(card, "levels", chip, lx_proc_levels_read);
 931 }
 932
 933
 934 static int snd_lx6464es_create(struct snd_card *card,
 935                                struct pci_dev *pci,
 936                                struct lx6464es **rchip)
 937 {
 938         struct lx6464es *chip;
 939         int err;
 940
 941         static const struct snd_device_ops ops = {
 942                 .dev_free = snd_lx6464es_dev_free,
 943         };
 944
 945         dev_dbg(card->dev, "->snd_lx6464es_create\n");
 946
 947         *rchip = NULL;
 948
 949         /* enable PCI device */
 950         err = pci_enable_device(pci);
 951         if (err < 0)
 952                 return err;
 953
 954         pci_set_master(pci);
 955
 956         /* check if we can restrict PCI DMA transfers to 32 bits */
 957         err = dma_set_mask(&pci->dev, DMA_BIT_MASK(32));
 958         if (err < 0) {
 959                 dev_err(card->dev,
 960                         "architecture does not support 32bit PCI busmaster DMA\n");
 961                 pci_disable_device(pci);
 962                 return -ENXIO;
 963         }
 964
 965         chip = kzalloc(sizeof(*chip), GFP_KERNEL);
 966         if (chip == NULL) {
 967                 err = -ENOMEM;
 968                 goto alloc_failed;
 969         }
 970
 971         chip->card = card;
 972         chip->pci = pci;
 973         chip->irq = -1;
 974
 975         /* initialize synchronization structs */
 976         mutex_init(&chip->lock);
 977         mutex_init(&chip->msg_lock);
 978         mutex_init(&chip->setup_mutex);
 979
 980         /* request resources */
 981         err = pci_request_regions(pci, card_name);
 982         if (err < 0)
 983                 goto request_regions_failed;
 984
 985         /* plx port */
 986         chip->port_plx = pci_resource_start(pci, 1);
 987         chip->port_plx_remapped = ioport_map(chip->port_plx,
 988                                              pci_resource_len(pci, 1));
 989
 990         /* dsp port */
 991         chip->port_dsp_bar = pci_ioremap_bar(pci, 2);
 992         if (!chip->port_dsp_bar) {
 993                 dev_err(card->dev, "cannot remap PCI memory region\n");
 994                 err = -ENOMEM;
 995                 goto remap_pci_failed;
 996         }
 997
 998         err = request_threaded_irq(pci->irq, lx_interrupt, lx_threaded_irq,
 999                                    IRQF_SHARED, KBUILD_MODNAME, chip);
1000         if (err) {
1001                 dev_err(card->dev, "unable to grab IRQ %d\n", pci->irq);
1002                 goto request_irq_failed;
1003         }
1004         chip->irq = pci->irq;
1005         card->sync_irq = chip->irq;
1006
1007         err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops);
1008         if (err < 0)
1009                 goto device_new_failed;
1010
1011         err = lx_init_dsp(chip);
1012         if (err < 0) {
1013                 dev_err(card->dev, "error during DSP initialization\n");
1014                 return err;
1015         }
1016
1017         err = lx_pcm_create(chip);
1018         if (err < 0)
1019                 return err;
1020
1021         err = lx_proc_create(card, chip);
1022         if (err < 0)
1023                 return err;
1024
1025         err = snd_ctl_add(card, snd_ctl_new1(&lx_control_playback_switch,
1026                                              chip));
1027         if (err < 0)
1028                 return err;
1029
1030         *rchip = chip;
1031         return 0;
1032
1033 device_new_failed:
1034         free_irq(pci->irq, chip);
1035
1036 request_irq_failed:
1037         iounmap(chip->port_dsp_bar);
1038
1039 remap_pci_failed:
1040         pci_release_regions(pci);
1041
1042 request_regions_failed:
1043         kfree(chip);
1044
1045 alloc_failed:
1046         pci_disable_device(pci);
1047
1048         return err;
1049 }
1050
1051 static int snd_lx6464es_probe(struct pci_dev *pci,
1052                               const struct pci_device_id *pci_id)
1053 {
1054         static int dev;
1055         struct snd_card *card;
1056         struct lx6464es *chip;
1057         int err;
1058
1059         dev_dbg(&pci->dev, "->snd_lx6464es_probe\n");
1060
1061         if (dev >= SNDRV_CARDS)
1062                 return -ENODEV;
1063         if (!enable[dev]) {
1064                 dev++;
1065                 return -ENOENT;
1066         }
1067
1068         err = snd_card_new(&pci->dev, index[dev], id[dev], THIS_MODULE,
1069                            0, &card);
1070         if (err < 0)
1071                 return err;
1072
1073         err = snd_lx6464es_create(card, pci, &chip);
1074         if (err < 0) {
1075                 dev_err(card->dev, "error during snd_lx6464es_create\n");
1076                 goto out_free;
1077         }
1078
1079         strcpy(card->driver, "LX6464ES");
1080         sprintf(card->id, "LX6464ES_%02X%02X%02X",
1081                 chip->mac_address[3], chip->mac_address[4], chip->mac_address[5]);
1082
1083         sprintf(card->shortname, "LX6464ES %02X.%02X.%02X.%02X.%02X.%02X",
1084                 chip->mac_address[0], chip->mac_address[1], chip->mac_address[2],
1085                 chip->mac_address[3], chip->mac_address[4], chip->mac_address[5]);
1086
1087         sprintf(card->longname, "%s at 0x%lx, 0x%p, irq %i",
1088                 card->shortname, chip->port_plx,
1089                 chip->port_dsp_bar, chip->irq);
1090
1091         err = snd_card_register(card);
1092         if (err < 0)
1093                 goto out_free;
1094
1095         dev_dbg(chip->card->dev, "initialization successful\n");
1096         pci_set_drvdata(pci, card);
1097         dev++;
1098         return 0;
1099
1100 out_free:
1101         snd_card_free(card);
1102         return err;
1103
1104 }
1105
1106 static void snd_lx6464es_remove(struct pci_dev *pci)
1107 {
1108         snd_card_free(pci_get_drvdata(pci));
1109 }
1110
1111
1112 static struct pci_driver lx6464es_driver = {
1113         .name =     KBUILD_MODNAME,
1114         .id_table = snd_lx6464es_ids,
1115         .probe =    snd_lx6464es_probe,
1116         .remove = snd_lx6464es_remove,
1117 };
1118
1119 module_pci_driver(lx6464es_driver);