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