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