SAFE public projects git trees. - safe/jmp/linux-2.6/blob - sound/pci/hda/hda_codec.c

   1 /*
   2  * Universal Interface for Intel High Definition Audio Codec
   3  *
   4  * Copyright (c) 2004 Takashi Iwai <tiwai@suse.de>
   5  *
   6  *
   7  *  This driver is free software; you can redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License as published by
   9  *  the Free Software Foundation; either version 2 of the License, or
  10  *  (at your option) any later version.
  11  *
  12  *  This driver is distributed in the hope that it will be useful,
  13  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  *  GNU General Public License for more details.
  16  *
  17  *  You should have received a copy of the GNU General Public License
  18  *  along with this program; if not, write to the Free Software
  19  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  20  */
  21
  22 #include <linux/init.h>
  23 #include <linux/delay.h>
  24 #include <linux/slab.h>
  25 #include <linux/pci.h>
  26 #include <linux/mutex.h>
  27 #include <sound/core.h>
  28 #include "hda_codec.h"
  29 #include <sound/asoundef.h>
  30 #include <sound/tlv.h>
  31 #include <sound/initval.h>
  32 #include "hda_local.h"
  33 #include <sound/hda_hwdep.h>
  34 #include "hda_patch.h"  /* codec presets */
  35
  36 #ifdef CONFIG_SND_HDA_POWER_SAVE
  37 /* define this option here to hide as static */
  38 static int power_save = CONFIG_SND_HDA_POWER_SAVE_DEFAULT;
  39 module_param(power_save, int, 0644);
  40 MODULE_PARM_DESC(power_save, "Automatic power-saving timeout "
  41                  "(in second, 0 = disable).");
  42 #endif
  43
  44 /*
  45  * vendor / preset table
  46  */
  47
  48 struct hda_vendor_id {
  49         unsigned int id;
  50         const char *name;
  51 };
  52
  53 /* codec vendor labels */
  54 static struct hda_vendor_id hda_vendor_ids[] = {
  55         { 0x1002, "ATI" },
  56         { 0x1057, "Motorola" },
  57         { 0x1095, "Silicon Image" },
  58         { 0x10ec, "Realtek" },
  59         { 0x1106, "VIA" },
  60         { 0x111d, "IDT" },
  61         { 0x11c1, "LSI" },
  62         { 0x11d4, "Analog Devices" },
  63         { 0x13f6, "C-Media" },
  64         { 0x14f1, "Conexant" },
  65         { 0x17e8, "Chrontel" },
  66         { 0x1854, "LG" },
  67         { 0x434d, "C-Media" },
  68         { 0x8384, "SigmaTel" },
  69         {} /* terminator */
  70 };
  71
  72 static const struct hda_codec_preset *hda_preset_tables[] = {
  73 #ifdef CONFIG_SND_HDA_CODEC_REALTEK
  74         snd_hda_preset_realtek,
  75 #endif
  76 #ifdef CONFIG_SND_HDA_CODEC_CMEDIA
  77         snd_hda_preset_cmedia,
  78 #endif
  79 #ifdef CONFIG_SND_HDA_CODEC_ANALOG
  80         snd_hda_preset_analog,
  81 #endif
  82 #ifdef CONFIG_SND_HDA_CODEC_SIGMATEL
  83         snd_hda_preset_sigmatel,
  84 #endif
  85 #ifdef CONFIG_SND_HDA_CODEC_SI3054
  86         snd_hda_preset_si3054,
  87 #endif
  88 #ifdef CONFIG_SND_HDA_CODEC_ATIHDMI
  89         snd_hda_preset_atihdmi,
  90 #endif
  91 #ifdef CONFIG_SND_HDA_CODEC_CONEXANT
  92         snd_hda_preset_conexant,
  93 #endif
  94 #ifdef CONFIG_SND_HDA_CODEC_VIA
  95         snd_hda_preset_via,
  96 #endif
  97 #ifdef CONFIG_SND_HDA_CODEC_NVHDMI
  98         snd_hda_preset_nvhdmi,
  99 #endif
 100         NULL
 101 };
 102
 103 #ifdef CONFIG_SND_HDA_POWER_SAVE
 104 static void hda_power_work(struct work_struct *work);
 105 static void hda_keep_power_on(struct hda_codec *codec);
 106 #else
 107 static inline void hda_keep_power_on(struct hda_codec *codec) {}
 108 #endif
 109
 110 /**
 111  * snd_hda_codec_read - send a command and get the response
 112  * @codec: the HDA codec
 113  * @nid: NID to send the command
 114  * @direct: direct flag
 115  * @verb: the verb to send
 116  * @parm: the parameter for the verb
 117  *
 118  * Send a single command and read the corresponding response.
 119  *
 120  * Returns the obtained response value, or -1 for an error.
 121  */
 122 unsigned int snd_hda_codec_read(struct hda_codec *codec, hda_nid_t nid,
 123                                 int direct,
 124                                 unsigned int verb, unsigned int parm)
 125 {
 126         unsigned int res;
 127         snd_hda_power_up(codec);
 128         mutex_lock(&codec->bus->cmd_mutex);
 129         if (!codec->bus->ops.command(codec, nid, direct, verb, parm))
 130                 res = codec->bus->ops.get_response(codec);
 131         else
 132                 res = (unsigned int)-1;
 133         mutex_unlock(&codec->bus->cmd_mutex);
 134         snd_hda_power_down(codec);
 135         return res;
 136 }
 137
 138 /**
 139  * snd_hda_codec_write - send a single command without waiting for response
 140  * @codec: the HDA codec
 141  * @nid: NID to send the command
 142  * @direct: direct flag
 143  * @verb: the verb to send
 144  * @parm: the parameter for the verb
 145  *
 146  * Send a single command without waiting for response.
 147  *
 148  * Returns 0 if successful, or a negative error code.
 149  */
 150 int snd_hda_codec_write(struct hda_codec *codec, hda_nid_t nid, int direct,
 151                          unsigned int verb, unsigned int parm)
 152 {
 153         int err;
 154         snd_hda_power_up(codec);
 155         mutex_lock(&codec->bus->cmd_mutex);
 156         err = codec->bus->ops.command(codec, nid, direct, verb, parm);
 157         mutex_unlock(&codec->bus->cmd_mutex);
 158         snd_hda_power_down(codec);
 159         return err;
 160 }
 161
 162 /**
 163  * snd_hda_sequence_write - sequence writes
 164  * @codec: the HDA codec
 165  * @seq: VERB array to send
 166  *
 167  * Send the commands sequentially from the given array.
 168  * The array must be terminated with NID=0.
 169  */
 170 void snd_hda_sequence_write(struct hda_codec *codec, const struct hda_verb *seq)
 171 {
 172         for (; seq->nid; seq++)
 173                 snd_hda_codec_write(codec, seq->nid, 0, seq->verb, seq->param);
 174 }
 175
 176 /**
 177  * snd_hda_get_sub_nodes - get the range of sub nodes
 178  * @codec: the HDA codec
 179  * @nid: NID to parse
 180  * @start_id: the pointer to store the start NID
 181  *
 182  * Parse the NID and store the start NID of its sub-nodes.
 183  * Returns the number of sub-nodes.
 184  */
 185 int snd_hda_get_sub_nodes(struct hda_codec *codec, hda_nid_t nid,
 186                           hda_nid_t *start_id)
 187 {
 188         unsigned int parm;
 189
 190         parm = snd_hda_param_read(codec, nid, AC_PAR_NODE_COUNT);
 191         if (parm == -1)
 192                 return 0;
 193         *start_id = (parm >> 16) & 0x7fff;
 194         return (int)(parm & 0x7fff);
 195 }
 196
 197 /**
 198  * snd_hda_get_connections - get connection list
 199  * @codec: the HDA codec
 200  * @nid: NID to parse
 201  * @conn_list: connection list array
 202  * @max_conns: max. number of connections to store
 203  *
 204  * Parses the connection list of the given widget and stores the list
 205  * of NIDs.
 206  *
 207  * Returns the number of connections, or a negative error code.
 208  */
 209 int snd_hda_get_connections(struct hda_codec *codec, hda_nid_t nid,
 210                             hda_nid_t *conn_list, int max_conns)
 211 {
 212         unsigned int parm;
 213         int i, conn_len, conns;
 214         unsigned int shift, num_elems, mask;
 215         hda_nid_t prev_nid;
 216
 217         if (snd_BUG_ON(!conn_list || max_conns <= 0))
 218                 return -EINVAL;
 219
 220         parm = snd_hda_param_read(codec, nid, AC_PAR_CONNLIST_LEN);
 221         if (parm & AC_CLIST_LONG) {
 222                 /* long form */
 223                 shift = 16;
 224                 num_elems = 2;
 225         } else {
 226                 /* short form */
 227                 shift = 8;
 228                 num_elems = 4;
 229         }
 230         conn_len = parm & AC_CLIST_LENGTH;
 231         mask = (1 << (shift-1)) - 1;
 232
 233         if (!conn_len)
 234                 return 0; /* no connection */
 235
 236         if (conn_len == 1) {
 237                 /* single connection */
 238                 parm = snd_hda_codec_read(codec, nid, 0,
 239                                           AC_VERB_GET_CONNECT_LIST, 0);
 240                 conn_list[0] = parm & mask;
 241                 return 1;
 242         }
 243
 244         /* multi connection */
 245         conns = 0;
 246         prev_nid = 0;
 247         for (i = 0; i < conn_len; i++) {
 248                 int range_val;
 249                 hda_nid_t val, n;
 250
 251                 if (i % num_elems == 0)
 252                         parm = snd_hda_codec_read(codec, nid, 0,
 253                                                   AC_VERB_GET_CONNECT_LIST, i);
 254                 range_val = !!(parm & (1 << (shift-1))); /* ranges */
 255                 val = parm & mask;
 256                 parm >>= shift;
 257                 if (range_val) {
 258                         /* ranges between the previous and this one */
 259                         if (!prev_nid || prev_nid >= val) {
 260                                 snd_printk(KERN_WARNING "hda_codec: "
 261                                            "invalid dep_range_val %x:%x\n",
 262                                            prev_nid, val);
 263                                 continue;
 264                         }
 265                         for (n = prev_nid + 1; n <= val; n++) {
 266                                 if (conns >= max_conns) {
 267                                         snd_printk(KERN_ERR
 268                                                    "Too many connections\n");
 269                                         return -EINVAL;
 270                                 }
 271                                 conn_list[conns++] = n;
 272                         }
 273                 } else {
 274                         if (conns >= max_conns) {
 275                                 snd_printk(KERN_ERR "Too many connections\n");
 276                                 return -EINVAL;
 277                         }
 278                         conn_list[conns++] = val;
 279                 }
 280                 prev_nid = val;
 281         }
 282         return conns;
 283 }
 284
 285
 286 /**
 287  * snd_hda_queue_unsol_event - add an unsolicited event to queue
 288  * @bus: the BUS
 289  * @res: unsolicited event (lower 32bit of RIRB entry)
 290  * @res_ex: codec addr and flags (upper 32bit or RIRB entry)
 291  *
 292  * Adds the given event to the queue.  The events are processed in
 293  * the workqueue asynchronously.  Call this function in the interrupt
 294  * hanlder when RIRB receives an unsolicited event.
 295  *
 296  * Returns 0 if successful, or a negative error code.
 297  */
 298 int snd_hda_queue_unsol_event(struct hda_bus *bus, u32 res, u32 res_ex)
 299 {
 300         struct hda_bus_unsolicited *unsol;
 301         unsigned int wp;
 302
 303         unsol = bus->unsol;
 304         if (!unsol)
 305                 return 0;
 306
 307         wp = (unsol->wp + 1) % HDA_UNSOL_QUEUE_SIZE;
 308         unsol->wp = wp;
 309
 310         wp <<= 1;
 311         unsol->queue[wp] = res;
 312         unsol->queue[wp + 1] = res_ex;
 313
 314         schedule_work(&unsol->work);
 315
 316         return 0;
 317 }
 318
 319 /*
 320  * process queued unsolicited events
 321  */
 322 static void process_unsol_events(struct work_struct *work)
 323 {
 324         struct hda_bus_unsolicited *unsol =
 325                 container_of(work, struct hda_bus_unsolicited, work);
 326         struct hda_bus *bus = unsol->bus;
 327         struct hda_codec *codec;
 328         unsigned int rp, caddr, res;
 329
 330         while (unsol->rp != unsol->wp) {
 331                 rp = (unsol->rp + 1) % HDA_UNSOL_QUEUE_SIZE;
 332                 unsol->rp = rp;
 333                 rp <<= 1;
 334                 res = unsol->queue[rp];
 335                 caddr = unsol->queue[rp + 1];
 336                 if (!(caddr & (1 << 4))) /* no unsolicited event? */
 337                         continue;
 338                 codec = bus->caddr_tbl[caddr & 0x0f];
 339                 if (codec && codec->patch_ops.unsol_event)
 340                         codec->patch_ops.unsol_event(codec, res);
 341         }
 342 }
 343
 344 /*
 345  * initialize unsolicited queue
 346  */
 347 static int __devinit init_unsol_queue(struct hda_bus *bus)
 348 {
 349         struct hda_bus_unsolicited *unsol;
 350
 351         if (bus->unsol) /* already initialized */
 352                 return 0;
 353
 354         unsol = kzalloc(sizeof(*unsol), GFP_KERNEL);
 355         if (!unsol) {
 356                 snd_printk(KERN_ERR "hda_codec: "
 357                            "can't allocate unsolicited queue\n");
 358                 return -ENOMEM;
 359         }
 360         INIT_WORK(&unsol->work, process_unsol_events);
 361         unsol->bus = bus;
 362         bus->unsol = unsol;
 363         return 0;
 364 }
 365
 366 /*
 367  * destructor
 368  */
 369 static void snd_hda_codec_free(struct hda_codec *codec);
 370
 371 static int snd_hda_bus_free(struct hda_bus *bus)
 372 {
 373         struct hda_codec *codec, *n;
 374
 375         if (!bus)
 376                 return 0;
 377         if (bus->unsol) {
 378                 flush_scheduled_work();
 379                 kfree(bus->unsol);
 380         }
 381         list_for_each_entry_safe(codec, n, &bus->codec_list, list) {
 382                 snd_hda_codec_free(codec);
 383         }
 384         if (bus->ops.private_free)
 385                 bus->ops.private_free(bus);
 386         kfree(bus);
 387         return 0;
 388 }
 389
 390 static int snd_hda_bus_dev_free(struct snd_device *device)
 391 {
 392         struct hda_bus *bus = device->device_data;
 393         return snd_hda_bus_free(bus);
 394 }
 395
 396 /**
 397  * snd_hda_bus_new - create a HDA bus
 398  * @card: the card entry
 399  * @temp: the template for hda_bus information
 400  * @busp: the pointer to store the created bus instance
 401  *
 402  * Returns 0 if successful, or a negative error code.
 403  */
 404 int __devinit snd_hda_bus_new(struct snd_card *card,
 405                               const struct hda_bus_template *temp,
 406                               struct hda_bus **busp)
 407 {
 408         struct hda_bus *bus;
 409         int err;
 410         static struct snd_device_ops dev_ops = {
 411                 .dev_free = snd_hda_bus_dev_free,
 412         };
 413
 414         if (snd_BUG_ON(!temp))
 415                 return -EINVAL;
 416         if (snd_BUG_ON(!temp->ops.command || !temp->ops.get_response))
 417                 return -EINVAL;
 418
 419         if (busp)
 420                 *busp = NULL;
 421
 422         bus = kzalloc(sizeof(*bus), GFP_KERNEL);
 423         if (bus == NULL) {
 424                 snd_printk(KERN_ERR "can't allocate struct hda_bus\n");
 425                 return -ENOMEM;
 426         }
 427
 428         bus->card = card;
 429         bus->private_data = temp->private_data;
 430         bus->pci = temp->pci;
 431         bus->modelname = temp->modelname;
 432         bus->ops = temp->ops;
 433
 434         mutex_init(&bus->cmd_mutex);
 435         INIT_LIST_HEAD(&bus->codec_list);
 436
 437         err = snd_device_new(card, SNDRV_DEV_BUS, bus, &dev_ops);
 438         if (err < 0) {
 439                 snd_hda_bus_free(bus);
 440                 return err;
 441         }
 442         if (busp)
 443                 *busp = bus;
 444         return 0;
 445 }
 446
 447 #ifdef CONFIG_SND_HDA_GENERIC
 448 #define is_generic_config(codec) \
 449         (codec->bus->modelname && !strcmp(codec->bus->modelname, "generic"))
 450 #else
 451 #define is_generic_config(codec)        0
 452 #endif
 453
 454 /*
 455  * find a matching codec preset
 456  */
 457 static const struct hda_codec_preset __devinit *
 458 find_codec_preset(struct hda_codec *codec)
 459 {
 460         const struct hda_codec_preset **tbl, *preset;
 461
 462         if (is_generic_config(codec))
 463                 return NULL; /* use the generic parser */
 464
 465         for (tbl = hda_preset_tables; *tbl; tbl++) {
 466                 for (preset = *tbl; preset->id; preset++) {
 467                         u32 mask = preset->mask;
 468                         if (preset->afg && preset->afg != codec->afg)
 469                                 continue;
 470                         if (preset->mfg && preset->mfg != codec->mfg)
 471                                 continue;
 472                         if (!mask)
 473                                 mask = ~0;
 474                         if (preset->id == (codec->vendor_id & mask) &&
 475                             (!preset->rev ||
 476                              preset->rev == codec->revision_id))
 477                                 return preset;
 478                 }
 479         }
 480         return NULL;
 481 }
 482
 483 /*
 484  * snd_hda_get_codec_name - store the codec name
 485  */
 486 void snd_hda_get_codec_name(struct hda_codec *codec,
 487                             char *name, int namelen)
 488 {
 489         const struct hda_vendor_id *c;
 490         const char *vendor = NULL;
 491         u16 vendor_id = codec->vendor_id >> 16;
 492         char tmp[16];
 493
 494         for (c = hda_vendor_ids; c->id; c++) {
 495                 if (c->id == vendor_id) {
 496                         vendor = c->name;
 497                         break;
 498                 }
 499         }
 500         if (!vendor) {
 501                 sprintf(tmp, "Generic %04x", vendor_id);
 502                 vendor = tmp;
 503         }
 504         if (codec->preset && codec->preset->name)
 505                 snprintf(name, namelen, "%s %s", vendor, codec->preset->name);
 506         else
 507                 snprintf(name, namelen, "%s ID %x", vendor,
 508                          codec->vendor_id & 0xffff);
 509 }
 510
 511 /*
 512  * look for an AFG and MFG nodes
 513  */
 514 static void __devinit setup_fg_nodes(struct hda_codec *codec)
 515 {
 516         int i, total_nodes;
 517         hda_nid_t nid;
 518
 519         total_nodes = snd_hda_get_sub_nodes(codec, AC_NODE_ROOT, &nid);
 520         for (i = 0; i < total_nodes; i++, nid++) {
 521                 unsigned int func;
 522                 func = snd_hda_param_read(codec, nid, AC_PAR_FUNCTION_TYPE);
 523                 switch (func & 0xff) {
 524                 case AC_GRP_AUDIO_FUNCTION:
 525                         codec->afg = nid;
 526                         break;
 527                 case AC_GRP_MODEM_FUNCTION:
 528                         codec->mfg = nid;
 529                         break;
 530                 default:
 531                         break;
 532                 }
 533         }
 534 }
 535
 536 /*
 537  * read widget caps for each widget and store in cache
 538  */
 539 static int read_widget_caps(struct hda_codec *codec, hda_nid_t fg_node)
 540 {
 541         int i;
 542         hda_nid_t nid;
 543
 544         codec->num_nodes = snd_hda_get_sub_nodes(codec, fg_node,
 545                                                  &codec->start_nid);
 546         codec->wcaps = kmalloc(codec->num_nodes * 4, GFP_KERNEL);
 547         if (!codec->wcaps)
 548                 return -ENOMEM;
 549         nid = codec->start_nid;
 550         for (i = 0; i < codec->num_nodes; i++, nid++)
 551                 codec->wcaps[i] = snd_hda_param_read(codec, nid,
 552                                                      AC_PAR_AUDIO_WIDGET_CAP);
 553         return 0;
 554 }
 555
 556
 557 static void init_hda_cache(struct hda_cache_rec *cache,
 558                            unsigned int record_size);
 559 static void free_hda_cache(struct hda_cache_rec *cache);
 560
 561 /*
 562  * codec destructor
 563  */
 564 static void snd_hda_codec_free(struct hda_codec *codec)
 565 {
 566         if (!codec)
 567                 return;
 568 #ifdef CONFIG_SND_HDA_POWER_SAVE
 569         cancel_delayed_work(&codec->power_work);
 570         flush_scheduled_work();
 571 #endif
 572         list_del(&codec->list);
 573         codec->bus->caddr_tbl[codec->addr] = NULL;
 574         if (codec->patch_ops.free)
 575                 codec->patch_ops.free(codec);
 576         free_hda_cache(&codec->amp_cache);
 577         free_hda_cache(&codec->cmd_cache);
 578         kfree(codec->wcaps);
 579         kfree(codec);
 580 }
 581
 582 /**
 583  * snd_hda_codec_new - create a HDA codec
 584  * @bus: the bus to assign
 585  * @codec_addr: the codec address
 586  * @codecp: the pointer to store the generated codec
 587  *
 588  * Returns 0 if successful, or a negative error code.
 589  */
 590 int __devinit snd_hda_codec_new(struct hda_bus *bus, unsigned int codec_addr,
 591                                 struct hda_codec **codecp)
 592 {
 593         struct hda_codec *codec;
 594         char component[31];
 595         int err;
 596
 597         if (snd_BUG_ON(!bus))
 598                 return -EINVAL;
 599         if (snd_BUG_ON(codec_addr > HDA_MAX_CODEC_ADDRESS))
 600                 return -EINVAL;
 601
 602         if (bus->caddr_tbl[codec_addr]) {
 603                 snd_printk(KERN_ERR "hda_codec: "
 604                            "address 0x%x is already occupied\n", codec_addr);
 605                 return -EBUSY;
 606         }
 607
 608         codec = kzalloc(sizeof(*codec), GFP_KERNEL);
 609         if (codec == NULL) {
 610                 snd_printk(KERN_ERR "can't allocate struct hda_codec\n");
 611                 return -ENOMEM;
 612         }
 613
 614         codec->bus = bus;
 615         codec->addr = codec_addr;
 616         mutex_init(&codec->spdif_mutex);
 617         init_hda_cache(&codec->amp_cache, sizeof(struct hda_amp_info));
 618         init_hda_cache(&codec->cmd_cache, sizeof(struct hda_cache_head));
 619
 620 #ifdef CONFIG_SND_HDA_POWER_SAVE
 621         INIT_DELAYED_WORK(&codec->power_work, hda_power_work);
 622         /* snd_hda_codec_new() marks the codec as power-up, and leave it as is.
 623          * the caller has to power down appropriatley after initialization
 624          * phase.
 625          */
 626         hda_keep_power_on(codec);
 627 #endif
 628
 629         list_add_tail(&codec->list, &bus->codec_list);
 630         bus->caddr_tbl[codec_addr] = codec;
 631
 632         codec->vendor_id = snd_hda_param_read(codec, AC_NODE_ROOT,
 633                                               AC_PAR_VENDOR_ID);
 634         if (codec->vendor_id == -1)
 635                 /* read again, hopefully the access method was corrected
 636                  * in the last read...
 637                  */
 638                 codec->vendor_id = snd_hda_param_read(codec, AC_NODE_ROOT,
 639                                                       AC_PAR_VENDOR_ID);
 640         codec->subsystem_id = snd_hda_param_read(codec, AC_NODE_ROOT,
 641                                                  AC_PAR_SUBSYSTEM_ID);
 642         codec->revision_id = snd_hda_param_read(codec, AC_NODE_ROOT,
 643                                                 AC_PAR_REV_ID);
 644
 645         setup_fg_nodes(codec);
 646         if (!codec->afg && !codec->mfg) {
 647                 snd_printdd("hda_codec: no AFG or MFG node found\n");
 648                 snd_hda_codec_free(codec);
 649                 return -ENODEV;
 650         }
 651
 652         if (read_widget_caps(codec, codec->afg ? codec->afg : codec->mfg) < 0) {
 653                 snd_printk(KERN_ERR "hda_codec: cannot malloc\n");
 654                 snd_hda_codec_free(codec);
 655                 return -ENOMEM;
 656         }
 657
 658         if (!codec->subsystem_id) {
 659                 hda_nid_t nid = codec->afg ? codec->afg : codec->mfg;
 660                 codec->subsystem_id =
 661                         snd_hda_codec_read(codec, nid, 0,
 662                                            AC_VERB_GET_SUBSYSTEM_ID, 0);
 663         }
 664
 665         codec->preset = find_codec_preset(codec);
 666         /* audio codec should override the mixer name */
 667         if (codec->afg || !*bus->card->mixername)
 668                 snd_hda_get_codec_name(codec, bus->card->mixername,
 669                                        sizeof(bus->card->mixername));
 670
 671         if (is_generic_config(codec)) {
 672                 err = snd_hda_parse_generic_codec(codec);
 673                 goto patched;
 674         }
 675         if (codec->preset && codec->preset->patch) {
 676                 err = codec->preset->patch(codec);
 677                 goto patched;
 678         }
 679
 680         /* call the default parser */
 681         err = snd_hda_parse_generic_codec(codec);
 682         if (err < 0)
 683                 printk(KERN_ERR "hda-codec: No codec parser is available\n");
 684
 685  patched:
 686         if (err < 0) {
 687                 snd_hda_codec_free(codec);
 688                 return err;
 689         }
 690
 691         if (codec->patch_ops.unsol_event)
 692                 init_unsol_queue(bus);
 693
 694         snd_hda_codec_proc_new(codec);
 695 #ifdef CONFIG_SND_HDA_HWDEP
 696         snd_hda_create_hwdep(codec);
 697 #endif
 698
 699         sprintf(component, "HDA:%08x,%08x,%08x", codec->vendor_id, codec->subsystem_id, codec->revision_id);
 700         snd_component_add(codec->bus->card, component);
 701
 702         if (codecp)
 703                 *codecp = codec;
 704         return 0;
 705 }
 706
 707 /**
 708  * snd_hda_codec_setup_stream - set up the codec for streaming
 709  * @codec: the CODEC to set up
 710  * @nid: the NID to set up
 711  * @stream_tag: stream tag to pass, it's between 0x1 and 0xf.
 712  * @channel_id: channel id to pass, zero based.
 713  * @format: stream format.
 714  */
 715 void snd_hda_codec_setup_stream(struct hda_codec *codec, hda_nid_t nid,
 716                                 u32 stream_tag,
 717                                 int channel_id, int format)
 718 {
 719         if (!nid)
 720                 return;
 721
 722         snd_printdd("hda_codec_setup_stream: "
 723                     "NID=0x%x, stream=0x%x, channel=%d, format=0x%x\n",
 724                     nid, stream_tag, channel_id, format);
 725         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CHANNEL_STREAMID,
 726                             (stream_tag << 4) | channel_id);
 727         msleep(1);
 728         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_STREAM_FORMAT, format);
 729 }
 730
 731 void snd_hda_codec_cleanup_stream(struct hda_codec *codec, hda_nid_t nid)
 732 {
 733         if (!nid)
 734                 return;
 735
 736         snd_printdd("hda_codec_cleanup_stream: NID=0x%x\n", nid);
 737         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CHANNEL_STREAMID, 0);
 738 #if 0 /* keep the format */
 739         msleep(1);
 740         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_STREAM_FORMAT, 0);
 741 #endif
 742 }
 743
 744 /*
 745  * amp access functions
 746  */
 747
 748 /* FIXME: more better hash key? */
 749 #define HDA_HASH_KEY(nid,dir,idx) (u32)((nid) + ((idx) << 16) + ((dir) << 24))
 750 #define INFO_AMP_CAPS   (1<<0)
 751 #define INFO_AMP_VOL(ch)        (1 << (1 + (ch)))
 752
 753 /* initialize the hash table */
 754 static void __devinit init_hda_cache(struct hda_cache_rec *cache,
 755                                      unsigned int record_size)
 756 {
 757         memset(cache, 0, sizeof(*cache));
 758         memset(cache->hash, 0xff, sizeof(cache->hash));
 759         cache->record_size = record_size;
 760 }
 761
 762 static void free_hda_cache(struct hda_cache_rec *cache)
 763 {
 764         kfree(cache->buffer);
 765 }
 766
 767 /* query the hash.  allocate an entry if not found. */
 768 static struct hda_cache_head  *get_alloc_hash(struct hda_cache_rec *cache,
 769                                               u32 key)
 770 {
 771         u16 idx = key % (u16)ARRAY_SIZE(cache->hash);
 772         u16 cur = cache->hash[idx];
 773         struct hda_cache_head *info;
 774
 775         while (cur != 0xffff) {
 776                 info = (struct hda_cache_head *)(cache->buffer +
 777                                                  cur * cache->record_size);
 778                 if (info->key == key)
 779                         return info;
 780                 cur = info->next;
 781         }
 782
 783         /* add a new hash entry */
 784         if (cache->num_entries >= cache->size) {
 785                 /* reallocate the array */
 786                 unsigned int new_size = cache->size + 64;
 787                 void *new_buffer;
 788                 new_buffer = kcalloc(new_size, cache->record_size, GFP_KERNEL);
 789                 if (!new_buffer) {
 790                         snd_printk(KERN_ERR "hda_codec: "
 791                                    "can't malloc amp_info\n");
 792                         return NULL;
 793                 }
 794                 if (cache->buffer) {
 795                         memcpy(new_buffer, cache->buffer,
 796                                cache->size * cache->record_size);
 797                         kfree(cache->buffer);
 798                 }
 799                 cache->size = new_size;
 800                 cache->buffer = new_buffer;
 801         }
 802         cur = cache->num_entries++;
 803         info = (struct hda_cache_head *)(cache->buffer +
 804                                          cur * cache->record_size);
 805         info->key = key;
 806         info->val = 0;
 807         info->next = cache->hash[idx];
 808         cache->hash[idx] = cur;
 809
 810         return info;
 811 }
 812
 813 /* query and allocate an amp hash entry */
 814 static inline struct hda_amp_info *
 815 get_alloc_amp_hash(struct hda_codec *codec, u32 key)
 816 {
 817         return (struct hda_amp_info *)get_alloc_hash(&codec->amp_cache, key);
 818 }
 819
 820 /*
 821  * query AMP capabilities for the given widget and direction
 822  */
 823 u32 query_amp_caps(struct hda_codec *codec, hda_nid_t nid, int direction)
 824 {
 825         struct hda_amp_info *info;
 826
 827         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, 0));
 828         if (!info)
 829                 return 0;
 830         if (!(info->head.val & INFO_AMP_CAPS)) {
 831                 if (!(get_wcaps(codec, nid) & AC_WCAP_AMP_OVRD))
 832                         nid = codec->afg;
 833                 info->amp_caps = snd_hda_param_read(codec, nid,
 834                                                     direction == HDA_OUTPUT ?
 835                                                     AC_PAR_AMP_OUT_CAP :
 836                                                     AC_PAR_AMP_IN_CAP);
 837                 if (info->amp_caps)
 838                         info->head.val |= INFO_AMP_CAPS;
 839         }
 840         return info->amp_caps;
 841 }
 842
 843 int snd_hda_override_amp_caps(struct hda_codec *codec, hda_nid_t nid, int dir,
 844                               unsigned int caps)
 845 {
 846         struct hda_amp_info *info;
 847
 848         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, dir, 0));
 849         if (!info)
 850                 return -EINVAL;
 851         info->amp_caps = caps;
 852         info->head.val |= INFO_AMP_CAPS;
 853         return 0;
 854 }
 855
 856 /*
 857  * read the current volume to info
 858  * if the cache exists, read the cache value.
 859  */
 860 static unsigned int get_vol_mute(struct hda_codec *codec,
 861                                  struct hda_amp_info *info, hda_nid_t nid,
 862                                  int ch, int direction, int index)
 863 {
 864         u32 val, parm;
 865
 866         if (info->head.val & INFO_AMP_VOL(ch))
 867                 return info->vol[ch];
 868
 869         parm = ch ? AC_AMP_GET_RIGHT : AC_AMP_GET_LEFT;
 870         parm |= direction == HDA_OUTPUT ? AC_AMP_GET_OUTPUT : AC_AMP_GET_INPUT;
 871         parm |= index;
 872         val = snd_hda_codec_read(codec, nid, 0,
 873                                  AC_VERB_GET_AMP_GAIN_MUTE, parm);
 874         info->vol[ch] = val & 0xff;
 875         info->head.val |= INFO_AMP_VOL(ch);
 876         return info->vol[ch];
 877 }
 878
 879 /*
 880  * write the current volume in info to the h/w and update the cache
 881  */
 882 static void put_vol_mute(struct hda_codec *codec, struct hda_amp_info *info,
 883                          hda_nid_t nid, int ch, int direction, int index,
 884                          int val)
 885 {
 886         u32 parm;
 887
 888         parm = ch ? AC_AMP_SET_RIGHT : AC_AMP_SET_LEFT;
 889         parm |= direction == HDA_OUTPUT ? AC_AMP_SET_OUTPUT : AC_AMP_SET_INPUT;
 890         parm |= index << AC_AMP_SET_INDEX_SHIFT;
 891         parm |= val;
 892         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_AMP_GAIN_MUTE, parm);
 893         info->vol[ch] = val;
 894 }
 895
 896 /*
 897  * read AMP value.  The volume is between 0 to 0x7f, 0x80 = mute bit.
 898  */
 899 int snd_hda_codec_amp_read(struct hda_codec *codec, hda_nid_t nid, int ch,
 900                            int direction, int index)
 901 {
 902         struct hda_amp_info *info;
 903         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, index));
 904         if (!info)
 905                 return 0;
 906         return get_vol_mute(codec, info, nid, ch, direction, index);
 907 }
 908
 909 /*
 910  * update the AMP value, mask = bit mask to set, val = the value
 911  */
 912 int snd_hda_codec_amp_update(struct hda_codec *codec, hda_nid_t nid, int ch,
 913                              int direction, int idx, int mask, int val)
 914 {
 915         struct hda_amp_info *info;
 916
 917         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, idx));
 918         if (!info)
 919                 return 0;
 920         val &= mask;
 921         val |= get_vol_mute(codec, info, nid, ch, direction, idx) & ~mask;
 922         if (info->vol[ch] == val)
 923                 return 0;
 924         put_vol_mute(codec, info, nid, ch, direction, idx, val);
 925         return 1;
 926 }
 927
 928 /*
 929  * update the AMP stereo with the same mask and value
 930  */
 931 int snd_hda_codec_amp_stereo(struct hda_codec *codec, hda_nid_t nid,
 932                              int direction, int idx, int mask, int val)
 933 {
 934         int ch, ret = 0;
 935         for (ch = 0; ch < 2; ch++)
 936                 ret |= snd_hda_codec_amp_update(codec, nid, ch, direction,
 937                                                 idx, mask, val);
 938         return ret;
 939 }
 940
 941 #ifdef SND_HDA_NEEDS_RESUME
 942 /* resume the all amp commands from the cache */
 943 void snd_hda_codec_resume_amp(struct hda_codec *codec)
 944 {
 945         struct hda_amp_info *buffer = codec->amp_cache.buffer;
 946         int i;
 947
 948         for (i = 0; i < codec->amp_cache.size; i++, buffer++) {
 949                 u32 key = buffer->head.key;
 950                 hda_nid_t nid;
 951                 unsigned int idx, dir, ch;
 952                 if (!key)
 953                         continue;
 954                 nid = key & 0xff;
 955                 idx = (key >> 16) & 0xff;
 956                 dir = (key >> 24) & 0xff;
 957                 for (ch = 0; ch < 2; ch++) {
 958                         if (!(buffer->head.val & INFO_AMP_VOL(ch)))
 959                                 continue;
 960                         put_vol_mute(codec, buffer, nid, ch, dir, idx,
 961                                      buffer->vol[ch]);
 962                 }
 963         }
 964 }
 965 #endif /* SND_HDA_NEEDS_RESUME */
 966
 967 /* volume */
 968 int snd_hda_mixer_amp_volume_info(struct snd_kcontrol *kcontrol,
 969                                   struct snd_ctl_elem_info *uinfo)
 970 {
 971         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
 972         u16 nid = get_amp_nid(kcontrol);
 973         u8 chs = get_amp_channels(kcontrol);
 974         int dir = get_amp_direction(kcontrol);
 975         u32 caps;
 976
 977         caps = query_amp_caps(codec, nid, dir);
 978         /* num steps */
 979         caps = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT;
 980         if (!caps) {
 981                 printk(KERN_WARNING "hda_codec: "
 982                        "num_steps = 0 for NID=0x%x (ctl = %s)\n", nid,
 983                        kcontrol->id.name);
 984                 return -EINVAL;
 985         }
 986         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 987         uinfo->count = chs == 3 ? 2 : 1;
 988         uinfo->value.integer.min = 0;
 989         uinfo->value.integer.max = caps;
 990         return 0;
 991 }
 992
 993 int snd_hda_mixer_amp_volume_get(struct snd_kcontrol *kcontrol,
 994                                  struct snd_ctl_elem_value *ucontrol)
 995 {
 996         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
 997         hda_nid_t nid = get_amp_nid(kcontrol);
 998         int chs = get_amp_channels(kcontrol);
 999         int dir = get_amp_direction(kcontrol);
1000         int idx = get_amp_index(kcontrol);
1001         long *valp = ucontrol->value.integer.value;
1002
1003         if (chs & 1)
1004                 *valp++ = snd_hda_codec_amp_read(codec, nid, 0, dir, idx)
1005                         & HDA_AMP_VOLMASK;
1006         if (chs & 2)
1007                 *valp = snd_hda_codec_amp_read(codec, nid, 1, dir, idx)
1008                         & HDA_AMP_VOLMASK;
1009         return 0;
1010 }
1011
1012 int snd_hda_mixer_amp_volume_put(struct snd_kcontrol *kcontrol,
1013                                  struct snd_ctl_elem_value *ucontrol)
1014 {
1015         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1016         hda_nid_t nid = get_amp_nid(kcontrol);
1017         int chs = get_amp_channels(kcontrol);
1018         int dir = get_amp_direction(kcontrol);
1019         int idx = get_amp_index(kcontrol);
1020         long *valp = ucontrol->value.integer.value;
1021         int change = 0;
1022
1023         snd_hda_power_up(codec);
1024         if (chs & 1) {
1025                 change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
1026                                                   0x7f, *valp);
1027                 valp++;
1028         }
1029         if (chs & 2)
1030                 change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
1031                                                    0x7f, *valp);
1032         snd_hda_power_down(codec);
1033         return change;
1034 }
1035
1036 int snd_hda_mixer_amp_tlv(struct snd_kcontrol *kcontrol, int op_flag,
1037                           unsigned int size, unsigned int __user *_tlv)
1038 {
1039         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1040         hda_nid_t nid = get_amp_nid(kcontrol);
1041         int dir = get_amp_direction(kcontrol);
1042         u32 caps, val1, val2;
1043
1044         if (size < 4 * sizeof(unsigned int))
1045                 return -ENOMEM;
1046         caps = query_amp_caps(codec, nid, dir);
1047         val2 = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
1048         val2 = (val2 + 1) * 25;
1049         val1 = -((caps & AC_AMPCAP_OFFSET) >> AC_AMPCAP_OFFSET_SHIFT);
1050         val1 = ((int)val1) * ((int)val2);
1051         if (put_user(SNDRV_CTL_TLVT_DB_SCALE, _tlv))
1052                 return -EFAULT;
1053         if (put_user(2 * sizeof(unsigned int), _tlv + 1))
1054                 return -EFAULT;
1055         if (put_user(val1, _tlv + 2))
1056                 return -EFAULT;
1057         if (put_user(val2, _tlv + 3))
1058                 return -EFAULT;
1059         return 0;
1060 }
1061
1062 /*
1063  * set (static) TLV for virtual master volume; recalculated as max 0dB
1064  */
1065 void snd_hda_set_vmaster_tlv(struct hda_codec *codec, hda_nid_t nid, int dir,
1066                              unsigned int *tlv)
1067 {
1068         u32 caps;
1069         int nums, step;
1070
1071         caps = query_amp_caps(codec, nid, dir);
1072         nums = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT;
1073         step = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
1074         step = (step + 1) * 25;
1075         tlv[0] = SNDRV_CTL_TLVT_DB_SCALE;
1076         tlv[1] = 2 * sizeof(unsigned int);
1077         tlv[2] = -nums * step;
1078         tlv[3] = step;
1079 }
1080
1081 /* find a mixer control element with the given name */
1082 static struct snd_kcontrol *
1083 _snd_hda_find_mixer_ctl(struct hda_codec *codec,
1084                         const char *name, int idx)
1085 {
1086         struct snd_ctl_elem_id id;
1087         memset(&id, 0, sizeof(id));
1088         id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1089         id.index = idx;
1090         strcpy(id.name, name);
1091         return snd_ctl_find_id(codec->bus->card, &id);
1092 }
1093
1094 struct snd_kcontrol *snd_hda_find_mixer_ctl(struct hda_codec *codec,
1095                                             const char *name)
1096 {
1097         return _snd_hda_find_mixer_ctl(codec, name, 0);
1098 }
1099
1100 /* create a virtual master control and add slaves */
1101 int snd_hda_add_vmaster(struct hda_codec *codec, char *name,
1102                         unsigned int *tlv, const char **slaves)
1103 {
1104         struct snd_kcontrol *kctl;
1105         const char **s;
1106         int err;
1107
1108         for (s = slaves; *s && !snd_hda_find_mixer_ctl(codec, *s); s++)
1109                 ;
1110         if (!*s) {
1111                 snd_printdd("No slave found for %s\n", name);
1112                 return 0;
1113         }
1114         kctl = snd_ctl_make_virtual_master(name, tlv);
1115         if (!kctl)
1116                 return -ENOMEM;
1117         err = snd_ctl_add(codec->bus->card, kctl);
1118         if (err < 0)
1119                 return err;
1120
1121         for (s = slaves; *s; s++) {
1122                 struct snd_kcontrol *sctl;
1123
1124                 sctl = snd_hda_find_mixer_ctl(codec, *s);
1125                 if (!sctl) {
1126                         snd_printdd("Cannot find slave %s, skipped\n", *s);
1127                         continue;
1128                 }
1129                 err = snd_ctl_add_slave(kctl, sctl);
1130                 if (err < 0)
1131                         return err;
1132         }
1133         return 0;
1134 }
1135
1136 /* switch */
1137 int snd_hda_mixer_amp_switch_info(struct snd_kcontrol *kcontrol,
1138                                   struct snd_ctl_elem_info *uinfo)
1139 {
1140         int chs = get_amp_channels(kcontrol);
1141
1142         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1143         uinfo->count = chs == 3 ? 2 : 1;
1144         uinfo->value.integer.min = 0;
1145         uinfo->value.integer.max = 1;
1146         return 0;
1147 }
1148
1149 int snd_hda_mixer_amp_switch_get(struct snd_kcontrol *kcontrol,
1150                                  struct snd_ctl_elem_value *ucontrol)
1151 {
1152         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1153         hda_nid_t nid = get_amp_nid(kcontrol);
1154         int chs = get_amp_channels(kcontrol);
1155         int dir = get_amp_direction(kcontrol);
1156         int idx = get_amp_index(kcontrol);
1157         long *valp = ucontrol->value.integer.value;
1158
1159         if (chs & 1)
1160                 *valp++ = (snd_hda_codec_amp_read(codec, nid, 0, dir, idx) &
1161                            HDA_AMP_MUTE) ? 0 : 1;
1162         if (chs & 2)
1163                 *valp = (snd_hda_codec_amp_read(codec, nid, 1, dir, idx) &
1164                          HDA_AMP_MUTE) ? 0 : 1;
1165         return 0;
1166 }
1167
1168 int snd_hda_mixer_amp_switch_put(struct snd_kcontrol *kcontrol,
1169                                  struct snd_ctl_elem_value *ucontrol)
1170 {
1171         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1172         hda_nid_t nid = get_amp_nid(kcontrol);
1173         int chs = get_amp_channels(kcontrol);
1174         int dir = get_amp_direction(kcontrol);
1175         int idx = get_amp_index(kcontrol);
1176         long *valp = ucontrol->value.integer.value;
1177         int change = 0;
1178
1179         snd_hda_power_up(codec);
1180         if (chs & 1) {
1181                 change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
1182                                                   HDA_AMP_MUTE,
1183                                                   *valp ? 0 : HDA_AMP_MUTE);
1184                 valp++;
1185         }
1186         if (chs & 2)
1187                 change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
1188                                                    HDA_AMP_MUTE,
1189                                                    *valp ? 0 : HDA_AMP_MUTE);
1190 #ifdef CONFIG_SND_HDA_POWER_SAVE
1191         if (codec->patch_ops.check_power_status)
1192                 codec->patch_ops.check_power_status(codec, nid);
1193 #endif
1194         snd_hda_power_down(codec);
1195         return change;
1196 }
1197
1198 /*
1199  * bound volume controls
1200  *
1201  * bind multiple volumes (# indices, from 0)
1202  */
1203
1204 #define AMP_VAL_IDX_SHIFT       19
1205 #define AMP_VAL_IDX_MASK        (0x0f<<19)
1206
1207 int snd_hda_mixer_bind_switch_get(struct snd_kcontrol *kcontrol,
1208                                   struct snd_ctl_elem_value *ucontrol)
1209 {
1210         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1211         unsigned long pval;
1212         int err;
1213
1214         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1215         pval = kcontrol->private_value;
1216         kcontrol->private_value = pval & ~AMP_VAL_IDX_MASK; /* index 0 */
1217         err = snd_hda_mixer_amp_switch_get(kcontrol, ucontrol);
1218         kcontrol->private_value = pval;
1219         mutex_unlock(&codec->spdif_mutex);
1220         return err;
1221 }
1222
1223 int snd_hda_mixer_bind_switch_put(struct snd_kcontrol *kcontrol,
1224                                   struct snd_ctl_elem_value *ucontrol)
1225 {
1226         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1227         unsigned long pval;
1228         int i, indices, err = 0, change = 0;
1229
1230         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1231         pval = kcontrol->private_value;
1232         indices = (pval & AMP_VAL_IDX_MASK) >> AMP_VAL_IDX_SHIFT;
1233         for (i = 0; i < indices; i++) {
1234                 kcontrol->private_value = (pval & ~AMP_VAL_IDX_MASK) |
1235                         (i << AMP_VAL_IDX_SHIFT);
1236                 err = snd_hda_mixer_amp_switch_put(kcontrol, ucontrol);
1237                 if (err < 0)
1238                         break;
1239                 change |= err;
1240         }
1241         kcontrol->private_value = pval;
1242         mutex_unlock(&codec->spdif_mutex);
1243         return err < 0 ? err : change;
1244 }
1245
1246 /*
1247  * generic bound volume/swtich controls
1248  */
1249 int snd_hda_mixer_bind_ctls_info(struct snd_kcontrol *kcontrol,
1250                                  struct snd_ctl_elem_info *uinfo)
1251 {
1252         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1253         struct hda_bind_ctls *c;
1254         int err;
1255
1256         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1257         c = (struct hda_bind_ctls *)kcontrol->private_value;
1258         kcontrol->private_value = *c->values;
1259         err = c->ops->info(kcontrol, uinfo);
1260         kcontrol->private_value = (long)c;
1261         mutex_unlock(&codec->spdif_mutex);
1262         return err;
1263 }
1264
1265 int snd_hda_mixer_bind_ctls_get(struct snd_kcontrol *kcontrol,
1266                                 struct snd_ctl_elem_value *ucontrol)
1267 {
1268         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1269         struct hda_bind_ctls *c;
1270         int err;
1271
1272         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1273         c = (struct hda_bind_ctls *)kcontrol->private_value;
1274         kcontrol->private_value = *c->values;
1275         err = c->ops->get(kcontrol, ucontrol);
1276         kcontrol->private_value = (long)c;
1277         mutex_unlock(&codec->spdif_mutex);
1278         return err;
1279 }
1280
1281 int snd_hda_mixer_bind_ctls_put(struct snd_kcontrol *kcontrol,
1282                                 struct snd_ctl_elem_value *ucontrol)
1283 {
1284         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1285         struct hda_bind_ctls *c;
1286         unsigned long *vals;
1287         int err = 0, change = 0;
1288
1289         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1290         c = (struct hda_bind_ctls *)kcontrol->private_value;
1291         for (vals = c->values; *vals; vals++) {
1292                 kcontrol->private_value = *vals;
1293                 err = c->ops->put(kcontrol, ucontrol);
1294                 if (err < 0)
1295                         break;
1296                 change |= err;
1297         }
1298         kcontrol->private_value = (long)c;
1299         mutex_unlock(&codec->spdif_mutex);
1300         return err < 0 ? err : change;
1301 }
1302
1303 int snd_hda_mixer_bind_tlv(struct snd_kcontrol *kcontrol, int op_flag,
1304                            unsigned int size, unsigned int __user *tlv)
1305 {
1306         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1307         struct hda_bind_ctls *c;
1308         int err;
1309
1310         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1311         c = (struct hda_bind_ctls *)kcontrol->private_value;
1312         kcontrol->private_value = *c->values;
1313         err = c->ops->tlv(kcontrol, op_flag, size, tlv);
1314         kcontrol->private_value = (long)c;
1315         mutex_unlock(&codec->spdif_mutex);
1316         return err;
1317 }
1318
1319 struct hda_ctl_ops snd_hda_bind_vol = {
1320         .info = snd_hda_mixer_amp_volume_info,
1321         .get = snd_hda_mixer_amp_volume_get,
1322         .put = snd_hda_mixer_amp_volume_put,
1323         .tlv = snd_hda_mixer_amp_tlv
1324 };
1325
1326 struct hda_ctl_ops snd_hda_bind_sw = {
1327         .info = snd_hda_mixer_amp_switch_info,
1328         .get = snd_hda_mixer_amp_switch_get,
1329         .put = snd_hda_mixer_amp_switch_put,
1330         .tlv = snd_hda_mixer_amp_tlv
1331 };
1332
1333 /*
1334  * SPDIF out controls
1335  */
1336
1337 static int snd_hda_spdif_mask_info(struct snd_kcontrol *kcontrol,
1338                                    struct snd_ctl_elem_info *uinfo)
1339 {
1340         uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
1341         uinfo->count = 1;
1342         return 0;
1343 }
1344
1345 static int snd_hda_spdif_cmask_get(struct snd_kcontrol *kcontrol,
1346                                    struct snd_ctl_elem_value *ucontrol)
1347 {
1348         ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
1349                                            IEC958_AES0_NONAUDIO |
1350                                            IEC958_AES0_CON_EMPHASIS_5015 |
1351                                            IEC958_AES0_CON_NOT_COPYRIGHT;
1352         ucontrol->value.iec958.status[1] = IEC958_AES1_CON_CATEGORY |
1353                                            IEC958_AES1_CON_ORIGINAL;
1354         return 0;
1355 }
1356
1357 static int snd_hda_spdif_pmask_get(struct snd_kcontrol *kcontrol,
1358                                    struct snd_ctl_elem_value *ucontrol)
1359 {
1360         ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
1361                                            IEC958_AES0_NONAUDIO |
1362                                            IEC958_AES0_PRO_EMPHASIS_5015;
1363         return 0;
1364 }
1365
1366 static int snd_hda_spdif_default_get(struct snd_kcontrol *kcontrol,
1367                                      struct snd_ctl_elem_value *ucontrol)
1368 {
1369         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1370
1371         ucontrol->value.iec958.status[0] = codec->spdif_status & 0xff;
1372         ucontrol->value.iec958.status[1] = (codec->spdif_status >> 8) & 0xff;
1373         ucontrol->value.iec958.status[2] = (codec->spdif_status >> 16) & 0xff;
1374         ucontrol->value.iec958.status[3] = (codec->spdif_status >> 24) & 0xff;
1375
1376         return 0;
1377 }
1378
1379 /* convert from SPDIF status bits to HDA SPDIF bits
1380  * bit 0 (DigEn) is always set zero (to be filled later)
1381  */
1382 static unsigned short convert_from_spdif_status(unsigned int sbits)
1383 {
1384         unsigned short val = 0;
1385
1386         if (sbits & IEC958_AES0_PROFESSIONAL)
1387                 val |= AC_DIG1_PROFESSIONAL;
1388         if (sbits & IEC958_AES0_NONAUDIO)
1389                 val |= AC_DIG1_NONAUDIO;
1390         if (sbits & IEC958_AES0_PROFESSIONAL) {
1391                 if ((sbits & IEC958_AES0_PRO_EMPHASIS) ==
1392                     IEC958_AES0_PRO_EMPHASIS_5015)
1393                         val |= AC_DIG1_EMPHASIS;
1394         } else {
1395                 if ((sbits & IEC958_AES0_CON_EMPHASIS) ==
1396                     IEC958_AES0_CON_EMPHASIS_5015)
1397                         val |= AC_DIG1_EMPHASIS;
1398                 if (!(sbits & IEC958_AES0_CON_NOT_COPYRIGHT))
1399                         val |= AC_DIG1_COPYRIGHT;
1400                 if (sbits & (IEC958_AES1_CON_ORIGINAL << 8))
1401                         val |= AC_DIG1_LEVEL;
1402                 val |= sbits & (IEC958_AES1_CON_CATEGORY << 8);
1403         }
1404         return val;
1405 }
1406
1407 /* convert to SPDIF status bits from HDA SPDIF bits
1408  */
1409 static unsigned int convert_to_spdif_status(unsigned short val)
1410 {
1411         unsigned int sbits = 0;
1412
1413         if (val & AC_DIG1_NONAUDIO)
1414                 sbits |= IEC958_AES0_NONAUDIO;
1415         if (val & AC_DIG1_PROFESSIONAL)
1416                 sbits |= IEC958_AES0_PROFESSIONAL;
1417         if (sbits & IEC958_AES0_PROFESSIONAL) {
1418                 if (sbits & AC_DIG1_EMPHASIS)
1419                         sbits |= IEC958_AES0_PRO_EMPHASIS_5015;
1420         } else {
1421                 if (val & AC_DIG1_EMPHASIS)
1422                         sbits |= IEC958_AES0_CON_EMPHASIS_5015;
1423                 if (!(val & AC_DIG1_COPYRIGHT))
1424                         sbits |= IEC958_AES0_CON_NOT_COPYRIGHT;
1425                 if (val & AC_DIG1_LEVEL)
1426                         sbits |= (IEC958_AES1_CON_ORIGINAL << 8);
1427                 sbits |= val & (0x7f << 8);
1428         }
1429         return sbits;
1430 }
1431
1432 /* set digital convert verbs both for the given NID and its slaves */
1433 static void set_dig_out(struct hda_codec *codec, hda_nid_t nid,
1434                         int verb, int val)
1435 {
1436         hda_nid_t *d;
1437
1438         snd_hda_codec_write(codec, nid, 0, verb, val);
1439         d = codec->slave_dig_outs;
1440         if (!d)
1441                 return;
1442         for (; *d; d++)
1443                 snd_hda_codec_write(codec, *d, 0, verb, val);
1444 }
1445
1446 static inline void set_dig_out_convert(struct hda_codec *codec, hda_nid_t nid,
1447                                        int dig1, int dig2)
1448 {
1449         if (dig1 != -1)
1450                 set_dig_out(codec, nid, AC_VERB_SET_DIGI_CONVERT_1, dig1);
1451         if (dig2 != -1)
1452                 set_dig_out(codec, nid, AC_VERB_SET_DIGI_CONVERT_2, dig2);
1453 }
1454
1455 static int snd_hda_spdif_default_put(struct snd_kcontrol *kcontrol,
1456                                      struct snd_ctl_elem_value *ucontrol)
1457 {
1458         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1459         hda_nid_t nid = kcontrol->private_value;
1460         unsigned short val;
1461         int change;
1462
1463         mutex_lock(&codec->spdif_mutex);
1464         codec->spdif_status = ucontrol->value.iec958.status[0] |
1465                 ((unsigned int)ucontrol->value.iec958.status[1] << 8) |
1466                 ((unsigned int)ucontrol->value.iec958.status[2] << 16) |
1467                 ((unsigned int)ucontrol->value.iec958.status[3] << 24);
1468         val = convert_from_spdif_status(codec->spdif_status);
1469         val |= codec->spdif_ctls & 1;
1470         change = codec->spdif_ctls != val;
1471         codec->spdif_ctls = val;
1472
1473         if (change)
1474                 set_dig_out_convert(codec, nid, val & 0xff, (val >> 8) & 0xff);
1475
1476         mutex_unlock(&codec->spdif_mutex);
1477         return change;
1478 }
1479
1480 #define snd_hda_spdif_out_switch_info   snd_ctl_boolean_mono_info
1481
1482 static int snd_hda_spdif_out_switch_get(struct snd_kcontrol *kcontrol,
1483                                         struct snd_ctl_elem_value *ucontrol)
1484 {
1485         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1486
1487         ucontrol->value.integer.value[0] = codec->spdif_ctls & AC_DIG1_ENABLE;
1488         return 0;
1489 }
1490
1491 static int snd_hda_spdif_out_switch_put(struct snd_kcontrol *kcontrol,
1492                                         struct snd_ctl_elem_value *ucontrol)
1493 {
1494         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1495         hda_nid_t nid = kcontrol->private_value;
1496         unsigned short val;
1497         int change;
1498
1499         mutex_lock(&codec->spdif_mutex);
1500         val = codec->spdif_ctls & ~AC_DIG1_ENABLE;
1501         if (ucontrol->value.integer.value[0])
1502                 val |= AC_DIG1_ENABLE;
1503         change = codec->spdif_ctls != val;
1504         if (change) {
1505                 codec->spdif_ctls = val;
1506                 set_dig_out_convert(codec, nid, val & 0xff, -1);
1507                 /* unmute amp switch (if any) */
1508                 if ((get_wcaps(codec, nid) & AC_WCAP_OUT_AMP) &&
1509                     (val & AC_DIG1_ENABLE))
1510                         snd_hda_codec_amp_stereo(codec, nid, HDA_OUTPUT, 0,
1511                                                  HDA_AMP_MUTE, 0);
1512         }
1513         mutex_unlock(&codec->spdif_mutex);
1514         return change;
1515 }
1516
1517 static struct snd_kcontrol_new dig_mixes[] = {
1518         {
1519                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
1520                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1521                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,CON_MASK),
1522                 .info = snd_hda_spdif_mask_info,
1523                 .get = snd_hda_spdif_cmask_get,
1524         },
1525         {
1526                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
1527                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1528                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,PRO_MASK),
1529                 .info = snd_hda_spdif_mask_info,
1530                 .get = snd_hda_spdif_pmask_get,
1531         },
1532         {
1533                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1534                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,DEFAULT),
1535                 .info = snd_hda_spdif_mask_info,
1536                 .get = snd_hda_spdif_default_get,
1537                 .put = snd_hda_spdif_default_put,
1538         },
1539         {
1540                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1541                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,SWITCH),
1542                 .info = snd_hda_spdif_out_switch_info,
1543                 .get = snd_hda_spdif_out_switch_get,
1544                 .put = snd_hda_spdif_out_switch_put,
1545         },
1546         { } /* end */
1547 };
1548
1549 #define SPDIF_MAX_IDX   4       /* 4 instances should be enough to probe */
1550
1551 /**
1552  * snd_hda_create_spdif_out_ctls - create Output SPDIF-related controls
1553  * @codec: the HDA codec
1554  * @nid: audio out widget NID
1555  *
1556  * Creates controls related with the SPDIF output.
1557  * Called from each patch supporting the SPDIF out.
1558  *
1559  * Returns 0 if successful, or a negative error code.
1560  */
1561 int snd_hda_create_spdif_out_ctls(struct hda_codec *codec, hda_nid_t nid)
1562 {
1563         int err;
1564         struct snd_kcontrol *kctl;
1565         struct snd_kcontrol_new *dig_mix;
1566         int idx;
1567
1568         for (idx = 0; idx < SPDIF_MAX_IDX; idx++) {
1569                 if (!_snd_hda_find_mixer_ctl(codec, "IEC958 Playback Switch",
1570                                              idx))
1571                         break;
1572         }
1573         if (idx >= SPDIF_MAX_IDX) {
1574                 printk(KERN_ERR "hda_codec: too many IEC958 outputs\n");
1575                 return -EBUSY;
1576         }
1577         for (dig_mix = dig_mixes; dig_mix->name; dig_mix++) {
1578                 kctl = snd_ctl_new1(dig_mix, codec);
1579                 kctl->id.index = idx;
1580                 kctl->private_value = nid;
1581                 err = snd_ctl_add(codec->bus->card, kctl);
1582                 if (err < 0)
1583                         return err;
1584         }
1585         codec->spdif_ctls =
1586                 snd_hda_codec_read(codec, nid, 0,
1587                                    AC_VERB_GET_DIGI_CONVERT_1, 0);
1588         codec->spdif_status = convert_to_spdif_status(codec->spdif_ctls);
1589         return 0;
1590 }
1591
1592 /*
1593  * SPDIF sharing with analog output
1594  */
1595 static int spdif_share_sw_get(struct snd_kcontrol *kcontrol,
1596                               struct snd_ctl_elem_value *ucontrol)
1597 {
1598         struct hda_multi_out *mout = snd_kcontrol_chip(kcontrol);
1599         ucontrol->value.integer.value[0] = mout->share_spdif;
1600         return 0;
1601 }
1602
1603 static int spdif_share_sw_put(struct snd_kcontrol *kcontrol,
1604                               struct snd_ctl_elem_value *ucontrol)
1605 {
1606         struct hda_multi_out *mout = snd_kcontrol_chip(kcontrol);
1607         mout->share_spdif = !!ucontrol->value.integer.value[0];
1608         return 0;
1609 }
1610
1611 static struct snd_kcontrol_new spdif_share_sw = {
1612         .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1613         .name = "IEC958 Default PCM Playback Switch",
1614         .info = snd_ctl_boolean_mono_info,
1615         .get = spdif_share_sw_get,
1616         .put = spdif_share_sw_put,
1617 };
1618
1619 int snd_hda_create_spdif_share_sw(struct hda_codec *codec,
1620                                   struct hda_multi_out *mout)
1621 {
1622         if (!mout->dig_out_nid)
1623                 return 0;
1624         /* ATTENTION: here mout is passed as private_data, instead of codec */
1625         return snd_ctl_add(codec->bus->card,
1626                            snd_ctl_new1(&spdif_share_sw, mout));
1627 }
1628
1629 /*
1630  * SPDIF input
1631  */
1632
1633 #define snd_hda_spdif_in_switch_info    snd_hda_spdif_out_switch_info
1634
1635 static int snd_hda_spdif_in_switch_get(struct snd_kcontrol *kcontrol,
1636                                        struct snd_ctl_elem_value *ucontrol)
1637 {
1638         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1639
1640         ucontrol->value.integer.value[0] = codec->spdif_in_enable;
1641         return 0;
1642 }
1643
1644 static int snd_hda_spdif_in_switch_put(struct snd_kcontrol *kcontrol,
1645                                        struct snd_ctl_elem_value *ucontrol)
1646 {
1647         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1648         hda_nid_t nid = kcontrol->private_value;
1649         unsigned int val = !!ucontrol->value.integer.value[0];
1650         int change;
1651
1652         mutex_lock(&codec->spdif_mutex);
1653         change = codec->spdif_in_enable != val;
1654         if (change) {
1655                 codec->spdif_in_enable = val;
1656                 snd_hda_codec_write_cache(codec, nid, 0,
1657                                           AC_VERB_SET_DIGI_CONVERT_1, val);
1658         }
1659         mutex_unlock(&codec->spdif_mutex);
1660         return change;
1661 }
1662
1663 static int snd_hda_spdif_in_status_get(struct snd_kcontrol *kcontrol,
1664                                        struct snd_ctl_elem_value *ucontrol)
1665 {
1666         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1667         hda_nid_t nid = kcontrol->private_value;
1668         unsigned short val;
1669         unsigned int sbits;
1670
1671         val = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT_1, 0);
1672         sbits = convert_to_spdif_status(val);
1673         ucontrol->value.iec958.status[0] = sbits;
1674         ucontrol->value.iec958.status[1] = sbits >> 8;
1675         ucontrol->value.iec958.status[2] = sbits >> 16;
1676         ucontrol->value.iec958.status[3] = sbits >> 24;
1677         return 0;
1678 }
1679
1680 static struct snd_kcontrol_new dig_in_ctls[] = {
1681         {
1682                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1683                 .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,SWITCH),
1684                 .info = snd_hda_spdif_in_switch_info,
1685                 .get = snd_hda_spdif_in_switch_get,
1686                 .put = snd_hda_spdif_in_switch_put,
1687         },
1688         {
1689                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
1690                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1691                 .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,DEFAULT),
1692                 .info = snd_hda_spdif_mask_info,
1693                 .get = snd_hda_spdif_in_status_get,
1694         },
1695         { } /* end */
1696 };
1697
1698 /**
1699  * snd_hda_create_spdif_in_ctls - create Input SPDIF-related controls
1700  * @codec: the HDA codec
1701  * @nid: audio in widget NID
1702  *
1703  * Creates controls related with the SPDIF input.
1704  * Called from each patch supporting the SPDIF in.
1705  *
1706  * Returns 0 if successful, or a negative error code.
1707  */
1708 int snd_hda_create_spdif_in_ctls(struct hda_codec *codec, hda_nid_t nid)
1709 {
1710         int err;
1711         struct snd_kcontrol *kctl;
1712         struct snd_kcontrol_new *dig_mix;
1713         int idx;
1714
1715         for (idx = 0; idx < SPDIF_MAX_IDX; idx++) {
1716                 if (!_snd_hda_find_mixer_ctl(codec, "IEC958 Capture Switch",
1717                                              idx))
1718                         break;
1719         }
1720         if (idx >= SPDIF_MAX_IDX) {
1721                 printk(KERN_ERR "hda_codec: too many IEC958 inputs\n");
1722                 return -EBUSY;
1723         }
1724         for (dig_mix = dig_in_ctls; dig_mix->name; dig_mix++) {
1725                 kctl = snd_ctl_new1(dig_mix, codec);
1726                 kctl->private_value = nid;
1727                 err = snd_ctl_add(codec->bus->card, kctl);
1728                 if (err < 0)
1729                         return err;
1730         }
1731         codec->spdif_in_enable =
1732                 snd_hda_codec_read(codec, nid, 0,
1733                                    AC_VERB_GET_DIGI_CONVERT_1, 0) &
1734                 AC_DIG1_ENABLE;
1735         return 0;
1736 }
1737
1738 #ifdef SND_HDA_NEEDS_RESUME
1739 /*
1740  * command cache
1741  */
1742
1743 /* build a 32bit cache key with the widget id and the command parameter */
1744 #define build_cmd_cache_key(nid, verb)  ((verb << 8) | nid)
1745 #define get_cmd_cache_nid(key)          ((key) & 0xff)
1746 #define get_cmd_cache_cmd(key)          (((key) >> 8) & 0xffff)
1747
1748 /**
1749  * snd_hda_codec_write_cache - send a single command with caching
1750  * @codec: the HDA codec
1751  * @nid: NID to send the command
1752  * @direct: direct flag
1753  * @verb: the verb to send
1754  * @parm: the parameter for the verb
1755  *
1756  * Send a single command without waiting for response.
1757  *
1758  * Returns 0 if successful, or a negative error code.
1759  */
1760 int snd_hda_codec_write_cache(struct hda_codec *codec, hda_nid_t nid,
1761                               int direct, unsigned int verb, unsigned int parm)
1762 {
1763         int err;
1764         snd_hda_power_up(codec);
1765         mutex_lock(&codec->bus->cmd_mutex);
1766         err = codec->bus->ops.command(codec, nid, direct, verb, parm);
1767         if (!err) {
1768                 struct hda_cache_head *c;
1769                 u32 key = build_cmd_cache_key(nid, verb);
1770                 c = get_alloc_hash(&codec->cmd_cache, key);
1771                 if (c)
1772                         c->val = parm;
1773         }
1774         mutex_unlock(&codec->bus->cmd_mutex);
1775         snd_hda_power_down(codec);
1776         return err;
1777 }
1778
1779 /* resume the all commands from the cache */
1780 void snd_hda_codec_resume_cache(struct hda_codec *codec)
1781 {
1782         struct hda_cache_head *buffer = codec->cmd_cache.buffer;
1783         int i;
1784
1785         for (i = 0; i < codec->cmd_cache.size; i++, buffer++) {
1786                 u32 key = buffer->key;
1787                 if (!key)
1788                         continue;
1789                 snd_hda_codec_write(codec, get_cmd_cache_nid(key), 0,
1790                                     get_cmd_cache_cmd(key), buffer->val);
1791         }
1792 }
1793
1794 /**
1795  * snd_hda_sequence_write_cache - sequence writes with caching
1796  * @codec: the HDA codec
1797  * @seq: VERB array to send
1798  *
1799  * Send the commands sequentially from the given array.
1800  * Thte commands are recorded on cache for power-save and resume.
1801  * The array must be terminated with NID=0.
1802  */
1803 void snd_hda_sequence_write_cache(struct hda_codec *codec,
1804                                   const struct hda_verb *seq)
1805 {
1806         for (; seq->nid; seq++)
1807                 snd_hda_codec_write_cache(codec, seq->nid, 0, seq->verb,
1808                                           seq->param);
1809 }
1810 #endif /* SND_HDA_NEEDS_RESUME */
1811
1812 /*
1813  * set power state of the codec
1814  */
1815 static void hda_set_power_state(struct hda_codec *codec, hda_nid_t fg,
1816                                 unsigned int power_state)
1817 {
1818         hda_nid_t nid;
1819         int i;
1820
1821         snd_hda_codec_write(codec, fg, 0, AC_VERB_SET_POWER_STATE,
1822                             power_state);
1823         msleep(10); /* partial workaround for "azx_get_response timeout" */
1824
1825         nid = codec->start_nid;
1826         for (i = 0; i < codec->num_nodes; i++, nid++) {
1827                 unsigned int wcaps = get_wcaps(codec, nid);
1828                 if (wcaps & AC_WCAP_POWER) {
1829                         unsigned int wid_type = (wcaps & AC_WCAP_TYPE) >>
1830                                 AC_WCAP_TYPE_SHIFT;
1831                         if (wid_type == AC_WID_PIN) {
1832                                 unsigned int pincap;
1833                                 /*
1834                                  * don't power down the widget if it controls
1835                                  * eapd and EAPD_BTLENABLE is set.
1836                                  */
1837                                 pincap = snd_hda_param_read(codec, nid,
1838                                                             AC_PAR_PIN_CAP);
1839                                 if (pincap & AC_PINCAP_EAPD) {
1840                                         int eapd = snd_hda_codec_read(codec,
1841                                                 nid, 0,
1842                                                 AC_VERB_GET_EAPD_BTLENABLE, 0);
1843                                         eapd &= 0x02;
1844                                         if (power_state == AC_PWRST_D3 && eapd)
1845                                                 continue;
1846                                 }
1847                         }
1848                         snd_hda_codec_write(codec, nid, 0,
1849                                             AC_VERB_SET_POWER_STATE,
1850                                             power_state);
1851                 }
1852         }
1853
1854         if (power_state == AC_PWRST_D0) {
1855                 unsigned long end_time;
1856                 int state;
1857                 msleep(10);
1858                 /* wait until the codec reachs to D0 */
1859                 end_time = jiffies + msecs_to_jiffies(500);
1860                 do {
1861                         state = snd_hda_codec_read(codec, fg, 0,
1862                                                    AC_VERB_GET_POWER_STATE, 0);
1863                         if (state == power_state)
1864                                 break;
1865                         msleep(1);
1866                 } while (time_after_eq(end_time, jiffies));
1867         }
1868 }
1869
1870 #ifdef SND_HDA_NEEDS_RESUME
1871 /*
1872  * call suspend and power-down; used both from PM and power-save
1873  */
1874 static void hda_call_codec_suspend(struct hda_codec *codec)
1875 {
1876         if (codec->patch_ops.suspend)
1877                 codec->patch_ops.suspend(codec, PMSG_SUSPEND);
1878         hda_set_power_state(codec,
1879                             codec->afg ? codec->afg : codec->mfg,
1880                             AC_PWRST_D3);
1881 #ifdef CONFIG_SND_HDA_POWER_SAVE
1882         cancel_delayed_work(&codec->power_work);
1883         codec->power_on = 0;
1884         codec->power_transition = 0;
1885 #endif
1886 }
1887
1888 /*
1889  * kick up codec; used both from PM and power-save
1890  */
1891 static void hda_call_codec_resume(struct hda_codec *codec)
1892 {
1893         hda_set_power_state(codec,
1894                             codec->afg ? codec->afg : codec->mfg,
1895                             AC_PWRST_D0);
1896         if (codec->patch_ops.resume)
1897                 codec->patch_ops.resume(codec);
1898         else {
1899                 if (codec->patch_ops.init)
1900                         codec->patch_ops.init(codec);
1901                 snd_hda_codec_resume_amp(codec);
1902                 snd_hda_codec_resume_cache(codec);
1903         }
1904 }
1905 #endif /* SND_HDA_NEEDS_RESUME */
1906
1907
1908 /**
1909  * snd_hda_build_controls - build mixer controls
1910  * @bus: the BUS
1911  *
1912  * Creates mixer controls for each codec included in the bus.
1913  *
1914  * Returns 0 if successful, otherwise a negative error code.
1915  */
1916 int __devinit snd_hda_build_controls(struct hda_bus *bus)
1917 {
1918         struct hda_codec *codec;
1919
1920         list_for_each_entry(codec, &bus->codec_list, list) {
1921                 int err = 0;
1922                 /* fake as if already powered-on */
1923                 hda_keep_power_on(codec);
1924                 /* then fire up */
1925                 hda_set_power_state(codec,
1926                                     codec->afg ? codec->afg : codec->mfg,
1927                                     AC_PWRST_D0);
1928                 /* continue to initialize... */
1929                 if (codec->patch_ops.init)
1930                         err = codec->patch_ops.init(codec);
1931                 if (!err && codec->patch_ops.build_controls)
1932                         err = codec->patch_ops.build_controls(codec);
1933                 snd_hda_power_down(codec);
1934                 if (err < 0)
1935                         return err;
1936         }
1937
1938         return 0;
1939 }
1940
1941 /*
1942  * stream formats
1943  */
1944 struct hda_rate_tbl {
1945         unsigned int hz;
1946         unsigned int alsa_bits;
1947         unsigned int hda_fmt;
1948 };
1949
1950 static struct hda_rate_tbl rate_bits[] = {
1951         /* rate in Hz, ALSA rate bitmask, HDA format value */
1952
1953         /* autodetected value used in snd_hda_query_supported_pcm */
1954         { 8000, SNDRV_PCM_RATE_8000, 0x0500 }, /* 1/6 x 48 */
1955         { 11025, SNDRV_PCM_RATE_11025, 0x4300 }, /* 1/4 x 44 */
1956         { 16000, SNDRV_PCM_RATE_16000, 0x0200 }, /* 1/3 x 48 */
1957         { 22050, SNDRV_PCM_RATE_22050, 0x4100 }, /* 1/2 x 44 */
1958         { 32000, SNDRV_PCM_RATE_32000, 0x0a00 }, /* 2/3 x 48 */
1959         { 44100, SNDRV_PCM_RATE_44100, 0x4000 }, /* 44 */
1960         { 48000, SNDRV_PCM_RATE_48000, 0x0000 }, /* 48 */
1961         { 88200, SNDRV_PCM_RATE_88200, 0x4800 }, /* 2 x 44 */
1962         { 96000, SNDRV_PCM_RATE_96000, 0x0800 }, /* 2 x 48 */
1963         { 176400, SNDRV_PCM_RATE_176400, 0x5800 },/* 4 x 44 */
1964         { 192000, SNDRV_PCM_RATE_192000, 0x1800 }, /* 4 x 48 */
1965 #define AC_PAR_PCM_RATE_BITS    11
1966         /* up to bits 10, 384kHZ isn't supported properly */
1967
1968         /* not autodetected value */
1969         { 9600, SNDRV_PCM_RATE_KNOT, 0x0400 }, /* 1/5 x 48 */
1970
1971         { 0 } /* terminator */
1972 };
1973
1974 /**
1975  * snd_hda_calc_stream_format - calculate format bitset
1976  * @rate: the sample rate
1977  * @channels: the number of channels
1978  * @format: the PCM format (SNDRV_PCM_FORMAT_XXX)
1979  * @maxbps: the max. bps
1980  *
1981  * Calculate the format bitset from the given rate, channels and th PCM format.
1982  *
1983  * Return zero if invalid.
1984  */
1985 unsigned int snd_hda_calc_stream_format(unsigned int rate,
1986                                         unsigned int channels,
1987                                         unsigned int format,
1988                                         unsigned int maxbps)
1989 {
1990         int i;
1991         unsigned int val = 0;
1992
1993         for (i = 0; rate_bits[i].hz; i++)
1994                 if (rate_bits[i].hz == rate) {
1995                         val = rate_bits[i].hda_fmt;
1996                         break;
1997                 }
1998         if (!rate_bits[i].hz) {
1999                 snd_printdd("invalid rate %d\n", rate);
2000                 return 0;
2001         }
2002
2003         if (channels == 0 || channels > 8) {
2004                 snd_printdd("invalid channels %d\n", channels);
2005                 return 0;
2006         }
2007         val |= channels - 1;
2008
2009         switch (snd_pcm_format_width(format)) {
2010         case 8:  val |= 0x00; break;
2011         case 16: val |= 0x10; break;
2012         case 20:
2013         case 24:
2014         case 32:
2015                 if (maxbps >= 32)
2016                         val |= 0x40;
2017                 else if (maxbps >= 24)
2018                         val |= 0x30;
2019                 else
2020                         val |= 0x20;
2021                 break;
2022         default:
2023                 snd_printdd("invalid format width %d\n",
2024                             snd_pcm_format_width(format));
2025                 return 0;
2026         }
2027
2028         return val;
2029 }
2030
2031 /**
2032  * snd_hda_query_supported_pcm - query the supported PCM rates and formats
2033  * @codec: the HDA codec
2034  * @nid: NID to query
2035  * @ratesp: the pointer to store the detected rate bitflags
2036  * @formatsp: the pointer to store the detected formats
2037  * @bpsp: the pointer to store the detected format widths
2038  *
2039  * Queries the supported PCM rates and formats.  The NULL @ratesp, @formatsp
2040  * or @bsps argument is ignored.
2041  *
2042  * Returns 0 if successful, otherwise a negative error code.
2043  */
2044 int snd_hda_query_supported_pcm(struct hda_codec *codec, hda_nid_t nid,
2045                                 u32 *ratesp, u64 *formatsp, unsigned int *bpsp)
2046 {
2047         int i;
2048         unsigned int val, streams;
2049
2050         val = 0;
2051         if (nid != codec->afg &&
2052             (get_wcaps(codec, nid) & AC_WCAP_FORMAT_OVRD)) {
2053                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
2054                 if (val == -1)
2055                         return -EIO;
2056         }
2057         if (!val)
2058                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
2059
2060         if (ratesp) {
2061                 u32 rates = 0;
2062                 for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++) {
2063                         if (val & (1 << i))
2064                                 rates |= rate_bits[i].alsa_bits;
2065                 }
2066                 *ratesp = rates;
2067         }
2068
2069         if (formatsp || bpsp) {
2070                 u64 formats = 0;
2071                 unsigned int bps;
2072                 unsigned int wcaps;
2073
2074                 wcaps = get_wcaps(codec, nid);
2075                 streams = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
2076                 if (streams == -1)
2077                         return -EIO;
2078                 if (!streams) {
2079                         streams = snd_hda_param_read(codec, codec->afg,
2080                                                      AC_PAR_STREAM);
2081                         if (streams == -1)
2082                                 return -EIO;
2083                 }
2084
2085                 bps = 0;
2086                 if (streams & AC_SUPFMT_PCM) {
2087                         if (val & AC_SUPPCM_BITS_8) {
2088                                 formats |= SNDRV_PCM_FMTBIT_U8;
2089                                 bps = 8;
2090                         }
2091                         if (val & AC_SUPPCM_BITS_16) {
2092                                 formats |= SNDRV_PCM_FMTBIT_S16_LE;
2093                                 bps = 16;
2094                         }
2095                         if (wcaps & AC_WCAP_DIGITAL) {
2096                                 if (val & AC_SUPPCM_BITS_32)
2097                                         formats |= SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE;
2098                                 if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24))
2099                                         formats |= SNDRV_PCM_FMTBIT_S32_LE;
2100                                 if (val & AC_SUPPCM_BITS_24)
2101                                         bps = 24;
2102                                 else if (val & AC_SUPPCM_BITS_20)
2103                                         bps = 20;
2104                         } else if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24|
2105                                           AC_SUPPCM_BITS_32)) {
2106                                 formats |= SNDRV_PCM_FMTBIT_S32_LE;
2107                                 if (val & AC_SUPPCM_BITS_32)
2108                                         bps = 32;
2109                                 else if (val & AC_SUPPCM_BITS_24)
2110                                         bps = 24;
2111                                 else if (val & AC_SUPPCM_BITS_20)
2112                                         bps = 20;
2113                         }
2114                 }
2115                 else if (streams == AC_SUPFMT_FLOAT32) {
2116                         /* should be exclusive */
2117                         formats |= SNDRV_PCM_FMTBIT_FLOAT_LE;
2118                         bps = 32;
2119                 } else if (streams == AC_SUPFMT_AC3) {
2120                         /* should be exclusive */
2121                         /* temporary hack: we have still no proper support
2122                          * for the direct AC3 stream...
2123                          */
2124                         formats |= SNDRV_PCM_FMTBIT_U8;
2125                         bps = 8;
2126                 }
2127                 if (formatsp)
2128                         *formatsp = formats;
2129                 if (bpsp)
2130                         *bpsp = bps;
2131         }
2132
2133         return 0;
2134 }
2135
2136 /**
2137  * snd_hda_is_supported_format - check whether the given node supports
2138  * the format val
2139  *
2140  * Returns 1 if supported, 0 if not.
2141  */
2142 int snd_hda_is_supported_format(struct hda_codec *codec, hda_nid_t nid,
2143                                 unsigned int format)
2144 {
2145         int i;
2146         unsigned int val = 0, rate, stream;
2147
2148         if (nid != codec->afg &&
2149             (get_wcaps(codec, nid) & AC_WCAP_FORMAT_OVRD)) {
2150                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
2151                 if (val == -1)
2152                         return 0;
2153         }
2154         if (!val) {
2155                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
2156                 if (val == -1)
2157                         return 0;
2158         }
2159
2160         rate = format & 0xff00;
2161         for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++)
2162                 if (rate_bits[i].hda_fmt == rate) {
2163                         if (val & (1 << i))
2164                                 break;
2165                         return 0;
2166                 }
2167         if (i >= AC_PAR_PCM_RATE_BITS)
2168                 return 0;
2169
2170         stream = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
2171         if (stream == -1)
2172                 return 0;
2173         if (!stream && nid != codec->afg)
2174                 stream = snd_hda_param_read(codec, codec->afg, AC_PAR_STREAM);
2175         if (!stream || stream == -1)
2176                 return 0;
2177
2178         if (stream & AC_SUPFMT_PCM) {
2179                 switch (format & 0xf0) {
2180                 case 0x00:
2181                         if (!(val & AC_SUPPCM_BITS_8))
2182                                 return 0;
2183                         break;
2184                 case 0x10:
2185                         if (!(val & AC_SUPPCM_BITS_16))
2186                                 return 0;
2187                         break;
2188                 case 0x20:
2189                         if (!(val & AC_SUPPCM_BITS_20))
2190                                 return 0;
2191                         break;
2192                 case 0x30:
2193                         if (!(val & AC_SUPPCM_BITS_24))
2194                                 return 0;
2195                         break;
2196                 case 0x40:
2197                         if (!(val & AC_SUPPCM_BITS_32))
2198                                 return 0;
2199                         break;
2200                 default:
2201                         return 0;
2202                 }
2203         } else {
2204                 /* FIXME: check for float32 and AC3? */
2205         }
2206
2207         return 1;
2208 }
2209
2210 /*
2211  * PCM stuff
2212  */
2213 static int hda_pcm_default_open_close(struct hda_pcm_stream *hinfo,
2214                                       struct hda_codec *codec,
2215                                       struct snd_pcm_substream *substream)
2216 {
2217         return 0;
2218 }
2219
2220 static int hda_pcm_default_prepare(struct hda_pcm_stream *hinfo,
2221                                    struct hda_codec *codec,
2222                                    unsigned int stream_tag,
2223                                    unsigned int format,
2224                                    struct snd_pcm_substream *substream)
2225 {
2226         snd_hda_codec_setup_stream(codec, hinfo->nid, stream_tag, 0, format);
2227         return 0;
2228 }
2229
2230 static int hda_pcm_default_cleanup(struct hda_pcm_stream *hinfo,
2231                                    struct hda_codec *codec,
2232                                    struct snd_pcm_substream *substream)
2233 {
2234         snd_hda_codec_cleanup_stream(codec, hinfo->nid);
2235         return 0;
2236 }
2237
2238 static int __devinit set_pcm_default_values(struct hda_codec *codec,
2239                                             struct hda_pcm_stream *info)
2240 {
2241         /* query support PCM information from the given NID */
2242         if (info->nid && (!info->rates || !info->formats)) {
2243                 snd_hda_query_supported_pcm(codec, info->nid,
2244                                 info->rates ? NULL : &info->rates,
2245                                 info->formats ? NULL : &info->formats,
2246                                 info->maxbps ? NULL : &info->maxbps);
2247         }
2248         if (info->ops.open == NULL)
2249                 info->ops.open = hda_pcm_default_open_close;
2250         if (info->ops.close == NULL)
2251                 info->ops.close = hda_pcm_default_open_close;
2252         if (info->ops.prepare == NULL) {
2253                 if (snd_BUG_ON(!info->nid))
2254                         return -EINVAL;
2255                 info->ops.prepare = hda_pcm_default_prepare;
2256         }
2257         if (info->ops.cleanup == NULL) {
2258                 if (snd_BUG_ON(!info->nid))
2259                         return -EINVAL;
2260                 info->ops.cleanup = hda_pcm_default_cleanup;
2261         }
2262         return 0;
2263 }
2264
2265 /*
2266  * attach a new PCM stream
2267  */
2268 static int __devinit
2269 snd_hda_attach_pcm(struct hda_codec *codec, struct hda_pcm *pcm)
2270 {
2271         struct hda_pcm_stream *info;
2272         int stream, err;
2273
2274         if (!pcm->name)
2275                 return -EINVAL;
2276         for (stream = 0; stream < 2; stream++) {
2277                 info = &pcm->stream[stream];
2278                 if (info->substreams) {
2279                         err = set_pcm_default_values(codec, info);
2280                         if (err < 0)
2281                                 return err;
2282                 }
2283         }
2284         return codec->bus->ops.attach_pcm(codec, pcm);
2285 }
2286
2287 /**
2288  * snd_hda_build_pcms - build PCM information
2289  * @bus: the BUS
2290  *
2291  * Create PCM information for each codec included in the bus.
2292  *
2293  * The build_pcms codec patch is requested to set up codec->num_pcms and
2294  * codec->pcm_info properly.  The array is referred by the top-level driver
2295  * to create its PCM instances.
2296  * The allocated codec->pcm_info should be released in codec->patch_ops.free
2297  * callback.
2298  *
2299  * At least, substreams, channels_min and channels_max must be filled for
2300  * each stream.  substreams = 0 indicates that the stream doesn't exist.
2301  * When rates and/or formats are zero, the supported values are queried
2302  * from the given nid.  The nid is used also by the default ops.prepare
2303  * and ops.cleanup callbacks.
2304  *
2305  * The driver needs to call ops.open in its open callback.  Similarly,
2306  * ops.close is supposed to be called in the close callback.
2307  * ops.prepare should be called in the prepare or hw_params callback
2308  * with the proper parameters for set up.
2309  * ops.cleanup should be called in hw_free for clean up of streams.
2310  *
2311  * This function returns 0 if successfull, or a negative error code.
2312  */
2313 int __devinit snd_hda_build_pcms(struct hda_bus *bus)
2314 {
2315         static const char *dev_name[HDA_PCM_NTYPES] = {
2316                 "Audio", "SPDIF", "HDMI", "Modem"
2317         };
2318         /* starting device index for each PCM type */
2319         static int dev_idx[HDA_PCM_NTYPES] = {
2320                 [HDA_PCM_TYPE_AUDIO] = 0,
2321                 [HDA_PCM_TYPE_SPDIF] = 1,
2322                 [HDA_PCM_TYPE_HDMI] = 3,
2323                 [HDA_PCM_TYPE_MODEM] = 6
2324         };
2325         /* normal audio device indices; not linear to keep compatibility */
2326         static int audio_idx[4] = { 0, 2, 4, 5 };
2327         struct hda_codec *codec;
2328         int num_devs[HDA_PCM_NTYPES];
2329
2330         memset(num_devs, 0, sizeof(num_devs));
2331         list_for_each_entry(codec, &bus->codec_list, list) {
2332                 unsigned int pcm;
2333                 int err;
2334                 if (!codec->patch_ops.build_pcms)
2335                         continue;
2336                 err = codec->patch_ops.build_pcms(codec);
2337                 if (err < 0)
2338                         return err;
2339                 for (pcm = 0; pcm < codec->num_pcms; pcm++) {
2340                         struct hda_pcm *cpcm = &codec->pcm_info[pcm];
2341                         int type = cpcm->pcm_type;
2342                         switch (type) {
2343                         case HDA_PCM_TYPE_AUDIO:
2344                                 if (num_devs[type] >= ARRAY_SIZE(audio_idx)) {
2345                                         snd_printk(KERN_WARNING
2346                                                    "Too many audio devices\n");
2347                                         continue;
2348                                 }
2349                                 cpcm->device = audio_idx[num_devs[type]];
2350                                 break;
2351                         case HDA_PCM_TYPE_SPDIF:
2352                         case HDA_PCM_TYPE_HDMI:
2353                         case HDA_PCM_TYPE_MODEM:
2354                                 if (num_devs[type]) {
2355                                         snd_printk(KERN_WARNING
2356                                                    "%s already defined\n",
2357                                                    dev_name[type]);
2358                                         continue;
2359                                 }
2360                                 cpcm->device = dev_idx[type];
2361                                 break;
2362                         default:
2363                                 snd_printk(KERN_WARNING
2364                                            "Invalid PCM type %d\n", type);
2365                                 continue;
2366                         }
2367                         num_devs[type]++;
2368                         err = snd_hda_attach_pcm(codec, cpcm);
2369                         if (err < 0)
2370                                 return err;
2371                 }
2372         }
2373         return 0;
2374 }
2375
2376 /**
2377  * snd_hda_check_board_config - compare the current codec with the config table
2378  * @codec: the HDA codec
2379  * @num_configs: number of config enums
2380  * @models: array of model name strings
2381  * @tbl: configuration table, terminated by null entries
2382  *
2383  * Compares the modelname or PCI subsystem id of the current codec with the
2384  * given configuration table.  If a matching entry is found, returns its
2385  * config value (supposed to be 0 or positive).
2386  *
2387  * If no entries are matching, the function returns a negative value.
2388  */
2389 int snd_hda_check_board_config(struct hda_codec *codec,
2390                                int num_configs, const char **models,
2391                                const struct snd_pci_quirk *tbl)
2392 {
2393         if (codec->bus->modelname && models) {
2394                 int i;
2395                 for (i = 0; i < num_configs; i++) {
2396                         if (models[i] &&
2397                             !strcmp(codec->bus->modelname, models[i])) {
2398                                 snd_printd(KERN_INFO "hda_codec: model '%s' is "
2399                                            "selected\n", models[i]);
2400                                 return i;
2401                         }
2402                 }
2403         }
2404
2405         if (!codec->bus->pci || !tbl)
2406                 return -1;
2407
2408         tbl = snd_pci_quirk_lookup(codec->bus->pci, tbl);
2409         if (!tbl)
2410                 return -1;
2411         if (tbl->value >= 0 && tbl->value < num_configs) {
2412 #ifdef CONFIG_SND_DEBUG_VERBOSE
2413                 char tmp[10];
2414                 const char *model = NULL;
2415                 if (models)
2416                         model = models[tbl->value];
2417                 if (!model) {
2418                         sprintf(tmp, "#%d", tbl->value);
2419                         model = tmp;
2420                 }
2421                 snd_printdd(KERN_INFO "hda_codec: model '%s' is selected "
2422                             "for config %x:%x (%s)\n",
2423                             model, tbl->subvendor, tbl->subdevice,
2424                             (tbl->name ? tbl->name : "Unknown device"));
2425 #endif
2426                 return tbl->value;
2427         }
2428         return -1;
2429 }
2430
2431 /**
2432  * snd_hda_add_new_ctls - create controls from the array
2433  * @codec: the HDA codec
2434  * @knew: the array of struct snd_kcontrol_new
2435  *
2436  * This helper function creates and add new controls in the given array.
2437  * The array must be terminated with an empty entry as terminator.
2438  *
2439  * Returns 0 if successful, or a negative error code.
2440  */
2441 int snd_hda_add_new_ctls(struct hda_codec *codec, struct snd_kcontrol_new *knew)
2442 {
2443         int err;
2444
2445         for (; knew->name; knew++) {
2446                 struct snd_kcontrol *kctl;
2447                 kctl = snd_ctl_new1(knew, codec);
2448                 if (!kctl)
2449                         return -ENOMEM;
2450                 err = snd_ctl_add(codec->bus->card, kctl);
2451                 if (err < 0) {
2452                         if (!codec->addr)
2453                                 return err;
2454                         kctl = snd_ctl_new1(knew, codec);
2455                         if (!kctl)
2456                                 return -ENOMEM;
2457                         kctl->id.device = codec->addr;
2458                         err = snd_ctl_add(codec->bus->card, kctl);
2459                         if (err < 0)
2460                                 return err;
2461                 }
2462         }
2463         return 0;
2464 }
2465
2466 #ifdef CONFIG_SND_HDA_POWER_SAVE
2467 static void hda_set_power_state(struct hda_codec *codec, hda_nid_t fg,
2468                                 unsigned int power_state);
2469
2470 static void hda_power_work(struct work_struct *work)
2471 {
2472         struct hda_codec *codec =
2473                 container_of(work, struct hda_codec, power_work.work);
2474
2475         if (!codec->power_on || codec->power_count) {
2476                 codec->power_transition = 0;
2477                 return;
2478         }
2479
2480         hda_call_codec_suspend(codec);
2481         if (codec->bus->ops.pm_notify)
2482                 codec->bus->ops.pm_notify(codec);
2483 }
2484
2485 static void hda_keep_power_on(struct hda_codec *codec)
2486 {
2487         codec->power_count++;
2488         codec->power_on = 1;
2489 }
2490
2491 void snd_hda_power_up(struct hda_codec *codec)
2492 {
2493         codec->power_count++;
2494         if (codec->power_on || codec->power_transition)
2495                 return;
2496
2497         codec->power_on = 1;
2498         if (codec->bus->ops.pm_notify)
2499                 codec->bus->ops.pm_notify(codec);
2500         hda_call_codec_resume(codec);
2501         cancel_delayed_work(&codec->power_work);
2502         codec->power_transition = 0;
2503 }
2504
2505 void snd_hda_power_down(struct hda_codec *codec)
2506 {
2507         --codec->power_count;
2508         if (!codec->power_on || codec->power_count || codec->power_transition)
2509                 return;
2510         if (power_save) {
2511                 codec->power_transition = 1; /* avoid reentrance */
2512                 schedule_delayed_work(&codec->power_work,
2513                                       msecs_to_jiffies(power_save * 1000));
2514         }
2515 }
2516
2517 int snd_hda_check_amp_list_power(struct hda_codec *codec,
2518                                  struct hda_loopback_check *check,
2519                                  hda_nid_t nid)
2520 {
2521         struct hda_amp_list *p;
2522         int ch, v;
2523
2524         if (!check->amplist)
2525                 return 0;
2526         for (p = check->amplist; p->nid; p++) {
2527                 if (p->nid == nid)
2528                         break;
2529         }
2530         if (!p->nid)
2531                 return 0; /* nothing changed */
2532
2533         for (p = check->amplist; p->nid; p++) {
2534                 for (ch = 0; ch < 2; ch++) {
2535                         v = snd_hda_codec_amp_read(codec, p->nid, ch, p->dir,
2536                                                    p->idx);
2537                         if (!(v & HDA_AMP_MUTE) && v > 0) {
2538                                 if (!check->power_on) {
2539                                         check->power_on = 1;
2540                                         snd_hda_power_up(codec);
2541                                 }
2542                                 return 1;
2543                         }
2544                 }
2545         }
2546         if (check->power_on) {
2547                 check->power_on = 0;
2548                 snd_hda_power_down(codec);
2549         }
2550         return 0;
2551 }
2552 #endif
2553
2554 /*
2555  * Channel mode helper
2556  */
2557 int snd_hda_ch_mode_info(struct hda_codec *codec,
2558                          struct snd_ctl_elem_info *uinfo,
2559                          const struct hda_channel_mode *chmode,
2560                          int num_chmodes)
2561 {
2562         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2563         uinfo->count = 1;
2564         uinfo->value.enumerated.items = num_chmodes;
2565         if (uinfo->value.enumerated.item >= num_chmodes)
2566                 uinfo->value.enumerated.item = num_chmodes - 1;
2567         sprintf(uinfo->value.enumerated.name, "%dch",
2568                 chmode[uinfo->value.enumerated.item].channels);
2569         return 0;
2570 }
2571
2572 int snd_hda_ch_mode_get(struct hda_codec *codec,
2573                         struct snd_ctl_elem_value *ucontrol,
2574                         const struct hda_channel_mode *chmode,
2575                         int num_chmodes,
2576                         int max_channels)
2577 {
2578         int i;
2579
2580         for (i = 0; i < num_chmodes; i++) {
2581                 if (max_channels == chmode[i].channels) {
2582                         ucontrol->value.enumerated.item[0] = i;
2583                         break;
2584                 }
2585         }
2586         return 0;
2587 }
2588
2589 int snd_hda_ch_mode_put(struct hda_codec *codec,
2590                         struct snd_ctl_elem_value *ucontrol,
2591                         const struct hda_channel_mode *chmode,
2592                         int num_chmodes,
2593                         int *max_channelsp)
2594 {
2595         unsigned int mode;
2596
2597         mode = ucontrol->value.enumerated.item[0];
2598         if (mode >= num_chmodes)
2599                 return -EINVAL;
2600         if (*max_channelsp == chmode[mode].channels)
2601                 return 0;
2602         /* change the current channel setting */
2603         *max_channelsp = chmode[mode].channels;
2604         if (chmode[mode].sequence)
2605                 snd_hda_sequence_write_cache(codec, chmode[mode].sequence);
2606         return 1;
2607 }
2608
2609 /*
2610  * input MUX helper
2611  */
2612 int snd_hda_input_mux_info(const struct hda_input_mux *imux,
2613                            struct snd_ctl_elem_info *uinfo)
2614 {
2615         unsigned int index;
2616
2617         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2618         uinfo->count = 1;
2619         uinfo->value.enumerated.items = imux->num_items;
2620         if (!imux->num_items)
2621                 return 0;
2622         index = uinfo->value.enumerated.item;
2623         if (index >= imux->num_items)
2624                 index = imux->num_items - 1;
2625         strcpy(uinfo->value.enumerated.name, imux->items[index].label);
2626         return 0;
2627 }
2628
2629 int snd_hda_input_mux_put(struct hda_codec *codec,
2630                           const struct hda_input_mux *imux,
2631                           struct snd_ctl_elem_value *ucontrol,
2632                           hda_nid_t nid,
2633                           unsigned int *cur_val)
2634 {
2635         unsigned int idx;
2636
2637         if (!imux->num_items)
2638                 return 0;
2639         idx = ucontrol->value.enumerated.item[0];
2640         if (idx >= imux->num_items)
2641                 idx = imux->num_items - 1;
2642         if (*cur_val == idx)
2643                 return 0;
2644         snd_hda_codec_write_cache(codec, nid, 0, AC_VERB_SET_CONNECT_SEL,
2645                                   imux->items[idx].index);
2646         *cur_val = idx;
2647         return 1;
2648 }
2649
2650
2651 /*
2652  * Multi-channel / digital-out PCM helper functions
2653  */
2654
2655 /* setup SPDIF output stream */
2656 static void setup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid,
2657                                  unsigned int stream_tag, unsigned int format)
2658 {
2659         /* turn off SPDIF once; otherwise the IEC958 bits won't be updated */
2660         if (codec->spdif_status_reset && (codec->spdif_ctls & AC_DIG1_ENABLE))
2661                 set_dig_out_convert(codec, nid,
2662                                     codec->spdif_ctls & ~AC_DIG1_ENABLE & 0xff,
2663                                     -1);
2664         snd_hda_codec_setup_stream(codec, nid, stream_tag, 0, format);
2665         if (codec->slave_dig_outs) {
2666                 hda_nid_t *d;
2667                 for (d = codec->slave_dig_outs; *d; d++)
2668                         snd_hda_codec_setup_stream(codec, *d, stream_tag, 0,
2669                                                    format);
2670         }
2671         /* turn on again (if needed) */
2672         if (codec->spdif_status_reset && (codec->spdif_ctls & AC_DIG1_ENABLE))
2673                 set_dig_out_convert(codec, nid,
2674                                     codec->spdif_ctls & 0xff, -1);
2675 }
2676
2677 static void cleanup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid)
2678 {
2679         snd_hda_codec_cleanup_stream(codec, nid);
2680         if (codec->slave_dig_outs) {
2681                 hda_nid_t *d;
2682                 for (d = codec->slave_dig_outs; *d; d++)
2683                         snd_hda_codec_cleanup_stream(codec, *d);
2684         }
2685 }
2686
2687 /*
2688  * open the digital out in the exclusive mode
2689  */
2690 int snd_hda_multi_out_dig_open(struct hda_codec *codec,
2691                                struct hda_multi_out *mout)
2692 {
2693         mutex_lock(&codec->spdif_mutex);
2694         if (mout->dig_out_used == HDA_DIG_ANALOG_DUP)
2695                 /* already opened as analog dup; reset it once */
2696                 cleanup_dig_out_stream(codec, mout->dig_out_nid);
2697         mout->dig_out_used = HDA_DIG_EXCLUSIVE;
2698         mutex_unlock(&codec->spdif_mutex);
2699         return 0;
2700 }
2701
2702 int snd_hda_multi_out_dig_prepare(struct hda_codec *codec,
2703                                   struct hda_multi_out *mout,
2704                                   unsigned int stream_tag,
2705                                   unsigned int format,
2706                                   struct snd_pcm_substream *substream)
2707 {
2708         mutex_lock(&codec->spdif_mutex);
2709         setup_dig_out_stream(codec, mout->dig_out_nid, stream_tag, format);
2710         mutex_unlock(&codec->spdif_mutex);
2711         return 0;
2712 }
2713
2714 /*
2715  * release the digital out
2716  */
2717 int snd_hda_multi_out_dig_close(struct hda_codec *codec,
2718                                 struct hda_multi_out *mout)
2719 {
2720         mutex_lock(&codec->spdif_mutex);
2721         mout->dig_out_used = 0;
2722         mutex_unlock(&codec->spdif_mutex);
2723         return 0;
2724 }
2725
2726 /*
2727  * set up more restrictions for analog out
2728  */
2729 int snd_hda_multi_out_analog_open(struct hda_codec *codec,
2730                                   struct hda_multi_out *mout,
2731                                   struct snd_pcm_substream *substream,
2732                                   struct hda_pcm_stream *hinfo)
2733 {
2734         struct snd_pcm_runtime *runtime = substream->runtime;
2735         runtime->hw.channels_max = mout->max_channels;
2736         if (mout->dig_out_nid) {
2737                 if (!mout->analog_rates) {
2738                         mout->analog_rates = hinfo->rates;
2739                         mout->analog_formats = hinfo->formats;
2740                         mout->analog_maxbps = hinfo->maxbps;
2741                 } else {
2742                         runtime->hw.rates = mout->analog_rates;
2743                         runtime->hw.formats = mout->analog_formats;
2744                         hinfo->maxbps = mout->analog_maxbps;
2745                 }
2746                 if (!mout->spdif_rates) {
2747                         snd_hda_query_supported_pcm(codec, mout->dig_out_nid,
2748                                                     &mout->spdif_rates,
2749                                                     &mout->spdif_formats,
2750                                                     &mout->spdif_maxbps);
2751                 }
2752                 mutex_lock(&codec->spdif_mutex);
2753                 if (mout->share_spdif) {
2754                         runtime->hw.rates &= mout->spdif_rates;
2755                         runtime->hw.formats &= mout->spdif_formats;
2756                         if (mout->spdif_maxbps < hinfo->maxbps)
2757                                 hinfo->maxbps = mout->spdif_maxbps;
2758                 }
2759                 mutex_unlock(&codec->spdif_mutex);
2760         }
2761         return snd_pcm_hw_constraint_step(substream->runtime, 0,
2762                                           SNDRV_PCM_HW_PARAM_CHANNELS, 2);
2763 }
2764
2765 /*
2766  * set up the i/o for analog out
2767  * when the digital out is available, copy the front out to digital out, too.
2768  */
2769 int snd_hda_multi_out_analog_prepare(struct hda_codec *codec,
2770                                      struct hda_multi_out *mout,
2771                                      unsigned int stream_tag,
2772                                      unsigned int format,
2773                                      struct snd_pcm_substream *substream)
2774 {
2775         hda_nid_t *nids = mout->dac_nids;
2776         int chs = substream->runtime->channels;
2777         int i;
2778
2779         mutex_lock(&codec->spdif_mutex);
2780         if (mout->dig_out_nid && mout->share_spdif &&
2781             mout->dig_out_used != HDA_DIG_EXCLUSIVE) {
2782                 if (chs == 2 &&
2783                     snd_hda_is_supported_format(codec, mout->dig_out_nid,
2784                                                 format) &&
2785                     !(codec->spdif_status & IEC958_AES0_NONAUDIO)) {
2786                         mout->dig_out_used = HDA_DIG_ANALOG_DUP;
2787                         setup_dig_out_stream(codec, mout->dig_out_nid,
2788                                              stream_tag, format);
2789                 } else {
2790                         mout->dig_out_used = 0;
2791                         cleanup_dig_out_stream(codec, mout->dig_out_nid);
2792                 }
2793         }
2794         mutex_unlock(&codec->spdif_mutex);
2795
2796         /* front */
2797         snd_hda_codec_setup_stream(codec, nids[HDA_FRONT], stream_tag,
2798                                    0, format);
2799         if (!mout->no_share_stream &&
2800             mout->hp_nid && mout->hp_nid != nids[HDA_FRONT])
2801                 /* headphone out will just decode front left/right (stereo) */
2802                 snd_hda_codec_setup_stream(codec, mout->hp_nid, stream_tag,
2803                                            0, format);
2804         /* extra outputs copied from front */
2805         for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
2806                 if (!mout->no_share_stream && mout->extra_out_nid[i])
2807                         snd_hda_codec_setup_stream(codec,
2808                                                    mout->extra_out_nid[i],
2809                                                    stream_tag, 0, format);
2810
2811         /* surrounds */
2812         for (i = 1; i < mout->num_dacs; i++) {
2813                 if (chs >= (i + 1) * 2) /* independent out */
2814                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
2815                                                    i * 2, format);
2816                 else if (!mout->no_share_stream) /* copy front */
2817                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
2818                                                    0, format);
2819         }
2820         return 0;
2821 }
2822
2823 /*
2824  * clean up the setting for analog out
2825  */
2826 int snd_hda_multi_out_analog_cleanup(struct hda_codec *codec,
2827                                      struct hda_multi_out *mout)
2828 {
2829         hda_nid_t *nids = mout->dac_nids;
2830         int i;
2831
2832         for (i = 0; i < mout->num_dacs; i++)
2833                 snd_hda_codec_cleanup_stream(codec, nids[i]);
2834         if (mout->hp_nid)
2835                 snd_hda_codec_cleanup_stream(codec, mout->hp_nid);
2836         for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
2837                 if (mout->extra_out_nid[i])
2838                         snd_hda_codec_cleanup_stream(codec,
2839                                                      mout->extra_out_nid[i]);
2840         mutex_lock(&codec->spdif_mutex);
2841         if (mout->dig_out_nid && mout->dig_out_used == HDA_DIG_ANALOG_DUP) {
2842                 cleanup_dig_out_stream(codec, mout->dig_out_nid);
2843                 mout->dig_out_used = 0;
2844         }
2845         mutex_unlock(&codec->spdif_mutex);
2846         return 0;
2847 }
2848
2849 /*
2850  * Helper for automatic pin configuration
2851  */
2852
2853 static int is_in_nid_list(hda_nid_t nid, hda_nid_t *list)
2854 {
2855         for (; *list; list++)
2856                 if (*list == nid)
2857                         return 1;
2858         return 0;
2859 }
2860
2861
2862 /*
2863  * Sort an associated group of pins according to their sequence numbers.
2864  */
2865 static void sort_pins_by_sequence(hda_nid_t * pins, short * sequences,
2866                                   int num_pins)
2867 {
2868         int i, j;
2869         short seq;
2870         hda_nid_t nid;
2871
2872         for (i = 0; i < num_pins; i++) {
2873                 for (j = i + 1; j < num_pins; j++) {
2874                         if (sequences[i] > sequences[j]) {
2875                                 seq = sequences[i];
2876                                 sequences[i] = sequences[j];
2877                                 sequences[j] = seq;
2878                                 nid = pins[i];
2879                                 pins[i] = pins[j];
2880                                 pins[j] = nid;
2881                         }
2882                 }
2883         }
2884 }
2885
2886
2887 /*
2888  * Parse all pin widgets and store the useful pin nids to cfg
2889  *
2890  * The number of line-outs or any primary output is stored in line_outs,
2891  * and the corresponding output pins are assigned to line_out_pins[],
2892  * in the order of front, rear, CLFE, side, ...
2893  *
2894  * If more extra outputs (speaker and headphone) are found, the pins are
2895  * assisnged to hp_pins[] and speaker_pins[], respectively.  If no line-out jack
2896  * is detected, one of speaker of HP pins is assigned as the primary
2897  * output, i.e. to line_out_pins[0].  So, line_outs is always positive
2898  * if any analog output exists.
2899  *
2900  * The analog input pins are assigned to input_pins array.
2901  * The digital input/output pins are assigned to dig_in_pin and dig_out_pin,
2902  * respectively.
2903  */
2904 int snd_hda_parse_pin_def_config(struct hda_codec *codec,
2905                                  struct auto_pin_cfg *cfg,
2906                                  hda_nid_t *ignore_nids)
2907 {
2908         hda_nid_t nid, end_nid;
2909         short seq, assoc_line_out, assoc_speaker;
2910         short sequences_line_out[ARRAY_SIZE(cfg->line_out_pins)];
2911         short sequences_speaker[ARRAY_SIZE(cfg->speaker_pins)];
2912         short sequences_hp[ARRAY_SIZE(cfg->hp_pins)];
2913
2914         memset(cfg, 0, sizeof(*cfg));
2915
2916         memset(sequences_line_out, 0, sizeof(sequences_line_out));
2917         memset(sequences_speaker, 0, sizeof(sequences_speaker));
2918         memset(sequences_hp, 0, sizeof(sequences_hp));
2919         assoc_line_out = assoc_speaker = 0;
2920
2921         end_nid = codec->start_nid + codec->num_nodes;
2922         for (nid = codec->start_nid; nid < end_nid; nid++) {
2923                 unsigned int wid_caps = get_wcaps(codec, nid);
2924                 unsigned int wid_type =
2925                         (wid_caps & AC_WCAP_TYPE) >> AC_WCAP_TYPE_SHIFT;
2926                 unsigned int def_conf;
2927                 short assoc, loc;
2928
2929                 /* read all default configuration for pin complex */
2930                 if (wid_type != AC_WID_PIN)
2931                         continue;
2932                 /* ignore the given nids (e.g. pc-beep returns error) */
2933                 if (ignore_nids && is_in_nid_list(nid, ignore_nids))
2934                         continue;
2935
2936                 def_conf = snd_hda_codec_read(codec, nid, 0,
2937                                               AC_VERB_GET_CONFIG_DEFAULT, 0);
2938                 if (get_defcfg_connect(def_conf) == AC_JACK_PORT_NONE)
2939                         continue;
2940                 loc = get_defcfg_location(def_conf);
2941                 switch (get_defcfg_device(def_conf)) {
2942                 case AC_JACK_LINE_OUT:
2943                         seq = get_defcfg_sequence(def_conf);
2944                         assoc = get_defcfg_association(def_conf);
2945
2946                         if (!(wid_caps & AC_WCAP_STEREO))
2947                                 if (!cfg->mono_out_pin)
2948                                         cfg->mono_out_pin = nid;
2949                         if (!assoc)
2950                                 continue;
2951                         if (!assoc_line_out)
2952                                 assoc_line_out = assoc;
2953                         else if (assoc_line_out != assoc)
2954                                 continue;
2955                         if (cfg->line_outs >= ARRAY_SIZE(cfg->line_out_pins))
2956                                 continue;
2957                         cfg->line_out_pins[cfg->line_outs] = nid;
2958                         sequences_line_out[cfg->line_outs] = seq;
2959                         cfg->line_outs++;
2960                         break;
2961                 case AC_JACK_SPEAKER:
2962                         seq = get_defcfg_sequence(def_conf);
2963                         assoc = get_defcfg_association(def_conf);
2964                         if (! assoc)
2965                                 continue;
2966                         if (! assoc_speaker)
2967                                 assoc_speaker = assoc;
2968                         else if (assoc_speaker != assoc)
2969                                 continue;
2970                         if (cfg->speaker_outs >= ARRAY_SIZE(cfg->speaker_pins))
2971                                 continue;
2972                         cfg->speaker_pins[cfg->speaker_outs] = nid;
2973                         sequences_speaker[cfg->speaker_outs] = seq;
2974                         cfg->speaker_outs++;
2975                         break;
2976                 case AC_JACK_HP_OUT:
2977                         seq = get_defcfg_sequence(def_conf);
2978                         assoc = get_defcfg_association(def_conf);
2979                         if (cfg->hp_outs >= ARRAY_SIZE(cfg->hp_pins))
2980                                 continue;
2981                         cfg->hp_pins[cfg->hp_outs] = nid;
2982                         sequences_hp[cfg->hp_outs] = (assoc << 4) | seq;
2983                         cfg->hp_outs++;
2984                         break;
2985                 case AC_JACK_MIC_IN: {
2986                         int preferred, alt;
2987                         if (loc == AC_JACK_LOC_FRONT) {
2988                                 preferred = AUTO_PIN_FRONT_MIC;
2989                                 alt = AUTO_PIN_MIC;
2990                         } else {
2991                                 preferred = AUTO_PIN_MIC;
2992                                 alt = AUTO_PIN_FRONT_MIC;
2993                         }
2994                         if (!cfg->input_pins[preferred])
2995                                 cfg->input_pins[preferred] = nid;
2996                         else if (!cfg->input_pins[alt])
2997                                 cfg->input_pins[alt] = nid;
2998                         break;
2999                 }
3000                 case AC_JACK_LINE_IN:
3001                         if (loc == AC_JACK_LOC_FRONT)
3002                                 cfg->input_pins[AUTO_PIN_FRONT_LINE] = nid;
3003                         else
3004                                 cfg->input_pins[AUTO_PIN_LINE] = nid;
3005                         break;
3006                 case AC_JACK_CD:
3007                         cfg->input_pins[AUTO_PIN_CD] = nid;
3008                         break;
3009                 case AC_JACK_AUX:
3010                         cfg->input_pins[AUTO_PIN_AUX] = nid;
3011                         break;
3012                 case AC_JACK_SPDIF_OUT:
3013                         cfg->dig_out_pin = nid;
3014                         break;
3015                 case AC_JACK_SPDIF_IN:
3016                         cfg->dig_in_pin = nid;
3017                         break;
3018                 }
3019         }
3020
3021         /* FIX-UP:
3022          * If no line-out is defined but multiple HPs are found,
3023          * some of them might be the real line-outs.
3024          */
3025         if (!cfg->line_outs && cfg->hp_outs > 1) {
3026                 int i = 0;
3027                 while (i < cfg->hp_outs) {
3028                         /* The real HPs should have the sequence 0x0f */
3029                         if ((sequences_hp[i] & 0x0f) == 0x0f) {
3030                                 i++;
3031                                 continue;
3032                         }
3033                         /* Move it to the line-out table */
3034                         cfg->line_out_pins[cfg->line_outs] = cfg->hp_pins[i];
3035                         sequences_line_out[cfg->line_outs] = sequences_hp[i];
3036                         cfg->line_outs++;
3037                         cfg->hp_outs--;
3038                         memmove(cfg->hp_pins + i, cfg->hp_pins + i + 1,
3039                                 sizeof(cfg->hp_pins[0]) * (cfg->hp_outs - i));
3040                         memmove(sequences_hp + i - 1, sequences_hp + i,
3041                                 sizeof(sequences_hp[0]) * (cfg->hp_outs - i));
3042                 }
3043         }
3044
3045         /* sort by sequence */
3046         sort_pins_by_sequence(cfg->line_out_pins, sequences_line_out,
3047                               cfg->line_outs);
3048         sort_pins_by_sequence(cfg->speaker_pins, sequences_speaker,
3049                               cfg->speaker_outs);
3050         sort_pins_by_sequence(cfg->hp_pins, sequences_hp,
3051                               cfg->hp_outs);
3052
3053         /* if we have only one mic, make it AUTO_PIN_MIC */
3054         if (!cfg->input_pins[AUTO_PIN_MIC] &&
3055             cfg->input_pins[AUTO_PIN_FRONT_MIC]) {
3056                 cfg->input_pins[AUTO_PIN_MIC] =
3057                         cfg->input_pins[AUTO_PIN_FRONT_MIC];
3058                 cfg->input_pins[AUTO_PIN_FRONT_MIC] = 0;
3059         }
3060         /* ditto for line-in */
3061         if (!cfg->input_pins[AUTO_PIN_LINE] &&
3062             cfg->input_pins[AUTO_PIN_FRONT_LINE]) {
3063                 cfg->input_pins[AUTO_PIN_LINE] =
3064                         cfg->input_pins[AUTO_PIN_FRONT_LINE];
3065                 cfg->input_pins[AUTO_PIN_FRONT_LINE] = 0;
3066         }
3067
3068         /*
3069          * FIX-UP: if no line-outs are detected, try to use speaker or HP pin
3070          * as a primary output
3071          */
3072         if (!cfg->line_outs) {
3073                 if (cfg->speaker_outs) {
3074                         cfg->line_outs = cfg->speaker_outs;
3075                         memcpy(cfg->line_out_pins, cfg->speaker_pins,
3076                                sizeof(cfg->speaker_pins));
3077                         cfg->speaker_outs = 0;
3078                         memset(cfg->speaker_pins, 0, sizeof(cfg->speaker_pins));
3079                         cfg->line_out_type = AUTO_PIN_SPEAKER_OUT;
3080                 } else if (cfg->hp_outs) {
3081                         cfg->line_outs = cfg->hp_outs;
3082                         memcpy(cfg->line_out_pins, cfg->hp_pins,
3083                                sizeof(cfg->hp_pins));
3084                         cfg->hp_outs = 0;
3085                         memset(cfg->hp_pins, 0, sizeof(cfg->hp_pins));
3086                         cfg->line_out_type = AUTO_PIN_HP_OUT;
3087                 }
3088         }
3089
3090         /* Reorder the surround channels
3091          * ALSA sequence is front/surr/clfe/side
3092          * HDA sequence is:
3093          *    4-ch: front/surr  =>  OK as it is
3094          *    6-ch: front/clfe/surr
3095          *    8-ch: front/clfe/rear/side|fc
3096          */
3097         switch (cfg->line_outs) {
3098         case 3:
3099         case 4:
3100                 nid = cfg->line_out_pins[1];
3101                 cfg->line_out_pins[1] = cfg->line_out_pins[2];
3102                 cfg->line_out_pins[2] = nid;
3103                 break;
3104         }
3105
3106         /*
3107          * debug prints of the parsed results
3108          */
3109         snd_printd("autoconfig: line_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
3110                    cfg->line_outs, cfg->line_out_pins[0], cfg->line_out_pins[1],
3111                    cfg->line_out_pins[2], cfg->line_out_pins[3],
3112                    cfg->line_out_pins[4]);
3113         snd_printd("   speaker_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
3114                    cfg->speaker_outs, cfg->speaker_pins[0],
3115                    cfg->speaker_pins[1], cfg->speaker_pins[2],
3116                    cfg->speaker_pins[3], cfg->speaker_pins[4]);
3117         snd_printd("   hp_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
3118                    cfg->hp_outs, cfg->hp_pins[0],
3119                    cfg->hp_pins[1], cfg->hp_pins[2],
3120                    cfg->hp_pins[3], cfg->hp_pins[4]);
3121         snd_printd("   mono: mono_out=0x%x\n", cfg->mono_out_pin);
3122         snd_printd("   inputs: mic=0x%x, fmic=0x%x, line=0x%x, fline=0x%x,"
3123                    " cd=0x%x, aux=0x%x\n",
3124                    cfg->input_pins[AUTO_PIN_MIC],
3125                    cfg->input_pins[AUTO_PIN_FRONT_MIC],
3126                    cfg->input_pins[AUTO_PIN_LINE],
3127                    cfg->input_pins[AUTO_PIN_FRONT_LINE],
3128                    cfg->input_pins[AUTO_PIN_CD],
3129                    cfg->input_pins[AUTO_PIN_AUX]);
3130
3131         return 0;
3132 }
3133
3134 /* labels for input pins */
3135 const char *auto_pin_cfg_labels[AUTO_PIN_LAST] = {
3136         "Mic", "Front Mic", "Line", "Front Line", "CD", "Aux"
3137 };
3138
3139
3140 #ifdef CONFIG_PM
3141 /*
3142  * power management
3143  */
3144
3145 /**
3146  * snd_hda_suspend - suspend the codecs
3147  * @bus: the HDA bus
3148  * @state: suspsend state
3149  *
3150  * Returns 0 if successful.
3151  */
3152 int snd_hda_suspend(struct hda_bus *bus, pm_message_t state)
3153 {
3154         struct hda_codec *codec;
3155
3156         list_for_each_entry(codec, &bus->codec_list, list) {
3157 #ifdef CONFIG_SND_HDA_POWER_SAVE
3158                 if (!codec->power_on)
3159                         continue;
3160 #endif
3161                 hda_call_codec_suspend(codec);
3162         }
3163         return 0;
3164 }
3165
3166 /**
3167  * snd_hda_resume - resume the codecs
3168  * @bus: the HDA bus
3169  * @state: resume state
3170  *
3171  * Returns 0 if successful.
3172  *
3173  * This fucntion is defined only when POWER_SAVE isn't set.
3174  * In the power-save mode, the codec is resumed dynamically.
3175  */
3176 int snd_hda_resume(struct hda_bus *bus)
3177 {
3178         struct hda_codec *codec;
3179
3180         list_for_each_entry(codec, &bus->codec_list, list) {
3181                 if (snd_hda_codec_needs_resume(codec))
3182                         hda_call_codec_resume(codec);
3183         }
3184         return 0;
3185 }
3186 #ifdef CONFIG_SND_HDA_POWER_SAVE
3187 int snd_hda_codecs_inuse(struct hda_bus *bus)
3188 {
3189         struct hda_codec *codec;
3190
3191         list_for_each_entry(codec, &bus->codec_list, list) {
3192                 if (snd_hda_codec_needs_resume(codec))
3193                         return 1;
3194         }
3195         return 0;
3196 }
3197 #endif
3198 #endif
3199
3200 /*
3201  * generic arrays
3202  */
3203
3204 /* get a new element from the given array
3205  * if it exceeds the pre-allocated array size, re-allocate the array
3206  */
3207 void *snd_array_new(struct snd_array *array)
3208 {
3209         if (array->used >= array->alloced) {
3210                 int num = array->alloced + array->alloc_align;
3211                 void *nlist = kcalloc(num + 1, array->elem_size, GFP_KERNEL);
3212                 if (!nlist)
3213                         return NULL;
3214                 if (array->list) {
3215                         memcpy(nlist, array->list,
3216                                array->elem_size * array->alloced);
3217                         kfree(array->list);
3218                 }
3219                 array->list = nlist;
3220                 array->alloced = num;
3221         }
3222         return array->list + (array->used++ * array->elem_size);
3223 }
3224
3225 /* free the given array elements */
3226 void snd_array_free(struct snd_array *array)
3227 {
3228         kfree(array->list);
3229         array->used = 0;
3230         array->alloced = 0;
3231         array->list = NULL;
3232 }