// SPDX-License-Identifier: GPL-2.0-or-later
/*
 *  Copyright (c) by Jaroslav Kysela <perex@perex.cz>
 *                   Creative Labs, Inc.
 *  Routines for effect processor FX8010
 *
 *  Copyright (c) by James Courtier-Dutton <James@superbug.co.uk>
 *      Added EMU 1010 support.
 *
 *  BUGS:
 *    --
 *
 *  TODO:
 *    --
 */

#include <linux/pci.h>
#include <linux/capability.h>
#include <linux/delay.h>
#include <linux/slab.h>
#include <linux/vmalloc.h>
#include <linux/init.h>
#include <linux/mutex.h>
#include <linux/moduleparam.h>
#include <linux/nospec.h>

#include <sound/core.h>
#include <sound/tlv.h>
#include <sound/emu10k1.h>

#if 0           /* for testing purposes - digital out -> capture */
#define EMU10K1_CAPTURE_DIGITAL_OUT
#endif
#if 0           /* for testing purposes - set S/PDIF to AC3 output */
#define EMU10K1_SET_AC3_IEC958
#endif
#if 0           /* for testing purposes - feed the front signal to Center/LFE outputs */
#define EMU10K1_CENTER_LFE_FROM_FRONT
#endif

static bool high_res_gpr_volume;
module_param(high_res_gpr_volume, bool, 0444);
MODULE_PARM_DESC(high_res_gpr_volume, "GPR mixer controls use 31-bit range.");

/*
 *  Tables
 */ 

static const char * const fxbuses[16] = {
        /* 0x00 */ "PCM Left",
        /* 0x01 */ "PCM Right",
        /* 0x02 */ "PCM Surround Left",
        /* 0x03 */ "PCM Surround Right",
        /* 0x04 */ "MIDI Left",
        /* 0x05 */ "MIDI Right",
        /* 0x06 */ "Center",
        /* 0x07 */ "LFE",
        /* 0x08 */ NULL,
        /* 0x09 */ NULL,
        /* 0x0a */ NULL,
        /* 0x0b */ NULL,
        /* 0x0c */ "MIDI Reverb",
        /* 0x0d */ "MIDI Chorus",
        /* 0x0e */ NULL,
        /* 0x0f */ NULL
};

static const char * const creative_ins[16] = {
        /* 0x00 */ "AC97 Left",
        /* 0x01 */ "AC97 Right",
        /* 0x02 */ "TTL IEC958 Left",
        /* 0x03 */ "TTL IEC958 Right",
        /* 0x04 */ "Zoom Video Left",
        /* 0x05 */ "Zoom Video Right",
        /* 0x06 */ "Optical IEC958 Left",
        /* 0x07 */ "Optical IEC958 Right",
        /* 0x08 */ "Line/Mic 1 Left",
        /* 0x09 */ "Line/Mic 1 Right",
        /* 0x0a */ "Coaxial IEC958 Left",
        /* 0x0b */ "Coaxial IEC958 Right",
        /* 0x0c */ "Line/Mic 2 Left",
        /* 0x0d */ "Line/Mic 2 Right",
        /* 0x0e */ NULL,
        /* 0x0f */ NULL
};

static const char * const audigy_ins[16] = {
        /* 0x00 */ "AC97 Left",
        /* 0x01 */ "AC97 Right",
        /* 0x02 */ "Audigy CD Left",
        /* 0x03 */ "Audigy CD Right",
        /* 0x04 */ "Optical IEC958 Left",
        /* 0x05 */ "Optical IEC958 Right",
        /* 0x06 */ NULL,
        /* 0x07 */ NULL,
        /* 0x08 */ "Line/Mic 2 Left",
        /* 0x09 */ "Line/Mic 2 Right",
        /* 0x0a */ "SPDIF Left",
        /* 0x0b */ "SPDIF Right",
        /* 0x0c */ "Aux2 Left",
        /* 0x0d */ "Aux2 Right",
        /* 0x0e */ NULL,
        /* 0x0f */ NULL
};

static const char * const creative_outs[32] = {
        /* 0x00 */ "AC97 Left",
        /* 0x01 */ "AC97 Right",
        /* 0x02 */ "Optical IEC958 Left",
        /* 0x03 */ "Optical IEC958 Right",
        /* 0x04 */ "Center",
        /* 0x05 */ "LFE",
        /* 0x06 */ "Headphone Left",
        /* 0x07 */ "Headphone Right",
        /* 0x08 */ "Surround Left",
        /* 0x09 */ "Surround Right",
        /* 0x0a */ "PCM Capture Left",
        /* 0x0b */ "PCM Capture Right",
        /* 0x0c */ "MIC Capture",
        /* 0x0d */ "AC97 Surround Left",
        /* 0x0e */ "AC97 Surround Right",
        /* 0x0f */ NULL,
        /* 0x10 */ NULL,
        /* 0x11 */ "Analog Center",
        /* 0x12 */ "Analog LFE",
        /* 0x13 */ NULL,
        /* 0x14 */ NULL,
        /* 0x15 */ NULL,
        /* 0x16 */ NULL,
        /* 0x17 */ NULL,
        /* 0x18 */ NULL,
        /* 0x19 */ NULL,
        /* 0x1a */ NULL,
        /* 0x1b */ NULL,
        /* 0x1c */ NULL,
        /* 0x1d */ NULL,
        /* 0x1e */ NULL,
        /* 0x1f */ NULL,
};

static const char * const audigy_outs[32] = {
        /* 0x00 */ "Digital Front Left",
        /* 0x01 */ "Digital Front Right",
        /* 0x02 */ "Digital Center",
        /* 0x03 */ "Digital LEF",
        /* 0x04 */ "Headphone Left",
        /* 0x05 */ "Headphone Right",
        /* 0x06 */ "Digital Rear Left",
        /* 0x07 */ "Digital Rear Right",
        /* 0x08 */ "Front Left",
        /* 0x09 */ "Front Right",
        /* 0x0a */ "Center",
        /* 0x0b */ "LFE",
        /* 0x0c */ NULL,
        /* 0x0d */ NULL,
        /* 0x0e */ "Rear Left",
        /* 0x0f */ "Rear Right",
        /* 0x10 */ "AC97 Front Left",
        /* 0x11 */ "AC97 Front Right",
        /* 0x12 */ "ADC Capture Left",
        /* 0x13 */ "ADC Capture Right",
        /* 0x14 */ NULL,
        /* 0x15 */ NULL,
        /* 0x16 */ NULL,
        /* 0x17 */ NULL,
        /* 0x18 */ NULL,
        /* 0x19 */ NULL,
        /* 0x1a */ NULL,
        /* 0x1b */ NULL,
        /* 0x1c */ NULL,
        /* 0x1d */ NULL,
        /* 0x1e */ NULL,
        /* 0x1f */ NULL,
};

static const u32 bass_table[41][5] = {
        { 0x3e4f844f, 0x84ed4cc3, 0x3cc69927, 0x7b03553a, 0xc4da8486 },
        { 0x3e69a17a, 0x84c280fb, 0x3cd77cd4, 0x7b2f2a6f, 0xc4b08d1d },
        { 0x3e82ff42, 0x849991d5, 0x3ce7466b, 0x7b5917c6, 0xc48863ee },
        { 0x3e9bab3c, 0x847267f0, 0x3cf5ffe8, 0x7b813560, 0xc461f22c },
        { 0x3eb3b275, 0x844ced29, 0x3d03b295, 0x7ba79a1c, 0xc43d223b },
        { 0x3ecb2174, 0x84290c8b, 0x3d106714, 0x7bcc5ba3, 0xc419dfa5 },
        { 0x3ee2044b, 0x8406b244, 0x3d1c2561, 0x7bef8e77, 0xc3f8170f },
        { 0x3ef86698, 0x83e5cb96, 0x3d26f4d8, 0x7c114600, 0xc3d7b625 },
        { 0x3f0e5390, 0x83c646c9, 0x3d30dc39, 0x7c319498, 0xc3b8ab97 },
        { 0x3f23d60b, 0x83a81321, 0x3d39e1af, 0x7c508b9c, 0xc39ae704 },
        { 0x3f38f884, 0x838b20d2, 0x3d420ad2, 0x7c6e3b75, 0xc37e58f1 },
        { 0x3f4dc52c, 0x836f60ef, 0x3d495cab, 0x7c8ab3a6, 0xc362f2be },
        { 0x3f6245e8, 0x8354c565, 0x3d4fdbb8, 0x7ca602d6, 0xc348a69b },
        { 0x3f76845f, 0x833b40ec, 0x3d558bf0, 0x7cc036df, 0xc32f677c },
        { 0x3f8a8a03, 0x8322c6fb, 0x3d5a70c4, 0x7cd95cd7, 0xc317290b },
        { 0x3f9e6014, 0x830b4bc3, 0x3d5e8d25, 0x7cf1811a, 0xc2ffdfa5 },
        { 0x3fb20fae, 0x82f4c420, 0x3d61e37f, 0x7d08af56, 0xc2e9804a },
        { 0x3fc5a1cc, 0x82df2592, 0x3d6475c3, 0x7d1ef294, 0xc2d40096 },
        { 0x3fd91f55, 0x82ca6632, 0x3d664564, 0x7d345541, 0xc2bf56b9 },
        { 0x3fec9120, 0x82b67cac, 0x3d675356, 0x7d48e138, 0xc2ab796e },
        { 0x40000000, 0x82a36037, 0x3d67a012, 0x7d5c9fc9, 0xc2985fee },
        { 0x401374c7, 0x8291088a, 0x3d672b93, 0x7d6f99c3, 0xc28601f2 },
        { 0x4026f857, 0x827f6dd7, 0x3d65f559, 0x7d81d77c, 0xc27457a3 },
        { 0x403a939f, 0x826e88c5, 0x3d63fc63, 0x7d9360d4, 0xc2635996 },
        { 0x404e4faf, 0x825e5266, 0x3d613f32, 0x7da43d42, 0xc25300c6 },
        { 0x406235ba, 0x824ec434, 0x3d5dbbc3, 0x7db473d7, 0xc243468e },
        { 0x40764f1f, 0x823fd80c, 0x3d596f8f, 0x7dc40b44, 0xc23424a2 },
        { 0x408aa576, 0x82318824, 0x3d545787, 0x7dd309e2, 0xc2259509 },
        { 0x409f4296, 0x8223cf0b, 0x3d4e7012, 0x7de175b5, 0xc2179218 },
        { 0x40b430a0, 0x8216a7a1, 0x3d47b505, 0x7def5475, 0xc20a1670 },
        { 0x40c97a0a, 0x820a0d12, 0x3d4021a1, 0x7dfcab8d, 0xc1fd1cf5 },
        { 0x40df29a6, 0x81fdfad6, 0x3d37b08d, 0x7e098028, 0xc1f0a0ca },
        { 0x40f54ab1, 0x81f26ca9, 0x3d2e5bd1, 0x7e15d72b, 0xc1e49d52 },
        { 0x410be8da, 0x81e75e89, 0x3d241cce, 0x7e21b544, 0xc1d90e24 },
        { 0x41231051, 0x81dcccb3, 0x3d18ec37, 0x7e2d1ee6, 0xc1cdef10 },
        { 0x413acdd0, 0x81d2b39e, 0x3d0cc20a, 0x7e38184e, 0xc1c33c13 },
        { 0x41532ea7, 0x81c90ffb, 0x3cff9585, 0x7e42a58b, 0xc1b8f15a },
        { 0x416c40cd, 0x81bfdeb2, 0x3cf15d21, 0x7e4cca7c, 0xc1af0b3f },
        { 0x418612ea, 0x81b71cdc, 0x3ce20e85, 0x7e568ad3, 0xc1a58640 },
        { 0x41a0b465, 0x81aec7c5, 0x3cd19e7c, 0x7e5fea1e, 0xc19c5f03 },
        { 0x41bc3573, 0x81a6dcea, 0x3cc000e9, 0x7e68ebc2, 0xc1939250 }
};

static const u32 treble_table[41][5] = {
        { 0x0125cba9, 0xfed5debd, 0x00599b6c, 0x0d2506da, 0xfa85b354 },
        { 0x0142f67e, 0xfeb03163, 0x0066cd0f, 0x0d14c69d, 0xfa914473 },
        { 0x016328bd, 0xfe860158, 0x0075b7f2, 0x0d03eb27, 0xfa9d32d2 },
        { 0x0186b438, 0xfe56c982, 0x00869234, 0x0cf27048, 0xfaa97fca },
        { 0x01adf358, 0xfe21f5fe, 0x00999842, 0x0ce051c2, 0xfab62ca5 },
        { 0x01d949fa, 0xfde6e287, 0x00af0d8d, 0x0ccd8b4a, 0xfac33aa7 },
        { 0x02092669, 0xfda4d8bf, 0x00c73d4c, 0x0cba1884, 0xfad0ab07 },
        { 0x023e0268, 0xfd5b0e4a, 0x00e27b54, 0x0ca5f509, 0xfade7ef2 },
        { 0x0278645c, 0xfd08a2b0, 0x01012509, 0x0c911c63, 0xfaecb788 },
        { 0x02b8e091, 0xfcac9d1a, 0x0123a262, 0x0c7b8a14, 0xfafb55df },
        { 0x03001a9a, 0xfc45e9ce, 0x014a6709, 0x0c65398f, 0xfb0a5aff },
        { 0x034ec6d7, 0xfbd3576b, 0x0175f397, 0x0c4e2643, 0xfb19c7e4 },
        { 0x03a5ac15, 0xfb5393ee, 0x01a6d6ed, 0x0c364b94, 0xfb299d7c },
        { 0x0405a562, 0xfac52968, 0x01ddafae, 0x0c1da4e2, 0xfb39dca5 },
        { 0x046fa3fe, 0xfa267a66, 0x021b2ddd, 0x0c042d8d, 0xfb4a8631 },
        { 0x04e4b17f, 0xf975be0f, 0x0260149f, 0x0be9e0f2, 0xfb5b9ae0 },
        { 0x0565f220, 0xf8b0fbe5, 0x02ad3c29, 0x0bceba73, 0xfb6d1b60 },
        { 0x05f4a745, 0xf7d60722, 0x030393d4, 0x0bb2b578, 0xfb7f084d },
        { 0x06923236, 0xf6e279bd, 0x03642465, 0x0b95cd75, 0xfb916233 },
        { 0x07401713, 0xf5d3aef9, 0x03d01283, 0x0b77fded, 0xfba42984 },
        { 0x08000000, 0xf4a6bd88, 0x0448a161, 0x0b594278, 0xfbb75e9f },
        { 0x08d3c097, 0xf3587131, 0x04cf35a4, 0x0b3996c9, 0xfbcb01cb },
        { 0x09bd59a2, 0xf1e543f9, 0x05655880, 0x0b18f6b2, 0xfbdf1333 },
        { 0x0abefd0f, 0xf04956ca, 0x060cbb12, 0x0af75e2c, 0xfbf392e8 },
        { 0x0bdb123e, 0xee806984, 0x06c739fe, 0x0ad4c962, 0xfc0880dd },
        { 0x0d143a94, 0xec85d287, 0x0796e150, 0x0ab134b0, 0xfc1ddce5 },
        { 0x0e6d5664, 0xea547598, 0x087df0a0, 0x0a8c9cb6, 0xfc33a6ad },
        { 0x0fe98a2a, 0xe7e6ba35, 0x097edf83, 0x0a66fe5b, 0xfc49ddc2 },
        { 0x118c4421, 0xe536813a, 0x0a9c6248, 0x0a4056d7, 0xfc608185 },
        { 0x1359422e, 0xe23d19eb, 0x0bd96efb, 0x0a18a3bf, 0xfc77912c },
        { 0x1554982b, 0xdef33645, 0x0d3942bd, 0x09efe312, 0xfc8f0bc1 },
        { 0x1782b68a, 0xdb50deb1, 0x0ebf676d, 0x09c6133f, 0xfca6f019 },
        { 0x19e8715d, 0xd74d64fd, 0x106fb999, 0x099b3337, 0xfcbf3cd6 },
        { 0x1c8b07b8, 0xd2df56ab, 0x124e6ec8, 0x096f4274, 0xfcd7f060 },
        { 0x1f702b6d, 0xcdfc6e92, 0x14601c10, 0x0942410b, 0xfcf108e5 },
        { 0x229e0933, 0xc89985cd, 0x16a9bcfa, 0x09142fb5, 0xfd0a8451 },
        { 0x261b5118, 0xc2aa8409, 0x1930bab6, 0x08e50fdc, 0xfd24604d },
        { 0x29ef3f5d, 0xbc224f28, 0x1bfaf396, 0x08b4e3aa, 0xfd3e9a3b },
        { 0x2e21a59b, 0xb4f2ba46, 0x1f0ec2d6, 0x0883ae15, 0xfd592f33 },
        { 0x32baf44b, 0xad0c7429, 0x227308a3, 0x085172eb, 0xfd741bfd },
        { 0x37c4448b, 0xa45ef51d, 0x262f3267, 0x081e36dc, 0xfd8f5d14 }
};

/* dB gain = (float) 20 * log10( float(db_table_value) / 0x8000000 ) */
static const u32 db_table[101] = {
        0x00000000, 0x01571f82, 0x01674b41, 0x01783a1b, 0x0189f540,
        0x019c8651, 0x01aff763, 0x01c45306, 0x01d9a446, 0x01eff6b8,
        0x0207567a, 0x021fd03d, 0x0239714c, 0x02544792, 0x027061a1,
        0x028dcebb, 0x02ac9edc, 0x02cce2bf, 0x02eeabe8, 0x03120cb0,
        0x0337184e, 0x035de2df, 0x03868173, 0x03b10a18, 0x03dd93e9,
        0x040c3713, 0x043d0cea, 0x04702ff3, 0x04a5bbf2, 0x04ddcdfb,
        0x0518847f, 0x0555ff62, 0x05966005, 0x05d9c95d, 0x06206005,
        0x066a4a52, 0x06b7b067, 0x0708bc4c, 0x075d9a01, 0x07b6779d,
        0x08138561, 0x0874f5d5, 0x08dafde1, 0x0945d4ed, 0x09b5b4fd,
        0x0a2adad1, 0x0aa58605, 0x0b25f936, 0x0bac7a24, 0x0c3951d8,
        0x0ccccccc, 0x0d673b17, 0x0e08f093, 0x0eb24510, 0x0f639481,
        0x101d3f2d, 0x10dfa9e6, 0x11ab3e3f, 0x12806ac3, 0x135fa333,
        0x144960c5, 0x153e2266, 0x163e6cfe, 0x174acbb7, 0x1863d04d,
        0x198a1357, 0x1abe349f, 0x1c00db77, 0x1d52b712, 0x1eb47ee6,
        0x2026f30f, 0x21aadcb6, 0x23410e7e, 0x24ea64f9, 0x26a7c71d,
        0x287a26c4, 0x2a62812c, 0x2c61df84, 0x2e795779, 0x30aa0bcf,
        0x32f52cfe, 0x355bf9d8, 0x37dfc033, 0x3a81dda4, 0x3d43c038,
        0x4026e73c, 0x432ce40f, 0x46575af8, 0x49a8040f, 0x4d20ac2a,
        0x50c335d3, 0x54919a57, 0x588dead1, 0x5cba514a, 0x611911ea,
        0x65ac8c2f, 0x6a773c39, 0x6f7bbc23, 0x74bcc56c, 0x7a3d3272,
        0x7fffffff,
};

/* EMU10k1/EMU10k2 DSP control db gain */
static const DECLARE_TLV_DB_SCALE(snd_emu10k1_db_scale1, -4000, 40, 1);
static const DECLARE_TLV_DB_LINEAR(snd_emu10k1_db_linear, TLV_DB_GAIN_MUTE, 0);

/* EMU10K1 bass/treble db gain */
static const DECLARE_TLV_DB_SCALE(snd_emu10k1_bass_treble_db_scale, -1200, 60, 0);

static const u32 onoff_table[2] = {
        0x00000000, 0x00000001
};

/*
 *   controls
 */

static int snd_emu10k1_gpr_ctl_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
{
        struct snd_emu10k1_fx8010_ctl *ctl =
                (struct snd_emu10k1_fx8010_ctl *) kcontrol->private_value;

        if (ctl->min == 0 && ctl->max == 1)
                uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
        else
                uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
        uinfo->count = ctl->vcount;
        uinfo->value.integer.min = ctl->min;
        uinfo->value.integer.max = ctl->max;
        return 0;
}

static int snd_emu10k1_gpr_ctl_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
{
        struct snd_emu10k1 *emu = snd_kcontrol_chip(kcontrol);
        struct snd_emu10k1_fx8010_ctl *ctl =
                (struct snd_emu10k1_fx8010_ctl *) kcontrol->private_value;
        unsigned long flags;
        unsigned int i;
        
        spin_lock_irqsave(&emu->reg_lock, flags);
        for (i = 0; i < ctl->vcount; i++)
                ucontrol->value.integer.value[i] = ctl->value[i];
        spin_unlock_irqrestore(&emu->reg_lock, flags);
        return 0;
}

static int snd_emu10k1_gpr_ctl_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
{
        struct snd_emu10k1 *emu = snd_kcontrol_chip(kcontrol);
        struct snd_emu10k1_fx8010_ctl *ctl =
                (struct snd_emu10k1_fx8010_ctl *) kcontrol->private_value;
        unsigned long flags;
        unsigned int nval, val;
        unsigned int i, j;
        int change = 0;
        
        spin_lock_irqsave(&emu->reg_lock, flags);
        for (i = 0; i < ctl->vcount; i++) {
                nval = ucontrol->value.integer.value[i];
                if (nval < ctl->min)
                        nval = ctl->min;
                if (nval > ctl->max)
                        nval = ctl->max;
                if (nval != ctl->value[i])
                        change = 1;
                val = ctl->value[i] = nval;
                switch (ctl->translation) {
                case EMU10K1_GPR_TRANSLATION_NONE:
                        snd_emu10k1_ptr_write(emu, emu->gpr_base + ctl->gpr[i], 0, val);
                        break;
                case EMU10K1_GPR_TRANSLATION_TABLE100:
                        snd_emu10k1_ptr_write(emu, emu->gpr_base + ctl->gpr[i], 0, db_table[val]);
                        break;
                case EMU10K1_GPR_TRANSLATION_BASS:
                        if ((ctl->count % 5) != 0 || (ctl->count / 5) != ctl->vcount) {
                                change = -EIO;
                                goto __error;
                        }
                        for (j = 0; j < 5; j++)
                                snd_emu10k1_ptr_write(emu, emu->gpr_base + ctl->gpr[j * ctl->vcount + i], 0, bass_table[val][j]);
                        break;
                case EMU10K1_GPR_TRANSLATION_TREBLE:
                        if ((ctl->count % 5) != 0 || (ctl->count / 5) != ctl->vcount) {
                                change = -EIO;
                                goto __error;
                        }
                        for (j = 0; j < 5; j++)
                                snd_emu10k1_ptr_write(emu, emu->gpr_base + ctl->gpr[j * ctl->vcount + i], 0, treble_table[val][j]);
                        break;
                case EMU10K1_GPR_TRANSLATION_ONOFF:
                        snd_emu10k1_ptr_write(emu, emu->gpr_base + ctl->gpr[i], 0, onoff_table[val]);
                        break;
                }
        }
      __error:
        spin_unlock_irqrestore(&emu->reg_lock, flags);
        return change;
}

/*
 *   Interrupt handler
 */

static void snd_emu10k1_fx8010_interrupt(struct snd_emu10k1 *emu)
{
        struct snd_emu10k1_fx8010_irq *irq, *nirq;

        irq = emu->fx8010.irq_handlers;
        while (irq) {
                nirq = irq->next;       /* irq ptr can be removed from list */
                if (snd_emu10k1_ptr_read(emu, emu->gpr_base + irq->gpr_running, 0) & 0xffff0000) {
                        if (irq->handler)
                                irq->handler(emu, irq->private_data);
                        snd_emu10k1_ptr_write(emu, emu->gpr_base + irq->gpr_running, 0, 1);
                }
                irq = nirq;
        }
}

int snd_emu10k1_fx8010_register_irq_handler(struct snd_emu10k1 *emu,
                                            snd_fx8010_irq_handler_t *handler,
                                            unsigned char gpr_running,
                                            void *private_data,
                                            struct snd_emu10k1_fx8010_irq *irq)
{
        unsigned long flags;
        
        irq->handler = handler;
        irq->gpr_running = gpr_running;
        irq->private_data = private_data;
        irq->next = NULL;
        spin_lock_irqsave(&emu->fx8010.irq_lock, flags);
        if (emu->fx8010.irq_handlers == NULL) {
                emu->fx8010.irq_handlers = irq;
                emu->dsp_interrupt = snd_emu10k1_fx8010_interrupt;
                snd_emu10k1_intr_enable(emu, INTE_FXDSPENABLE);
        } else {
                irq->next = emu->fx8010.irq_handlers;
                emu->fx8010.irq_handlers = irq;
        }
        spin_unlock_irqrestore(&emu->fx8010.irq_lock, flags);
        return 0;
}

int snd_emu10k1_fx8010_unregister_irq_handler(struct snd_emu10k1 *emu,
                                              struct snd_emu10k1_fx8010_irq *irq)
{
        struct snd_emu10k1_fx8010_irq *tmp;
        unsigned long flags;
        
        spin_lock_irqsave(&emu->fx8010.irq_lock, flags);
        if ((tmp = emu->fx8010.irq_handlers) == irq) {
                emu->fx8010.irq_handlers = tmp->next;
                if (emu->fx8010.irq_handlers == NULL) {
                        snd_emu10k1_intr_disable(emu, INTE_FXDSPENABLE);
                        emu->dsp_interrupt = NULL;
                }
        } else {
                while (tmp && tmp->next != irq)
                        tmp = tmp->next;
                if (tmp)
                        tmp->next = tmp->next->next;
        }
        spin_unlock_irqrestore(&emu->fx8010.irq_lock, flags);
        return 0;
}

/*************************************************************************
 * EMU10K1 effect manager
 *************************************************************************/

static void snd_emu10k1_write_op(struct snd_emu10k1_fx8010_code *icode,
                                 unsigned int *ptr,
                                 u32 op, u32 r, u32 a, u32 x, u32 y)
{
        u_int32_t *code;
        if (snd_BUG_ON(*ptr >= 512))
                return;
        code = icode->code + (*ptr) * 2;
        set_bit(*ptr, icode->code_valid);
        code[0] = ((x & 0x3ff) << 10) | (y & 0x3ff);
        code[1] = ((op & 0x0f) << 20) | ((r & 0x3ff) << 10) | (a & 0x3ff);
        (*ptr)++;
}

#define OP(icode, ptr, op, r, a, x, y) \
        snd_emu10k1_write_op(icode, ptr, op, r, a, x, y)

static void snd_emu10k1_audigy_write_op(struct snd_emu10k1_fx8010_code *icode,
                                        unsigned int *ptr,
                                        u32 op, u32 r, u32 a, u32 x, u32 y)
{
        u_int32_t *code;
        if (snd_BUG_ON(*ptr >= 1024))
                return;
        code = icode->code + (*ptr) * 2;
        set_bit(*ptr, icode->code_valid);
        code[0] = ((x & 0x7ff) << 12) | (y & 0x7ff);
        code[1] = ((op & 0x0f) << 24) | ((r & 0x7ff) << 12) | (a & 0x7ff);
        (*ptr)++;
}

#define A_OP(icode, ptr, op, r, a, x, y) \
        snd_emu10k1_audigy_write_op(icode, ptr, op, r, a, x, y)

static void snd_emu10k1_efx_write(struct snd_emu10k1 *emu, unsigned int pc, unsigned int data)
{
        pc += emu->audigy ? A_MICROCODEBASE : MICROCODEBASE;
        snd_emu10k1_ptr_write(emu, pc, 0, data);
}

unsigned int snd_emu10k1_efx_read(struct snd_emu10k1 *emu, unsigned int pc)
{
        pc += emu->audigy ? A_MICROCODEBASE : MICROCODEBASE;
        return snd_emu10k1_ptr_read(emu, pc, 0);
}

static int snd_emu10k1_gpr_poke(struct snd_emu10k1 *emu,
                                struct snd_emu10k1_fx8010_code *icode,
                                bool in_kernel)
{
        int gpr;
        u32 val;

        for (gpr = 0; gpr < (emu->audigy ? 0x200 : 0x100); gpr++) {
                if (!test_bit(gpr, icode->gpr_valid))
                        continue;
                if (in_kernel)
                        val = icode->gpr_map[gpr];
                else if (get_user(val, (__user u32 *)&icode->gpr_map[gpr]))
                        return -EFAULT;
                snd_emu10k1_ptr_write(emu, emu->gpr_base + gpr, 0, val);
        }
        return 0;
}

static int snd_emu10k1_gpr_peek(struct snd_emu10k1 *emu,
                                struct snd_emu10k1_fx8010_code *icode)
{
        int gpr;
        u32 val;

        for (gpr = 0; gpr < (emu->audigy ? 0x200 : 0x100); gpr++) {
                set_bit(gpr, icode->gpr_valid);
                val = snd_emu10k1_ptr_read(emu, emu->gpr_base + gpr, 0);
                if (put_user(val, (__user u32 *)&icode->gpr_map[gpr]))
                        return -EFAULT;
        }
        return 0;
}

static int snd_emu10k1_tram_poke(struct snd_emu10k1 *emu,
                                 struct snd_emu10k1_fx8010_code *icode,
                                 bool in_kernel)
{
        int tram;
        u32 addr, val;

        for (tram = 0; tram < (emu->audigy ? 0x100 : 0xa0); tram++) {
                if (!test_bit(tram, icode->tram_valid))
                        continue;
                if (in_kernel) {
                        val = icode->tram_data_map[tram];
                        addr = icode->tram_addr_map[tram];
                } else {
                        if (get_user(val, (__user __u32 *)&icode->tram_data_map[tram]) ||
                            get_user(addr, (__user __u32 *)&icode->tram_addr_map[tram]))
                                return -EFAULT;
                }
                snd_emu10k1_ptr_write(emu, TANKMEMDATAREGBASE + tram, 0, val);
                if (!emu->audigy) {
                        snd_emu10k1_ptr_write(emu, TANKMEMADDRREGBASE + tram, 0, addr);
                } else {
                        snd_emu10k1_ptr_write(emu, TANKMEMADDRREGBASE + tram, 0, addr << 12);
                        snd_emu10k1_ptr_write(emu, A_TANKMEMCTLREGBASE + tram, 0, addr >> 20);
                }
        }
        return 0;
}

static int snd_emu10k1_tram_peek(struct snd_emu10k1 *emu,
                                 struct snd_emu10k1_fx8010_code *icode)
{
        int tram;
        u32 val, addr;

        memset(icode->tram_valid, 0, sizeof(icode->tram_valid));
        for (tram = 0; tram < (emu->audigy ? 0x100 : 0xa0); tram++) {
                set_bit(tram, icode->tram_valid);
                val = snd_emu10k1_ptr_read(emu, TANKMEMDATAREGBASE + tram, 0);
                if (!emu->audigy) {
                        addr = snd_emu10k1_ptr_read(emu, TANKMEMADDRREGBASE + tram, 0);
                } else {
                        addr = snd_emu10k1_ptr_read(emu, TANKMEMADDRREGBASE + tram, 0) >> 12;
                        addr |= snd_emu10k1_ptr_read(emu, A_TANKMEMCTLREGBASE + tram, 0) << 20;
                }
                if (put_user(val, (__user u32 *)&icode->tram_data_map[tram]) ||
                    put_user(addr, (__user u32 *)&icode->tram_addr_map[tram]))
                        return -EFAULT;
        }
        return 0;
}

static int snd_emu10k1_code_poke(struct snd_emu10k1 *emu,
                                 struct snd_emu10k1_fx8010_code *icode,
                                 bool in_kernel)
{
        u32 pc, lo, hi;

        for (pc = 0; pc < (emu->audigy ? 2*1024 : 2*512); pc += 2) {
                if (!test_bit(pc / 2, icode->code_valid))
                        continue;
                if (in_kernel) {
                        lo = icode->code[pc + 0];
                        hi = icode->code[pc + 1];
                } else {
                        if (get_user(lo, (__user u32 *)&icode->code[pc + 0]) ||
                            get_user(hi, (__user u32 *)&icode->code[pc + 1]))
                                return -EFAULT;
                }
                snd_emu10k1_efx_write(emu, pc + 0, lo);
                snd_emu10k1_efx_write(emu, pc + 1, hi);
        }
        return 0;
}

static int snd_emu10k1_code_peek(struct snd_emu10k1 *emu,
                                 struct snd_emu10k1_fx8010_code *icode)
{
        u32 pc;

        memset(icode->code_valid, 0, sizeof(icode->code_valid));
        for (pc = 0; pc < (emu->audigy ? 2*1024 : 2*512); pc += 2) {
                set_bit(pc / 2, icode->code_valid);
                if (put_user(snd_emu10k1_efx_read(emu, pc + 0),
                             (__user u32 *)&icode->code[pc + 0]))
                        return -EFAULT;
                if (put_user(snd_emu10k1_efx_read(emu, pc + 1),
                             (__user u32 *)&icode->code[pc + 1]))
                        return -EFAULT;
        }
        return 0;
}

static struct snd_emu10k1_fx8010_ctl *
snd_emu10k1_look_for_ctl(struct snd_emu10k1 *emu,
                         struct emu10k1_ctl_elem_id *_id)
{
        struct snd_ctl_elem_id *id = (struct snd_ctl_elem_id *)_id;
        struct snd_emu10k1_fx8010_ctl *ctl;
        struct snd_kcontrol *kcontrol;

        list_for_each_entry(ctl, &emu->fx8010.gpr_ctl, list) {
                kcontrol = ctl->kcontrol;
                if (kcontrol->id.iface == id->iface &&
                    !strcmp(kcontrol->id.name, id->name) &&
                    kcontrol->id.index == id->index)
                        return ctl;
        }
        return NULL;
}

#define MAX_TLV_SIZE    256

static unsigned int *copy_tlv(const unsigned int __user *_tlv, bool in_kernel)
{
        unsigned int data[2];
        unsigned int *tlv;

        if (!_tlv)
                return NULL;
        if (in_kernel)
                memcpy(data, (__force void *)_tlv, sizeof(data));
        else if (copy_from_user(data, _tlv, sizeof(data)))
                return NULL;
        if (data[1] >= MAX_TLV_SIZE)
                return NULL;
        tlv = kmalloc(data[1] + sizeof(data), GFP_KERNEL);
        if (!tlv)
                return NULL;
        memcpy(tlv, data, sizeof(data));
        if (in_kernel) {
                memcpy(tlv + 2, (__force void *)(_tlv + 2),  data[1]);
        } else if (copy_from_user(tlv + 2, _tlv + 2, data[1])) {
                kfree(tlv);
                return NULL;
        }
        return tlv;
}

static int copy_gctl(struct snd_emu10k1 *emu,
                     struct snd_emu10k1_fx8010_control_gpr *dst,
                     struct snd_emu10k1_fx8010_control_gpr *src,
                     int idx, bool in_kernel)
{
        struct snd_emu10k1_fx8010_control_gpr __user *_src;
        struct snd_emu10k1_fx8010_control_old_gpr *octl;
        struct snd_emu10k1_fx8010_control_old_gpr __user *_octl;

        _src = (struct snd_emu10k1_fx8010_control_gpr __user *)src;
        if (emu->support_tlv) {
                if (in_kernel)
                        *dst = src[idx];
                else if (copy_from_user(dst, &_src[idx], sizeof(*src)))
                        return -EFAULT;
                return 0;
        }

        octl = (struct snd_emu10k1_fx8010_control_old_gpr *)src;
        _octl = (struct snd_emu10k1_fx8010_control_old_gpr __user *)octl;
        if (in_kernel)
                memcpy(dst, &octl[idx], sizeof(*octl));
        else if (copy_from_user(dst, &_octl[idx], sizeof(*octl)))
                return -EFAULT;
        dst->tlv = NULL;
        return 0;
}

static int copy_gctl_to_user(struct snd_emu10k1 *emu,
                     struct snd_emu10k1_fx8010_control_gpr *dst,
                     struct snd_emu10k1_fx8010_control_gpr *src,
                     int idx)
{
        struct snd_emu10k1_fx8010_control_gpr __user *_dst;
        struct snd_emu10k1_fx8010_control_old_gpr __user *octl;

        _dst = (struct snd_emu10k1_fx8010_control_gpr __user *)dst;
        if (emu->support_tlv)
                return copy_to_user(&_dst[idx], src, sizeof(*src));
        
        octl = (struct snd_emu10k1_fx8010_control_old_gpr __user *)dst;
        return copy_to_user(&octl[idx], src, sizeof(*octl));
}

static int copy_ctl_elem_id(const struct emu10k1_ctl_elem_id *list, int i,
                            struct emu10k1_ctl_elem_id *ret, bool in_kernel)
{
        struct emu10k1_ctl_elem_id __user *_id =
                (struct emu10k1_ctl_elem_id __user *)&list[i];

        if (in_kernel)
                *ret = list[i];
        else if (copy_from_user(ret, _id, sizeof(*ret)))
                return -EFAULT;
        return 0;
}

static int snd_emu10k1_verify_controls(struct snd_emu10k1 *emu,
                                       struct snd_emu10k1_fx8010_code *icode,
                                       bool in_kernel)
{
        unsigned int i;
        struct emu10k1_ctl_elem_id id;
        struct snd_emu10k1_fx8010_control_gpr *gctl;
        struct snd_ctl_elem_id *gctl_id;
        int err;
        
        for (i = 0; i < icode->gpr_del_control_count; i++) {
                err = copy_ctl_elem_id(icode->gpr_del_controls, i, &id,
                                       in_kernel);
                if (err < 0)
                        return err;
                if (snd_emu10k1_look_for_ctl(emu, &id) == NULL)
                        return -ENOENT;
        }
        gctl = kmalloc(sizeof(*gctl), GFP_KERNEL);
        if (! gctl)
                return -ENOMEM;
        err = 0;
        for (i = 0; i < icode->gpr_add_control_count; i++) {
                if (copy_gctl(emu, gctl, icode->gpr_add_controls, i,
                              in_kernel)) {
                        err = -EFAULT;
                        goto __error;
                }
                if (snd_emu10k1_look_for_ctl(emu, &gctl->id))
                        continue;
                gctl_id = (struct snd_ctl_elem_id *)&gctl->id;
                down_read(&emu->card->controls_rwsem);
                if (snd_ctl_find_id(emu->card, gctl_id)) {
                        up_read(&emu->card->controls_rwsem);
                        err = -EEXIST;
                        goto __error;
                }
                up_read(&emu->card->controls_rwsem);
                if (gctl_id->iface != SNDRV_CTL_ELEM_IFACE_MIXER &&
                    gctl_id->iface != SNDRV_CTL_ELEM_IFACE_PCM) {
                        err = -EINVAL;
                        goto __error;
                }
        }
        for (i = 0; i < icode->gpr_list_control_count; i++) {
                /* FIXME: we need to check the WRITE access */
                if (copy_gctl(emu, gctl, icode->gpr_list_controls, i,
                              in_kernel)) {
                        err = -EFAULT;
                        goto __error;
                }
        }
 __error:
        kfree(gctl);
        return err;
}

static void snd_emu10k1_ctl_private_free(struct snd_kcontrol *kctl)
{
        struct snd_emu10k1_fx8010_ctl *ctl;
        
        ctl = (struct snd_emu10k1_fx8010_ctl *) kctl->private_value;
        kctl->private_value = 0;
        list_del(&ctl->list);
        kfree(ctl);
        kfree(kctl->tlv.p);
}

static int snd_emu10k1_add_controls(struct snd_emu10k1 *emu,
                                    struct snd_emu10k1_fx8010_code *icode,
                                    bool in_kernel)
{
        unsigned int i, j;
        struct snd_emu10k1_fx8010_control_gpr *gctl;
        struct snd_ctl_elem_id *gctl_id;
        struct snd_emu10k1_fx8010_ctl *ctl, *nctl;
        struct snd_kcontrol_new knew;
        struct snd_kcontrol *kctl;
        struct snd_ctl_elem_value *val;
        int err = 0;

        val = kmalloc(sizeof(*val), GFP_KERNEL);
        gctl = kmalloc(sizeof(*gctl), GFP_KERNEL);
        nctl = kmalloc(sizeof(*nctl), GFP_KERNEL);
        if (!val || !gctl || !nctl) {
                err = -ENOMEM;
                goto __error;
        }

        for (i = 0; i < icode->gpr_add_control_count; i++) {
                if (copy_gctl(emu, gctl, icode->gpr_add_controls, i,
                              in_kernel)) {
                        err = -EFAULT;
                        goto __error;
                }
                gctl_id = (struct snd_ctl_elem_id *)&gctl->id;
                if (gctl_id->iface != SNDRV_CTL_ELEM_IFACE_MIXER &&
                    gctl_id->iface != SNDRV_CTL_ELEM_IFACE_PCM) {
                        err = -EINVAL;
                        goto __error;
                }
                if (!*gctl_id->name) {
                        err = -EINVAL;
                        goto __error;
                }
                ctl = snd_emu10k1_look_for_ctl(emu, &gctl->id);
                memset(&knew, 0, sizeof(knew));
                knew.iface = gctl_id->iface;
                knew.name = gctl_id->name;
                knew.index = gctl_id->index;
                knew.device = gctl_id->device;
                knew.subdevice = gctl_id->subdevice;
                knew.info = snd_emu10k1_gpr_ctl_info;
                knew.tlv.p = copy_tlv((const unsigned int __user *)gctl->tlv, in_kernel);
                if (knew.tlv.p)
                        knew.access = SNDRV_CTL_ELEM_ACCESS_READWRITE |
                                SNDRV_CTL_ELEM_ACCESS_TLV_READ;
                knew.get = snd_emu10k1_gpr_ctl_get;
                knew.put = snd_emu10k1_gpr_ctl_put;
                memset(nctl, 0, sizeof(*nctl));
                nctl->vcount = gctl->vcount;
                nctl->count = gctl->count;
                for (j = 0; j < 32; j++) {
                        nctl->gpr[j] = gctl->gpr[j];
                        nctl->value[j] = ~gctl->value[j];       /* inverted, we want to write new value in gpr_ctl_put() */
                        val->value.integer.value[j] = gctl->value[j];
                }
                nctl->min = gctl->min;
                nctl->max = gctl->max;
                nctl->translation = gctl->translation;
                if (ctl == NULL) {
                        ctl = kmalloc(sizeof(*ctl), GFP_KERNEL);
                        if (ctl == NULL) {
                                err = -ENOMEM;
                                kfree(knew.tlv.p);
                                goto __error;
                        }
                        knew.private_value = (unsigned long)ctl;
                        *ctl = *nctl;
                        if ((err = snd_ctl_add(emu->card, kctl = snd_ctl_new1(&knew, emu))) < 0) {
                                kfree(ctl);
                                kfree(knew.tlv.p);
                                goto __error;
                        }
                        kctl->private_free = snd_emu10k1_ctl_private_free;
                        ctl->kcontrol = kctl;
                        list_add_tail(&ctl->list, &emu->fx8010.gpr_ctl);
                } else {
                        /* overwrite */
                        nctl->list = ctl->list;
                        nctl->kcontrol = ctl->kcontrol;
                        *ctl = *nctl;
                        snd_ctl_notify(emu->card, SNDRV_CTL_EVENT_MASK_VALUE |
                                                  SNDRV_CTL_EVENT_MASK_INFO, &ctl->kcontrol->id);
                }
                snd_emu10k1_gpr_ctl_put(ctl->kcontrol, val);
        }
      __error:
        kfree(nctl);
        kfree(gctl);
        kfree(val);
        return err;
}

static int snd_emu10k1_del_controls(struct snd_emu10k1 *emu,
                                    struct snd_emu10k1_fx8010_code *icode,
                                    bool in_kernel)
{
        unsigned int i;
        struct emu10k1_ctl_elem_id id;
        struct snd_emu10k1_fx8010_ctl *ctl;
        struct snd_card *card = emu->card;
        int err;
        
        for (i = 0; i < icode->gpr_del_control_count; i++) {
                err = copy_ctl_elem_id(icode->gpr_del_controls, i, &id,
                                       in_kernel);
                if (err < 0)
                        return err;
                down_write(&card->controls_rwsem);
                ctl = snd_emu10k1_look_for_ctl(emu, &id);
                if (ctl)
                        snd_ctl_remove(card, ctl->kcontrol);
                up_write(&card->controls_rwsem);
        }
        return 0;
}

static int snd_emu10k1_list_controls(struct snd_emu10k1 *emu,
                                     struct snd_emu10k1_fx8010_code *icode)
{
        unsigned int i = 0, j;
        unsigned int total = 0;
        struct snd_emu10k1_fx8010_control_gpr *gctl;
        struct snd_emu10k1_fx8010_ctl *ctl;
        struct snd_ctl_elem_id *id;

        gctl = kmalloc(sizeof(*gctl), GFP_KERNEL);
        if (! gctl)
                return -ENOMEM;

        list_for_each_entry(ctl, &emu->fx8010.gpr_ctl, list) {
                total++;
                if (icode->gpr_list_controls &&
                    i < icode->gpr_list_control_count) {
                        memset(gctl, 0, sizeof(*gctl));
                        id = &ctl->kcontrol->id;
                        gctl->id.iface = (__force int)id->iface;
                        strlcpy(gctl->id.name, id->name, sizeof(gctl->id.name));
                        gctl->id.index = id->index;
                        gctl->id.device = id->device;
                        gctl->id.subdevice = id->subdevice;
                        gctl->vcount = ctl->vcount;
                        gctl->count = ctl->count;
                        for (j = 0; j < 32; j++) {
                                gctl->gpr[j] = ctl->gpr[j];
                                gctl->value[j] = ctl->value[j];
                        }
                        gctl->min = ctl->min;
                        gctl->max = ctl->max;
                        gctl->translation = ctl->translation;
                        if (copy_gctl_to_user(emu, icode->gpr_list_controls,
                                              gctl, i)) {
                                kfree(gctl);
                                return -EFAULT;
                        }
                        i++;
                }
        }
        icode->gpr_list_control_total = total;
        kfree(gctl);
        return 0;
}

static int snd_emu10k1_icode_poke(struct snd_emu10k1 *emu,
                                  struct snd_emu10k1_fx8010_code *icode,
                                  bool in_kernel)
{
        int err = 0;

        mutex_lock(&emu->fx8010.lock);
        err = snd_emu10k1_verify_controls(emu, icode, in_kernel);
        if (err < 0)
                goto __error;
        strlcpy(emu->fx8010.name, icode->name, sizeof(emu->fx8010.name));
        /* stop FX processor - this may be dangerous, but it's better to miss
           some samples than generate wrong ones - [jk] */
        if (emu->audigy)
                snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg | A_DBG_SINGLE_STEP);
        else
                snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg | EMU10K1_DBG_SINGLE_STEP);
        /* ok, do the main job */
        err = snd_emu10k1_del_controls(emu, icode, in_kernel);
        if (err < 0)
                goto __error;
        err = snd_emu10k1_gpr_poke(emu, icode, in_kernel);
        if (err < 0)
                goto __error;
        err = snd_emu10k1_tram_poke(emu, icode, in_kernel);
        if (err < 0)
                goto __error;
        err = snd_emu10k1_code_poke(emu, icode, in_kernel);
        if (err < 0)
                goto __error;
        err = snd_emu10k1_add_controls(emu, icode, in_kernel);
        if (err < 0)

                goto __error;
        /* start FX processor when the DSP code is updated */
        if (emu->audigy)
                snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg);
        else
                snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg);
      __error:
        mutex_unlock(&emu->fx8010.lock);
        return err;
}

static int snd_emu10k1_icode_peek(struct snd_emu10k1 *emu,
                                  struct snd_emu10k1_fx8010_code *icode)
{
        int err;

        mutex_lock(&emu->fx8010.lock);
        strlcpy(icode->name, emu->fx8010.name, sizeof(icode->name));
        /* ok, do the main job */
        err = snd_emu10k1_gpr_peek(emu, icode);
        if (err >= 0)
                err = snd_emu10k1_tram_peek(emu, icode);
        if (err >= 0)
                err = snd_emu10k1_code_peek(emu, icode);
        if (err >= 0)
                err = snd_emu10k1_list_controls(emu, icode);
        mutex_unlock(&emu->fx8010.lock);
        return err;
}

static int snd_emu10k1_ipcm_poke(struct snd_emu10k1 *emu,
                                 struct snd_emu10k1_fx8010_pcm_rec *ipcm)
{
        unsigned int i;
        int err = 0;
        struct snd_emu10k1_fx8010_pcm *pcm;

        if (ipcm->substream >= EMU10K1_FX8010_PCM_COUNT)
                return -EINVAL;
        ipcm->substream = array_index_nospec(ipcm->substream,
                                             EMU10K1_FX8010_PCM_COUNT);
        if (ipcm->channels > 32)
                return -EINVAL;
        pcm = &emu->fx8010.pcm[ipcm->substream];
        mutex_lock(&emu->fx8010.lock);
        spin_lock_irq(&emu->reg_lock);
        if (pcm->opened) {
                err = -EBUSY;
                goto __error;
        }
        if (ipcm->channels == 0) {      /* remove */
                pcm->valid = 0;
        } else {
                /* FIXME: we need to add universal code to the PCM transfer routine */
                if (ipcm->channels != 2) {
                        err = -EINVAL;
                        goto __error;
                }
                pcm->valid = 1;
                pcm->opened = 0;
                pcm->channels = ipcm->channels;
                pcm->tram_start = ipcm->tram_start;
                pcm->buffer_size = ipcm->buffer_size;
                pcm->gpr_size = ipcm->gpr_size;
                pcm->gpr_count = ipcm->gpr_count;
                pcm->gpr_tmpcount = ipcm->gpr_tmpcount;
                pcm->gpr_ptr = ipcm->gpr_ptr;
                pcm->gpr_trigger = ipcm->gpr_trigger;
                pcm->gpr_running = ipcm->gpr_running;
                for (i = 0; i < pcm->channels; i++)
                        pcm->etram[i] = ipcm->etram[i];
        }
      __error:
        spin_unlock_irq(&emu->reg_lock);
        mutex_unlock(&emu->fx8010.lock);
        return err;
}

static int snd_emu10k1_ipcm_peek(struct snd_emu10k1 *emu,
                                 struct snd_emu10k1_fx8010_pcm_rec *ipcm)
{
        unsigned int i;
        int err = 0;
        struct snd_emu10k1_fx8010_pcm *pcm;

        if (ipcm->substream >= EMU10K1_FX8010_PCM_COUNT)
                return -EINVAL;
        ipcm->substream = array_index_nospec(ipcm->substream,
                                             EMU10K1_FX8010_PCM_COUNT);
        pcm = &emu->fx8010.pcm[ipcm->substream];
        mutex_lock(&emu->fx8010.lock);
        spin_lock_irq(&emu->reg_lock);
        ipcm->channels = pcm->channels;
        ipcm->tram_start = pcm->tram_start;
        ipcm->buffer_size = pcm->buffer_size;
        ipcm->gpr_size = pcm->gpr_size;
        ipcm->gpr_ptr = pcm->gpr_ptr;
        ipcm->gpr_count = pcm->gpr_count;
        ipcm->gpr_tmpcount = pcm->gpr_tmpcount;
        ipcm->gpr_trigger = pcm->gpr_trigger;
        ipcm->gpr_running = pcm->gpr_running;
        for (i = 0; i < pcm->channels; i++)
                ipcm->etram[i] = pcm->etram[i];
        ipcm->res1 = ipcm->res2 = 0;
        ipcm->pad = 0;
        spin_unlock_irq(&emu->reg_lock);
        mutex_unlock(&emu->fx8010.lock);
        return err;
}

#define SND_EMU10K1_GPR_CONTROLS        44
#define SND_EMU10K1_INPUTS              12
#define SND_EMU10K1_PLAYBACK_CHANNELS   8
#define SND_EMU10K1_CAPTURE_CHANNELS    4

static void
snd_emu10k1_init_mono_control(struct snd_emu10k1_fx8010_control_gpr *ctl,
                              const char *name, int gpr, int defval)
{
        ctl->id.iface = (__force int)SNDRV_CTL_ELEM_IFACE_MIXER;
        strcpy(ctl->id.name, name);
        ctl->vcount = ctl->count = 1;
        ctl->gpr[0] = gpr + 0; ctl->value[0] = defval;
        if (high_res_gpr_volume) {
                ctl->min = 0;
                ctl->max = 0x7fffffff;
                ctl->tlv = snd_emu10k1_db_linear;
                ctl->translation = EMU10K1_GPR_TRANSLATION_NONE;
        } else {
                ctl->min = 0;
                ctl->max = 100;
                ctl->tlv = snd_emu10k1_db_scale1;
                ctl->translation = EMU10K1_GPR_TRANSLATION_TABLE100;
        }
}

static void
snd_emu10k1_init_stereo_control(struct snd_emu10k1_fx8010_control_gpr *ctl,
                                const char *name, int gpr, int defval)
{
        ctl->id.iface = (__force int)SNDRV_CTL_ELEM_IFACE_MIXER;
        strcpy(ctl->id.name, name);
        ctl->vcount = ctl->count = 2;
        ctl->gpr[0] = gpr + 0; ctl->value[0] = defval;
        ctl->gpr[1] = gpr + 1; ctl->value[1] = defval;
        if (high_res_gpr_volume) {
                ctl->min = 0;
                ctl->max = 0x7fffffff;
                ctl->tlv = snd_emu10k1_db_linear;
                ctl->translation = EMU10K1_GPR_TRANSLATION_NONE;
        } else {
                ctl->min = 0;
                ctl->max = 100;
                ctl->tlv = snd_emu10k1_db_scale1;
                ctl->translation = EMU10K1_GPR_TRANSLATION_TABLE100;
        }
}

static void
snd_emu10k1_init_mono_onoff_control(struct snd_emu10k1_fx8010_control_gpr *ctl,
                                    const char *name, int gpr, int defval)
{
        ctl->id.iface = (__force int)SNDRV_CTL_ELEM_IFACE_MIXER;
        strcpy(ctl->id.name, name);
        ctl->vcount = ctl->count = 1;
        ctl->gpr[0] = gpr + 0; ctl->value[0] = defval;
        ctl->min = 0;
        ctl->max = 1;
        ctl->translation = EMU10K1_GPR_TRANSLATION_ONOFF;
}

static void
snd_emu10k1_init_stereo_onoff_control(struct snd_emu10k1_fx8010_control_gpr *ctl,
                                      const char *name, int gpr, int defval)
{
        ctl->id.iface = (__force int)SNDRV_CTL_ELEM_IFACE_MIXER;
        strcpy(ctl->id.name, name);
        ctl->vcount = ctl->count = 2;
        ctl->gpr[0] = gpr + 0; ctl->value[0] = defval;
        ctl->gpr[1] = gpr + 1; ctl->value[1] = defval;
        ctl->min = 0;
        ctl->max = 1;
        ctl->translation = EMU10K1_GPR_TRANSLATION_ONOFF;
}

/*
 * Used for emu1010 - conversion from 32-bit capture inputs from HANA
 * to 2 x 16-bit registers in audigy - their values are read via DMA.
 * Conversion is performed by Audigy DSP instructions of FX8010.
 */
static int snd_emu10k1_audigy_dsp_convert_32_to_2x16(
                                struct snd_emu10k1_fx8010_code *icode,
                                u32 *ptr, int tmp, int bit_shifter16,
                                int reg_in, int reg_out)
{
        A_OP(icode, ptr, iACC3, A_GPR(tmp + 1), reg_in, A_C_00000000, A_C_00000000);
        A_OP(icode, ptr, iANDXOR, A_GPR(tmp), A_GPR(tmp + 1), A_GPR(bit_shifter16 - 1), A_C_00000000);
        A_OP(icode, ptr, iTSTNEG, A_GPR(tmp + 2), A_GPR(tmp), A_C_80000000, A_GPR(bit_shifter16 - 2));
        A_OP(icode, ptr, iANDXOR, A_GPR(tmp + 2), A_GPR(tmp + 2), A_C_80000000, A_C_00000000);
        A_OP(icode, ptr, iANDXOR, A_GPR(tmp), A_GPR(tmp), A_GPR(bit_shifter16 - 3), A_C_00000000);
        A_OP(icode, ptr, iMACINT0, A_GPR(tmp), A_C_00000000, A_GPR(tmp), A_C_00010000);
        A_OP(icode, ptr, iANDXOR, reg_out, A_GPR(tmp), A_C_ffffffff, A_GPR(tmp + 2));
        A_OP(icode, ptr, iACC3, reg_out + 1, A_GPR(tmp + 1), A_C_00000000, A_C_00000000);
        return 1;
}

/*
 * initial DSP configuration for Audigy
 */

static int _snd_emu10k1_audigy_init_efx(struct snd_emu10k1 *emu)
{
        int err, i, z, gpr, nctl;
        int bit_shifter16;
        const int playback = 10;
        const int capture = playback + (SND_EMU10K1_PLAYBACK_CHANNELS * 2); /* we reserve 10 voices */
        const int stereo_mix = capture + 2;
        const int tmp = 0x88;
        u32 ptr;
        struct snd_emu10k1_fx8010_code *icode = NULL;
        struct snd_emu10k1_fx8010_control_gpr *controls = NULL, *ctl;
        u32 *gpr_map;

        err = -ENOMEM;
        icode = kzalloc(sizeof(*icode), GFP_KERNEL);
        if (!icode)
                return err;

        icode->gpr_map = kcalloc(512 + 256 + 256 + 2 * 1024,
                                 sizeof(u_int32_t), GFP_KERNEL);
        if (!icode->gpr_map)
                goto __err_gpr;
        controls = kcalloc(SND_EMU10K1_GPR_CONTROLS,
                           sizeof(*controls), GFP_KERNEL);
        if (!controls)
                goto __err_ctrls;

        gpr_map = icode->gpr_map;

        icode->tram_data_map = icode->gpr_map + 512;
        icode->tram_addr_map = icode->tram_data_map + 256;
        icode->code = icode->tram_addr_map + 256;

        /* clear free GPRs */
        for (i = 0; i < 512; i++)
                set_bit(i, icode->gpr_valid);
                
        /* clear TRAM data & address lines */
        for (i = 0; i < 256; i++)
                set_bit(i, icode->tram_valid);

        strcpy(icode->name, "Audigy DSP code for ALSA");
        ptr = 0;
        nctl = 0;
        gpr = stereo_mix + 10;
        gpr_map[gpr++] = 0x00007fff;
        gpr_map[gpr++] = 0x00008000;
        gpr_map[gpr++] = 0x0000ffff;
        bit_shifter16 = gpr;

        /* stop FX processor */
        snd_emu10k1_ptr_write(emu, A_DBG, 0, (emu->fx8010.dbg = 0) | A_DBG_SINGLE_STEP);

#if 1
        /* PCM front Playback Volume (independent from stereo mix)
         * playback = 0 + ( gpr * FXBUS_PCM_LEFT_FRONT >> 31)
         * where gpr contains attenuation from corresponding mixer control
         * (snd_emu10k1_init_stereo_control)
         */
        A_OP(icode, &ptr, iMAC0, A_GPR(playback), A_C_00000000, A_GPR(gpr), A_FXBUS(FXBUS_PCM_LEFT_FRONT));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+1), A_C_00000000, A_GPR(gpr+1), A_FXBUS(FXBUS_PCM_RIGHT_FRONT));
        snd_emu10k1_init_stereo_control(&controls[nctl++], "PCM Front Playback Volume", gpr, 100);
        gpr += 2;

        /* PCM Surround Playback (independent from stereo mix) */
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+2), A_C_00000000, A_GPR(gpr), A_FXBUS(FXBUS_PCM_LEFT_REAR));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+3), A_C_00000000, A_GPR(gpr+1), A_FXBUS(FXBUS_PCM_RIGHT_REAR));
        snd_emu10k1_init_stereo_control(&controls[nctl++], "PCM Surround Playback Volume", gpr, 100);
        gpr += 2;
        
        /* PCM Side Playback (independent from stereo mix) */
        if (emu->card_capabilities->spk71) {
                A_OP(icode, &ptr, iMAC0, A_GPR(playback+6), A_C_00000000, A_GPR(gpr), A_FXBUS(FXBUS_PCM_LEFT_SIDE));
                A_OP(icode, &ptr, iMAC0, A_GPR(playback+7), A_C_00000000, A_GPR(gpr+1), A_FXBUS(FXBUS_PCM_RIGHT_SIDE));
                snd_emu10k1_init_stereo_control(&controls[nctl++], "PCM Side Playback Volume", gpr, 100);
                gpr += 2;
        }

        /* PCM Center Playback (independent from stereo mix) */
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+4), A_C_00000000, A_GPR(gpr), A_FXBUS(FXBUS_PCM_CENTER));
        snd_emu10k1_init_mono_control(&controls[nctl++], "PCM Center Playback Volume", gpr, 100);
        gpr++;

        /* PCM LFE Playback (independent from stereo mix) */
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+5), A_C_00000000, A_GPR(gpr), A_FXBUS(FXBUS_PCM_LFE));
        snd_emu10k1_init_mono_control(&controls[nctl++], "PCM LFE Playback Volume", gpr, 100);
        gpr++;
        
        /*
         * Stereo Mix
         */
        /* Wave (PCM) Playback Volume (will be renamed later) */
        A_OP(icode, &ptr, iMAC0, A_GPR(stereo_mix), A_C_00000000, A_GPR(gpr), A_FXBUS(FXBUS_PCM_LEFT));
        A_OP(icode, &ptr, iMAC0, A_GPR(stereo_mix+1), A_C_00000000, A_GPR(gpr+1), A_FXBUS(FXBUS_PCM_RIGHT));
        snd_emu10k1_init_stereo_control(&controls[nctl++], "Wave Playback Volume", gpr, 100);
        gpr += 2;

        /* Synth Playback */
        A_OP(icode, &ptr, iMAC0, A_GPR(stereo_mix+0), A_GPR(stereo_mix+0), A_GPR(gpr), A_FXBUS(FXBUS_MIDI_LEFT));
        A_OP(icode, &ptr, iMAC0, A_GPR(stereo_mix+1), A_GPR(stereo_mix+1), A_GPR(gpr+1), A_FXBUS(FXBUS_MIDI_RIGHT));
        snd_emu10k1_init_stereo_control(&controls[nctl++], "Synth Playback Volume", gpr, 100);
        gpr += 2;

        /* Wave (PCM) Capture */
        A_OP(icode, &ptr, iMAC0, A_GPR(capture+0), A_C_00000000, A_GPR(gpr), A_FXBUS(FXBUS_PCM_LEFT));
        A_OP(icode, &ptr, iMAC0, A_GPR(capture+1), A_C_00000000, A_GPR(gpr+1), A_FXBUS(FXBUS_PCM_RIGHT));
        snd_emu10k1_init_stereo_control(&controls[nctl++], "PCM Capture Volume", gpr, 0);
        gpr += 2;

        /* Synth Capture */
        A_OP(icode, &ptr, iMAC0, A_GPR(capture+0), A_GPR(capture+0), A_GPR(gpr), A_FXBUS(FXBUS_MIDI_LEFT));
        A_OP(icode, &ptr, iMAC0, A_GPR(capture+1), A_GPR(capture+1), A_GPR(gpr+1), A_FXBUS(FXBUS_MIDI_RIGHT));
        snd_emu10k1_init_stereo_control(&controls[nctl++], "Synth Capture Volume", gpr, 0);
        gpr += 2;
      
        /*
         * inputs
         */
#define A_ADD_VOLUME_IN(var,vol,input) \
A_OP(icode, &ptr, iMAC0, A_GPR(var), A_GPR(var), A_GPR(vol), A_EXTIN(input))

        /* emu1212 DSP 0 and DSP 1 Capture */
        if (emu->card_capabilities->emu_model) {
                if (emu->card_capabilities->ca0108_chip) {
                        /* Note:JCD:No longer bit shift lower 16bits to upper 16bits of 32bit value. */
                        A_OP(icode, &ptr, iMACINT0, A_GPR(tmp), A_C_00000000, A3_EMU32IN(0x0), A_C_00000001);
                        A_OP(icode, &ptr, iMAC0, A_GPR(capture+0), A_GPR(capture+0), A_GPR(gpr), A_GPR(tmp));
                        A_OP(icode, &ptr, iMACINT0, A_GPR(tmp), A_C_00000000, A3_EMU32IN(0x1), A_C_00000001);
                        A_OP(icode, &ptr, iMAC0, A_GPR(capture+1), A_GPR(capture+1), A_GPR(gpr), A_GPR(tmp));
                } else {
                        A_OP(icode, &ptr, iMAC0, A_GPR(capture+0), A_GPR(capture+0), A_GPR(gpr), A_P16VIN(0x0));
                        A_OP(icode, &ptr, iMAC0, A_GPR(capture+1), A_GPR(capture+1), A_GPR(gpr+1), A_P16VIN(0x1));
                }
                snd_emu10k1_init_stereo_control(&controls[nctl++], "EMU Capture Volume", gpr, 0);
                gpr += 2;
        }
        /* AC'97 Playback Volume - used only for mic (renamed later) */
        A_ADD_VOLUME_IN(stereo_mix, gpr, A_EXTIN_AC97_L);
        A_ADD_VOLUME_IN(stereo_mix+1, gpr+1, A_EXTIN_AC97_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++], "AMic Playback Volume", gpr, 0);
        gpr += 2;
        /* AC'97 Capture Volume - used only for mic */
        A_ADD_VOLUME_IN(capture, gpr, A_EXTIN_AC97_L);
        A_ADD_VOLUME_IN(capture+1, gpr+1, A_EXTIN_AC97_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++], "Mic Capture Volume", gpr, 0);
        gpr += 2;

        /* mic capture buffer */        
        A_OP(icode, &ptr, iINTERP, A_EXTOUT(A_EXTOUT_MIC_CAP), A_EXTIN(A_EXTIN_AC97_L), 0xcd, A_EXTIN(A_EXTIN_AC97_R));

        /* Audigy CD Playback Volume */
        A_ADD_VOLUME_IN(stereo_mix, gpr, A_EXTIN_SPDIF_CD_L);
        A_ADD_VOLUME_IN(stereo_mix+1, gpr+1, A_EXTIN_SPDIF_CD_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++],
                                        emu->card_capabilities->ac97_chip ? "Audigy CD Playback Volume" : "CD Playback Volume",
                                        gpr, 0);
        gpr += 2;
        /* Audigy CD Capture Volume */
        A_ADD_VOLUME_IN(capture, gpr, A_EXTIN_SPDIF_CD_L);
        A_ADD_VOLUME_IN(capture+1, gpr+1, A_EXTIN_SPDIF_CD_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++],
                                        emu->card_capabilities->ac97_chip ? "Audigy CD Capture Volume" : "CD Capture Volume",
                                        gpr, 0);
        gpr += 2;

        /* Optical SPDIF Playback Volume */
        A_ADD_VOLUME_IN(stereo_mix, gpr, A_EXTIN_OPT_SPDIF_L);
        A_ADD_VOLUME_IN(stereo_mix+1, gpr+1, A_EXTIN_OPT_SPDIF_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++], SNDRV_CTL_NAME_IEC958("Optical ",PLAYBACK,VOLUME), gpr, 0);
        gpr += 2;
        /* Optical SPDIF Capture Volume */
        A_ADD_VOLUME_IN(capture, gpr, A_EXTIN_OPT_SPDIF_L);
        A_ADD_VOLUME_IN(capture+1, gpr+1, A_EXTIN_OPT_SPDIF_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++], SNDRV_CTL_NAME_IEC958("Optical ",CAPTURE,VOLUME), gpr, 0);
        gpr += 2;

        /* Line2 Playback Volume */
        A_ADD_VOLUME_IN(stereo_mix, gpr, A_EXTIN_LINE2_L);
        A_ADD_VOLUME_IN(stereo_mix+1, gpr+1, A_EXTIN_LINE2_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++],
                                        emu->card_capabilities->ac97_chip ? "Line2 Playback Volume" : "Line Playback Volume",
                                        gpr, 0);
        gpr += 2;
        /* Line2 Capture Volume */
        A_ADD_VOLUME_IN(capture, gpr, A_EXTIN_LINE2_L);
        A_ADD_VOLUME_IN(capture+1, gpr+1, A_EXTIN_LINE2_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++],
                                        emu->card_capabilities->ac97_chip ? "Line2 Capture Volume" : "Line Capture Volume",
                                        gpr, 0);
        gpr += 2;
        
        /* Philips ADC Playback Volume */
        A_ADD_VOLUME_IN(stereo_mix, gpr, A_EXTIN_ADC_L);
        A_ADD_VOLUME_IN(stereo_mix+1, gpr+1, A_EXTIN_ADC_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++], "Analog Mix Playback Volume", gpr, 0);
        gpr += 2;
        /* Philips ADC Capture Volume */
        A_ADD_VOLUME_IN(capture, gpr, A_EXTIN_ADC_L);
        A_ADD_VOLUME_IN(capture+1, gpr+1, A_EXTIN_ADC_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++], "Analog Mix Capture Volume", gpr, 0);
        gpr += 2;

        /* Aux2 Playback Volume */
        A_ADD_VOLUME_IN(stereo_mix, gpr, A_EXTIN_AUX2_L);
        A_ADD_VOLUME_IN(stereo_mix+1, gpr+1, A_EXTIN_AUX2_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++],
                                        emu->card_capabilities->ac97_chip ? "Aux2 Playback Volume" : "Aux Playback Volume",
                                        gpr, 0);
        gpr += 2;
        /* Aux2 Capture Volume */
        A_ADD_VOLUME_IN(capture, gpr, A_EXTIN_AUX2_L);
        A_ADD_VOLUME_IN(capture+1, gpr+1, A_EXTIN_AUX2_R);
        snd_emu10k1_init_stereo_control(&controls[nctl++],
                                        emu->card_capabilities->ac97_chip ? "Aux2 Capture Volume" : "Aux Capture Volume",
                                        gpr, 0);
        gpr += 2;
        
        /* Stereo Mix Front Playback Volume */
        A_OP(icode, &ptr, iMAC0, A_GPR(playback), A_GPR(playback), A_GPR(gpr), A_GPR(stereo_mix));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+1), A_GPR(playback+1), A_GPR(gpr+1), A_GPR(stereo_mix+1));
        snd_emu10k1_init_stereo_control(&controls[nctl++], "Front Playback Volume", gpr, 100);
        gpr += 2;
        
        /* Stereo Mix Surround Playback */
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+2), A_GPR(playback+2), A_GPR(gpr), A_GPR(stereo_mix));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+3), A_GPR(playback+3), A_GPR(gpr+1), A_GPR(stereo_mix+1));
        snd_emu10k1_init_stereo_control(&controls[nctl++], "Surround Playback Volume", gpr, 0);
        gpr += 2;

        /* Stereo Mix Center Playback */
        /* Center = sub = Left/2 + Right/2 */
        A_OP(icode, &ptr, iINTERP, A_GPR(tmp), A_GPR(stereo_mix), 0xcd, A_GPR(stereo_mix+1));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+4), A_GPR(playback+4), A_GPR(gpr), A_GPR(tmp));
        snd_emu10k1_init_mono_control(&controls[nctl++], "Center Playback Volume", gpr, 0);
        gpr++;

        /* Stereo Mix LFE Playback */
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+5), A_GPR(playback+5), A_GPR(gpr), A_GPR(tmp));
        snd_emu10k1_init_mono_control(&controls[nctl++], "LFE Playback Volume", gpr, 0);
        gpr++;
        
        if (emu->card_capabilities->spk71) {
                /* Stereo Mix Side Playback */
                A_OP(icode, &ptr, iMAC0, A_GPR(playback+6), A_GPR(playback+6), A_GPR(gpr), A_GPR(stereo_mix));
                A_OP(icode, &ptr, iMAC0, A_GPR(playback+7), A_GPR(playback+7), A_GPR(gpr+1), A_GPR(stereo_mix+1));
                snd_emu10k1_init_stereo_control(&controls[nctl++], "Side Playback Volume", gpr, 0);
                gpr += 2;
        }

        /*
         * outputs
         */
#define A_PUT_OUTPUT(out,src) A_OP(icode, &ptr, iACC3, A_EXTOUT(out), A_C_00000000, A_C_00000000, A_GPR(src))
#define A_PUT_STEREO_OUTPUT(out1,out2,src) \
        {A_PUT_OUTPUT(out1,src); A_PUT_OUTPUT(out2,src+1);}

#define _A_SWITCH(icode, ptr, dst, src, sw) \
        A_OP((icode), ptr, iMACINT0, dst, A_C_00000000, src, sw);
#define A_SWITCH(icode, ptr, dst, src, sw) \
                _A_SWITCH(icode, ptr, A_GPR(dst), A_GPR(src), A_GPR(sw))
#define _A_SWITCH_NEG(icode, ptr, dst, src) \
        A_OP((icode), ptr, iANDXOR, dst, src, A_C_00000001, A_C_00000001);
#define A_SWITCH_NEG(icode, ptr, dst, src) \
                _A_SWITCH_NEG(icode, ptr, A_GPR(dst), A_GPR(src))


        /*
         *  Process tone control
         */
        A_OP(icode, &ptr, iACC3, A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 0), A_GPR(playback + 0), A_C_00000000, A_C_00000000); /* left */
        A_OP(icode, &ptr, iACC3, A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 1), A_GPR(playback + 1), A_C_00000000, A_C_00000000); /* right */
        A_OP(icode, &ptr, iACC3, A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 2), A_GPR(playback + 2), A_C_00000000, A_C_00000000); /* rear left */
        A_OP(icode, &ptr, iACC3, A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 3), A_GPR(playback + 3), A_C_00000000, A_C_00000000); /* rear right */
        A_OP(icode, &ptr, iACC3, A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 4), A_GPR(playback + 4), A_C_00000000, A_C_00000000); /* center */
        A_OP(icode, &ptr, iACC3, A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 5), A_GPR(playback + 5), A_C_00000000, A_C_00000000); /* LFE */
        if (emu->card_capabilities->spk71) {
                A_OP(icode, &ptr, iACC3, A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 6), A_GPR(playback + 6), A_C_00000000, A_C_00000000); /* side left */
                A_OP(icode, &ptr, iACC3, A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 7), A_GPR(playback + 7), A_C_00000000, A_C_00000000); /* side right */
        }
        

        ctl = &controls[nctl + 0];
        ctl->id.iface = (__force int)SNDRV_CTL_ELEM_IFACE_MIXER;
        strcpy(ctl->id.name, "Tone Control - Bass");
        ctl->vcount = 2;
        ctl->count = 10;
        ctl->min = 0;
        ctl->max = 40;
        ctl->value[0] = ctl->value[1] = 20;
        ctl->translation = EMU10K1_GPR_TRANSLATION_BASS;
        ctl = &controls[nctl + 1];
        ctl->id.iface = (__force int)SNDRV_CTL_ELEM_IFACE_MIXER;
        strcpy(ctl->id.name, "Tone Control - Treble");
        ctl->vcount = 2;
        ctl->count = 10;
        ctl->min = 0;
        ctl->max = 40;
        ctl->value[0] = ctl->value[1] = 20;
        ctl->translation = EMU10K1_GPR_TRANSLATION_TREBLE;

#define BASS_GPR        0x8c
#define TREBLE_GPR      0x96

        for (z = 0; z < 5; z++) {
                int j;
                for (j = 0; j < 2; j++) {
                        controls[nctl + 0].gpr[z * 2 + j] = BASS_GPR + z * 2 + j;
                        controls[nctl + 1].gpr[z * 2 + j] = TREBLE_GPR + z * 2 + j;
                }
        }
        for (z = 0; z < 4; z++) {               /* front/rear/center-lfe/side */
                int j, k, l, d;
                for (j = 0; j < 2; j++) {       /* left/right */
                        k = 0xb0 + (z * 8) + (j * 4);
                        l = 0xe0 + (z * 8) + (j * 4);
                        d = playback + SND_EMU10K1_PLAYBACK_CHANNELS + z * 2 + j;

                        A_OP(icode, &ptr, iMAC0, A_C_00000000, A_C_00000000, A_GPR(d), A_GPR(BASS_GPR + 0 + j));
                        A_OP(icode, &ptr, iMACMV, A_GPR(k+1), A_GPR(k), A_GPR(k+1), A_GPR(BASS_GPR + 4 + j));
                        A_OP(icode, &ptr, iMACMV, A_GPR(k), A_GPR(d), A_GPR(k), A_GPR(BASS_GPR + 2 + j));
                        A_OP(icode, &ptr, iMACMV, A_GPR(k+3), A_GPR(k+2), A_GPR(k+3), A_GPR(BASS_GPR + 8 + j));
                        A_OP(icode, &ptr, iMAC0, A_GPR(k+2), A_GPR_ACCU, A_GPR(k+2), A_GPR(BASS_GPR + 6 + j));
                        A_OP(icode, &ptr, iACC3, A_GPR(k+2), A_GPR(k+2), A_GPR(k+2), A_C_00000000);

                        A_OP(icode, &ptr, iMAC0, A_C_00000000, A_C_00000000, A_GPR(k+2), A_GPR(TREBLE_GPR + 0 + j));
                        A_OP(icode, &ptr, iMACMV, A_GPR(l+1), A_GPR(l), A_GPR(l+1), A_GPR(TREBLE_GPR + 4 + j));
                        A_OP(icode, &ptr, iMACMV, A_GPR(l), A_GPR(k+2), A_GPR(l), A_GPR(TREBLE_GPR + 2 + j));
                        A_OP(icode, &ptr, iMACMV, A_GPR(l+3), A_GPR(l+2), A_GPR(l+3), A_GPR(TREBLE_GPR + 8 + j));
                        A_OP(icode, &ptr, iMAC0, A_GPR(l+2), A_GPR_ACCU, A_GPR(l+2), A_GPR(TREBLE_GPR + 6 + j));
                        A_OP(icode, &ptr, iMACINT0, A_GPR(l+2), A_C_00000000, A_GPR(l+2), A_C_00000010);

                        A_OP(icode, &ptr, iACC3, A_GPR(d), A_GPR(l+2), A_C_00000000, A_C_00000000);

                        if (z == 2)     /* center */
                                break;
                }
        }
        nctl += 2;

#undef BASS_GPR
#undef TREBLE_GPR

        for (z = 0; z < 8; z++) {
                A_SWITCH(icode, &ptr, tmp + 0, playback + SND_EMU10K1_PLAYBACK_CHANNELS + z, gpr + 0);
                A_SWITCH_NEG(icode, &ptr, tmp + 1, gpr + 0);
                A_SWITCH(icode, &ptr, tmp + 1, playback + z, tmp + 1);
                A_OP(icode, &ptr, iACC3, A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + z), A_GPR(tmp + 0), A_GPR(tmp + 1), A_C_00000000);
        }
        snd_emu10k1_init_stereo_onoff_control(controls + nctl++, "Tone Control - Switch", gpr, 0);
        gpr += 2;

        /* Master volume (will be renamed later) */
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+0+SND_EMU10K1_PLAYBACK_CHANNELS), A_C_00000000, A_GPR(gpr), A_GPR(playback+0+SND_EMU10K1_PLAYBACK_CHANNELS));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+1+SND_EMU10K1_PLAYBACK_CHANNELS), A_C_00000000, A_GPR(gpr), A_GPR(playback+1+SND_EMU10K1_PLAYBACK_CHANNELS));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+2+SND_EMU10K1_PLAYBACK_CHANNELS), A_C_00000000, A_GPR(gpr), A_GPR(playback+2+SND_EMU10K1_PLAYBACK_CHANNELS));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+3+SND_EMU10K1_PLAYBACK_CHANNELS), A_C_00000000, A_GPR(gpr), A_GPR(playback+3+SND_EMU10K1_PLAYBACK_CHANNELS));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+4+SND_EMU10K1_PLAYBACK_CHANNELS), A_C_00000000, A_GPR(gpr), A_GPR(playback+4+SND_EMU10K1_PLAYBACK_CHANNELS));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+5+SND_EMU10K1_PLAYBACK_CHANNELS), A_C_00000000, A_GPR(gpr), A_GPR(playback+5+SND_EMU10K1_PLAYBACK_CHANNELS));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+6+SND_EMU10K1_PLAYBACK_CHANNELS), A_C_00000000, A_GPR(gpr), A_GPR(playback+6+SND_EMU10K1_PLAYBACK_CHANNELS));
        A_OP(icode, &ptr, iMAC0, A_GPR(playback+7+SND_EMU10K1_PLAYBACK_CHANNELS), A_C_00000000, A_GPR(gpr), A_GPR(playback+7+SND_EMU10K1_PLAYBACK_CHANNELS));
        snd_emu10k1_init_mono_control(&controls[nctl++], "Wave Master Playback Volume", gpr, 0);
        gpr += 2;

        /* analog speakers */
        A_PUT_STEREO_OUTPUT(A_EXTOUT_AFRONT_L, A_EXTOUT_AFRONT_R, playback + SND_EMU10K1_PLAYBACK_CHANNELS);
        A_PUT_STEREO_OUTPUT(A_EXTOUT_AREAR_L, A_EXTOUT_AREAR_R, playback+2 + SND_EMU10K1_PLAYBACK_CHANNELS);
        A_PUT_OUTPUT(A_EXTOUT_ACENTER, playback+4 + SND_EMU10K1_PLAYBACK_CHANNELS);
        A_PUT_OUTPUT(A_EXTOUT_ALFE, playback+5 + SND_EMU10K1_PLAYBACK_CHANNELS);
        if (emu->card_capabilities->spk71)
                A_PUT_STEREO_OUTPUT(A_EXTOUT_ASIDE_L, A_EXTOUT_ASIDE_R, playback+6 + SND_EMU10K1_PLAYBACK_CHANNELS);

        /* headphone */
        A_PUT_STEREO_OUTPUT(A_EXTOUT_HEADPHONE_L, A_EXTOUT_HEADPHONE_R, playback + SND_EMU10K1_PLAYBACK_CHANNELS);

        /* digital outputs */
        /* A_PUT_STEREO_OUTPUT(A_EXTOUT_FRONT_L, A_EXTOUT_FRONT_R, playback + SND_EMU10K1_PLAYBACK_CHANNELS); */
        if (emu->card_capabilities->emu_model) {
                /* EMU1010 Outputs from PCM Front, Rear, Center, LFE, Side */
                dev_info(emu->card->dev, "EMU outputs on\n");
                for (z = 0; z < 8; z++) {
                        if (emu->card_capabilities->ca0108_chip) {
                                A_OP(icode, &ptr, iACC3, A3_EMU32OUT(z), A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + z), A_C_00000000, A_C_00000000);
                        } else {
                                A_OP(icode, &ptr, iACC3, A_EMU32OUTL(z), A_GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + z), A_C_00000000, A_C_00000000);
                        }
                }
        }

        /* IEC958 Optical Raw Playback Switch */ 
        gpr_map[gpr++] = 0;
        gpr_map[gpr++] = 0x1008;
        gpr_map[gpr++] = 0xffff0000;
        for (z = 0; z < 2; z++) {
                A_OP(icode, &ptr, iMAC0, A_GPR(tmp + 2), A_FXBUS(FXBUS_PT_LEFT + z), A_C_00000000, A_C_00000000);
                A_OP(icode, &ptr, iSKIP, A_GPR_COND, A_GPR_COND, A_GPR(gpr - 2), A_C_00000001);
                A_OP(icode, &ptr, iACC3, A_GPR(tmp + 2), A_C_00000000, A_C_00010000, A_GPR(tmp + 2));
                A_OP(icode, &ptr, iANDXOR, A_GPR(tmp + 2), A_GPR(tmp + 2), A_GPR(gpr - 1), A_C_00000000);
                A_SWITCH(icode, &ptr, tmp + 0, tmp + 2, gpr + z);
                A_SWITCH_NEG(icode, &ptr, tmp + 1, gpr + z);
                A_SWITCH(icode, &ptr, tmp + 1, playback + SND_EMU10K1_PLAYBACK_CHANNELS + z, tmp + 1);
                if ((z==1) && (emu->card_capabilities->spdif_bug)) {
                        /* Due to a SPDIF output bug on some Audigy cards, this code delays the Right channel by 1 sample */
                        dev_info(emu->card->dev,
                                 "Installing spdif_bug patch: %s\n",
                                 emu->card_capabilities->name);
                        A_OP(icode, &ptr, iACC3, A_EXTOUT(A_EXTOUT_FRONT_L + z), A_GPR(gpr - 3), A_C_00000000, A_C_00000000);
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 3), A_GPR(tmp + 0), A_GPR(tmp + 1), A_C_00000000);
                } else {
                        A_OP(icode, &ptr, iACC3, A_EXTOUT(A_EXTOUT_FRONT_L + z), A_GPR(tmp + 0), A_GPR(tmp + 1), A_C_00000000);
                }
        }
        snd_emu10k1_init_stereo_onoff_control(controls + nctl++, SNDRV_CTL_NAME_IEC958("Optical Raw ",PLAYBACK,SWITCH), gpr, 0);
        gpr += 2;
        
        A_PUT_STEREO_OUTPUT(A_EXTOUT_REAR_L, A_EXTOUT_REAR_R, playback+2 + SND_EMU10K1_PLAYBACK_CHANNELS);
        A_PUT_OUTPUT(A_EXTOUT_CENTER, playback+4 + SND_EMU10K1_PLAYBACK_CHANNELS);
        A_PUT_OUTPUT(A_EXTOUT_LFE, playback+5 + SND_EMU10K1_PLAYBACK_CHANNELS);

        /* ADC buffer */
#ifdef EMU10K1_CAPTURE_DIGITAL_OUT
        A_PUT_STEREO_OUTPUT(A_EXTOUT_ADC_CAP_L, A_EXTOUT_ADC_CAP_R, playback + SND_EMU10K1_PLAYBACK_CHANNELS);
#else
        A_PUT_OUTPUT(A_EXTOUT_ADC_CAP_L, capture);
        A_PUT_OUTPUT(A_EXTOUT_ADC_CAP_R, capture+1);
#endif

        if (emu->card_capabilities->emu_model) {
                if (emu->card_capabilities->ca0108_chip) {
                        dev_info(emu->card->dev, "EMU2 inputs on\n");
                        for (z = 0; z < 0x10; z++) {
                                snd_emu10k1_audigy_dsp_convert_32_to_2x16( icode, &ptr, tmp, 
                                                                        bit_shifter16,
                                                                        A3_EMU32IN(z),
                                                                        A_FXBUS2(z*2) );
                        }
                } else {
                        dev_info(emu->card->dev, "EMU inputs on\n");
                        /* Capture 16 (originally 8) channels of S32_LE sound */

                        /*
                        dev_dbg(emu->card->dev, "emufx.c: gpr=0x%x, tmp=0x%x\n",
                               gpr, tmp);
                        */
                        /* For the EMU1010: How to get 32bit values from the DSP. High 16bits into L, low 16bits into R. */
                        /* A_P16VIN(0) is delayed by one sample,
                         * so all other A_P16VIN channels will need to also be delayed
                         */
                        /* Left ADC in. 1 of 2 */
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16( icode, &ptr, tmp, bit_shifter16, A_P16VIN(0x0), A_FXBUS2(0) );
                        /* Right ADC in 1 of 2 */
                        gpr_map[gpr++] = 0x00000000;
                        /* Delaying by one sample: instead of copying the input
                         * value A_P16VIN to output A_FXBUS2 as in the first channel,
                         * we use an auxiliary register, delaying the value by one
                         * sample
                         */
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16( icode, &ptr, tmp, bit_shifter16, A_GPR(gpr - 1), A_FXBUS2(2) );
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0x1), A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16( icode, &ptr, tmp, bit_shifter16, A_GPR(gpr - 1), A_FXBUS2(4) );
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0x2), A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16( icode, &ptr, tmp, bit_shifter16, A_GPR(gpr - 1), A_FXBUS2(6) );
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0x3), A_C_00000000, A_C_00000000);
                        /* For 96kHz mode */
                        /* Left ADC in. 2 of 2 */
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16( icode, &ptr, tmp, bit_shifter16, A_GPR(gpr - 1), A_FXBUS2(0x8) );
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0x4), A_C_00000000, A_C_00000000);
                        /* Right ADC in 2 of 2 */
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16( icode, &ptr, tmp, bit_shifter16, A_GPR(gpr - 1), A_FXBUS2(0xa) );
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0x5), A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16( icode, &ptr, tmp, bit_shifter16, A_GPR(gpr - 1), A_FXBUS2(0xc) );
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0x6), A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16( icode, &ptr, tmp, bit_shifter16, A_GPR(gpr - 1), A_FXBUS2(0xe) );
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0x7), A_C_00000000, A_C_00000000);
                        /* Pavel Hofman - we still have voices, A_FXBUS2s, and
                         * A_P16VINs available -
                         * let's add 8 more capture channels - total of 16
                         */
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16(icode, &ptr, tmp,
                                                                  bit_shifter16,
                                                                  A_GPR(gpr - 1),
                                                                  A_FXBUS2(0x10));
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0x8),
                             A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16(icode, &ptr, tmp,
                                                                  bit_shifter16,
                                                                  A_GPR(gpr - 1),
                                                                  A_FXBUS2(0x12));
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0x9),
                             A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16(icode, &ptr, tmp,
                                                                  bit_shifter16,
                                                                  A_GPR(gpr - 1),
                                                                  A_FXBUS2(0x14));
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0xa),
                             A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16(icode, &ptr, tmp,
                                                                  bit_shifter16,
                                                                  A_GPR(gpr - 1),
                                                                  A_FXBUS2(0x16));
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0xb),
                             A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16(icode, &ptr, tmp,
                                                                  bit_shifter16,
                                                                  A_GPR(gpr - 1),
                                                                  A_FXBUS2(0x18));
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0xc),
                             A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16(icode, &ptr, tmp,
                                                                  bit_shifter16,
                                                                  A_GPR(gpr - 1),
                                                                  A_FXBUS2(0x1a));
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0xd),
                             A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16(icode, &ptr, tmp,
                                                                  bit_shifter16,
                                                                  A_GPR(gpr - 1),
                                                                  A_FXBUS2(0x1c));
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0xe),
                             A_C_00000000, A_C_00000000);
                        gpr_map[gpr++] = 0x00000000;
                        snd_emu10k1_audigy_dsp_convert_32_to_2x16(icode, &ptr, tmp,
                                                                  bit_shifter16,
                                                                  A_GPR(gpr - 1),
                                                                  A_FXBUS2(0x1e));
                        A_OP(icode, &ptr, iACC3, A_GPR(gpr - 1), A_P16VIN(0xf),
                             A_C_00000000, A_C_00000000);
                }

#if 0
                for (z = 4; z < 8; z++) {
                        A_OP(icode, &ptr, iACC3, A_FXBUS2(z), A_C_00000000, A_C_00000000, A_C_00000000);
                }
                for (z = 0xc; z < 0x10; z++) {
                        A_OP(icode, &ptr, iACC3, A_FXBUS2(z), A_C_00000000, A_C_00000000, A_C_00000000);
                }
#endif
        } else {
                /* EFX capture - capture the 16 EXTINs */
                /* Capture 16 channels of S16_LE sound */
                for (z = 0; z < 16; z++) {
                        A_OP(icode, &ptr, iACC3, A_FXBUS2(z), A_C_00000000, A_C_00000000, A_EXTIN(z));
                }
        }
        
#endif /* JCD test */
        /*
         * ok, set up done..
         */

        if (gpr > tmp) {
                snd_BUG();
                err = -EIO;
                goto __err;
        }
        /* clear remaining instruction memory */
        while (ptr < 0x400)
                A_OP(icode, &ptr, 0x0f, 0xc0, 0xc0, 0xcf, 0xc0);

        icode->gpr_add_control_count = nctl;
        icode->gpr_add_controls = controls;
        emu->support_tlv = 1; /* support TLV */
        err = snd_emu10k1_icode_poke(emu, icode, true);
        emu->support_tlv = 0; /* clear again */

__err:
        kfree(controls);
__err_ctrls:
        kfree(icode->gpr_map);
__err_gpr:
        kfree(icode);
        return err;
}


/*
 * initial DSP configuration for Emu10k1
 */

/* when volume = max, then copy only to avoid volume modification */
/* with iMAC0 (negative values) */
static void _volume(struct snd_emu10k1_fx8010_code *icode, u32 *ptr, u32 dst, u32 src, u32 vol)
{
        OP(icode, ptr, iMAC0, dst, C_00000000, src, vol);
        OP(icode, ptr, iANDXOR, C_00000000, vol, C_ffffffff, C_7fffffff);
        OP(icode, ptr, iSKIP, GPR_COND, GPR_COND, CC_REG_NONZERO, C_00000001);
        OP(icode, ptr, iACC3, dst, src, C_00000000, C_00000000);
}
static void _volume_add(struct snd_emu10k1_fx8010_code *icode, u32 *ptr, u32 dst, u32 src, u32 vol)
{
        OP(icode, ptr, iANDXOR, C_00000000, vol, C_ffffffff, C_7fffffff);
        OP(icode, ptr, iSKIP, GPR_COND, GPR_COND, CC_REG_NONZERO, C_00000002);
        OP(icode, ptr, iMACINT0, dst, dst, src, C_00000001);
        OP(icode, ptr, iSKIP, C_00000000, C_7fffffff, C_7fffffff, C_00000001);
        OP(icode, ptr, iMAC0, dst, dst, src, vol);
}
static void _volume_out(struct snd_emu10k1_fx8010_code *icode, u32 *ptr, u32 dst, u32 src, u32 vol)
{
        OP(icode, ptr, iANDXOR, C_00000000, vol, C_ffffffff, C_7fffffff);
        OP(icode, ptr, iSKIP, GPR_COND, GPR_COND, CC_REG_NONZERO, C_00000002);
        OP(icode, ptr, iACC3, dst, src, C_00000000, C_00000000);
        OP(icode, ptr, iSKIP, C_00000000, C_7fffffff, C_7fffffff, C_00000001);
        OP(icode, ptr, iMAC0, dst, C_00000000, src, vol);
}

#define VOLUME(icode, ptr, dst, src, vol) \
                _volume(icode, ptr, GPR(dst), GPR(src), GPR(vol))
#define VOLUME_IN(icode, ptr, dst, src, vol) \
                _volume(icode, ptr, GPR(dst), EXTIN(src), GPR(vol))
#define VOLUME_ADD(icode, ptr, dst, src, vol) \
                _volume_add(icode, ptr, GPR(dst), GPR(src), GPR(vol))
#define VOLUME_ADDIN(icode, ptr, dst, src, vol) \
                _volume_add(icode, ptr, GPR(dst), EXTIN(src), GPR(vol))
#define VOLUME_OUT(icode, ptr, dst, src, vol) \
                _volume_out(icode, ptr, EXTOUT(dst), GPR(src), GPR(vol))
#define _SWITCH(icode, ptr, dst, src, sw) \
        OP((icode), ptr, iMACINT0, dst, C_00000000, src, sw);
#define SWITCH(icode, ptr, dst, src, sw) \
                _SWITCH(icode, ptr, GPR(dst), GPR(src), GPR(sw))
#define SWITCH_IN(icode, ptr, dst, src, sw) \
                _SWITCH(icode, ptr, GPR(dst), EXTIN(src), GPR(sw))
#define _SWITCH_NEG(icode, ptr, dst, src) \
        OP((icode), ptr, iANDXOR, dst, src, C_00000001, C_00000001);
#define SWITCH_NEG(icode, ptr, dst, src) \
                _SWITCH_NEG(icode, ptr, GPR(dst), GPR(src))


static int _snd_emu10k1_init_efx(struct snd_emu10k1 *emu)
{
        int err, i, z, gpr, tmp, playback, capture;
        u32 ptr;
        struct snd_emu10k1_fx8010_code *icode;
        struct snd_emu10k1_fx8010_pcm_rec *ipcm = NULL;
        struct snd_emu10k1_fx8010_control_gpr *controls = NULL, *ctl;
        u32 *gpr_map;

        err = -ENOMEM;
        icode = kzalloc(sizeof(*icode), GFP_KERNEL);
        if (!icode)
                return err;

        icode->gpr_map = kcalloc(256 + 160 + 160 + 2 * 512,
                                 sizeof(u_int32_t), GFP_KERNEL);
        if (!icode->gpr_map)
                goto __err_gpr;

        controls = kcalloc(SND_EMU10K1_GPR_CONTROLS,
                           sizeof(struct snd_emu10k1_fx8010_control_gpr),
                           GFP_KERNEL);
        if (!controls)
                goto __err_ctrls;

        ipcm = kzalloc(sizeof(*ipcm), GFP_KERNEL);
        if (!ipcm)
                goto __err_ipcm;

        gpr_map = icode->gpr_map;

        icode->tram_data_map = icode->gpr_map + 256;
        icode->tram_addr_map = icode->tram_data_map + 160;
        icode->code = icode->tram_addr_map + 160;
        
        /* clear free GPRs */
        for (i = 0; i < 256; i++)
                set_bit(i, icode->gpr_valid);

        /* clear TRAM data & address lines */
        for (i = 0; i < 160; i++)
                set_bit(i, icode->tram_valid);

        strcpy(icode->name, "SB Live! FX8010 code for ALSA v1.2 by Jaroslav Kysela");
        ptr = 0; i = 0;
        /* we have 12 inputs */
        playback = SND_EMU10K1_INPUTS;
        /* we have 6 playback channels and tone control doubles */
        capture = playback + (SND_EMU10K1_PLAYBACK_CHANNELS * 2);
        gpr = capture + SND_EMU10K1_CAPTURE_CHANNELS;
        tmp = 0x88;     /* we need 4 temporary GPR */
        /* from 0x8c to 0xff is the area for tone control */

        /* stop FX processor */
        snd_emu10k1_ptr_write(emu, DBG, 0, (emu->fx8010.dbg = 0) | EMU10K1_DBG_SINGLE_STEP);

        /*
         *  Process FX Buses
         */
        OP(icode, &ptr, iMACINT0, GPR(0), C_00000000, FXBUS(FXBUS_PCM_LEFT), C_00000004);
        OP(icode, &ptr, iMACINT0, GPR(1), C_00000000, FXBUS(FXBUS_PCM_RIGHT), C_00000004);
        OP(icode, &ptr, iMACINT0, GPR(2), C_00000000, FXBUS(FXBUS_MIDI_LEFT), C_00000004);
        OP(icode, &ptr, iMACINT0, GPR(3), C_00000000, FXBUS(FXBUS_MIDI_RIGHT), C_00000004);
        OP(icode, &ptr, iMACINT0, GPR(4), C_00000000, FXBUS(FXBUS_PCM_LEFT_REAR), C_00000004);
        OP(icode, &ptr, iMACINT0, GPR(5), C_00000000, FXBUS(FXBUS_PCM_RIGHT_REAR), C_00000004);
        OP(icode, &ptr, iMACINT0, GPR(6), C_00000000, FXBUS(FXBUS_PCM_CENTER), C_00000004);
        OP(icode, &ptr, iMACINT0, GPR(7), C_00000000, FXBUS(FXBUS_PCM_LFE), C_00000004);
        OP(icode, &ptr, iMACINT0, GPR(8), C_00000000, C_00000000, C_00000000);  /* S/PDIF left */
        OP(icode, &ptr, iMACINT0, GPR(9), C_00000000, C_00000000, C_00000000);  /* S/PDIF right */
        OP(icode, &ptr, iMACINT0, GPR(10), C_00000000, FXBUS(FXBUS_PCM_LEFT_FRONT), C_00000004);
        OP(icode, &ptr, iMACINT0, GPR(11), C_00000000, FXBUS(FXBUS_PCM_RIGHT_FRONT), C_00000004);

        /* Raw S/PDIF PCM */
        ipcm->substream = 0;
        ipcm->channels = 2;
        ipcm->tram_start = 0;
        ipcm->buffer_size = (64 * 1024) / 2;
        ipcm->gpr_size = gpr++;
        ipcm->gpr_ptr = gpr++;
        ipcm->gpr_count = gpr++;
        ipcm->gpr_tmpcount = gpr++;
        ipcm->gpr_trigger = gpr++;
        ipcm->gpr_running = gpr++;
        ipcm->etram[0] = 0;
        ipcm->etram[1] = 1;

        gpr_map[gpr + 0] = 0xfffff000;
        gpr_map[gpr + 1] = 0xffff0000;
        gpr_map[gpr + 2] = 0x70000000;
        gpr_map[gpr + 3] = 0x00000007;
        gpr_map[gpr + 4] = 0x001f << 11;
        gpr_map[gpr + 5] = 0x001c << 11;
        gpr_map[gpr + 6] = (0x22  - 0x01) - 1;  /* skip at 01 to 22 */
        gpr_map[gpr + 7] = (0x22  - 0x06) - 1;  /* skip at 06 to 22 */
        gpr_map[gpr + 8] = 0x2000000 + (2<<11);
        gpr_map[gpr + 9] = 0x4000000 + (2<<11);
        gpr_map[gpr + 10] = 1<<11;
        gpr_map[gpr + 11] = (0x24 - 0x0a) - 1;  /* skip at 0a to 24 */
        gpr_map[gpr + 12] = 0;

        /* if the trigger flag is not set, skip */
        /* 00: */ OP(icode, &ptr, iMAC0, C_00000000, GPR(ipcm->gpr_trigger), C_00000000, C_00000000);
        /* 01: */ OP(icode, &ptr, iSKIP, GPR_COND, GPR_COND, CC_REG_ZERO, GPR(gpr + 6));
        /* if the running flag is set, we're running */
        /* 02: */ OP(icode, &ptr, iMAC0, C_00000000, GPR(ipcm->gpr_running), C_00000000, C_00000000);
        /* 03: */ OP(icode, &ptr, iSKIP, GPR_COND, GPR_COND, CC_REG_NONZERO, C_00000004);
        /* wait until ((GPR_DBAC>>11) & 0x1f) == 0x1c) */
        /* 04: */ OP(icode, &ptr, iANDXOR, GPR(tmp + 0), GPR_DBAC, GPR(gpr + 4), C_00000000);
        /* 05: */ OP(icode, &ptr, iMACINT0, C_00000000, GPR(tmp + 0), C_ffffffff, GPR(gpr + 5));
        /* 06: */ OP(icode, &ptr, iSKIP, GPR_COND, GPR_COND, CC_REG_NONZERO, GPR(gpr + 7));
        /* 07: */ OP(icode, &ptr, iACC3, GPR(gpr + 12), C_00000010, C_00000001, C_00000000);

        /* 08: */ OP(icode, &ptr, iANDXOR, GPR(ipcm->gpr_running), GPR(ipcm->gpr_running), C_00000000, C_00000001);
        /* 09: */ OP(icode, &ptr, iACC3, GPR(gpr + 12), GPR(gpr + 12), C_ffffffff, C_00000000);
        /* 0a: */ OP(icode, &ptr, iSKIP, GPR_COND, GPR_COND, CC_REG_NONZERO, GPR(gpr + 11));
        /* 0b: */ OP(icode, &ptr, iACC3, GPR(gpr + 12), C_00000001, C_00000000, C_00000000);

        /* 0c: */ OP(icode, &ptr, iANDXOR, GPR(tmp + 0), ETRAM_DATA(ipcm->etram[0]), GPR(gpr + 0), C_00000000);
        /* 0d: */ OP(icode, &ptr, iLOG, GPR(tmp + 0), GPR(tmp + 0), GPR(gpr + 3), C_00000000);
        /* 0e: */ OP(icode, &ptr, iANDXOR, GPR(8), GPR(tmp + 0), GPR(gpr + 1), GPR(gpr + 2));
        /* 0f: */ OP(icode, &ptr, iSKIP, C_00000000, GPR_COND, CC_REG_MINUS, C_00000001);
        /* 10: */ OP(icode, &ptr, iANDXOR, GPR(8), GPR(8), GPR(gpr + 1), GPR(gpr + 2));

        /* 11: */ OP(icode, &ptr, iANDXOR, GPR(tmp + 0), ETRAM_DATA(ipcm->etram[1]), GPR(gpr + 0), C_00000000);
        /* 12: */ OP(icode, &ptr, iLOG, GPR(tmp + 0), GPR(tmp + 0), GPR(gpr + 3), C_00000000);
        /* 13: */ OP(icode, &ptr, iANDXOR, GPR(9), GPR(tmp + 0), GPR(gpr + 1), GPR(gpr + 2));
        /* 14: */ OP(icode, &ptr, iSKIP, C_00000000, GPR_COND, CC_REG_MINUS, C_00000001);
        /* 15: */ OP(icode, &ptr, iANDXOR, GPR(9), GPR(9), GPR(gpr + 1), GPR(gpr + 2));

        /* 16: */ OP(icode, &ptr, iACC3, GPR(tmp + 0), GPR(ipcm->gpr_ptr), C_00000001, C_00000000);
        /* 17: */ OP(icode, &ptr, iMACINT0, C_00000000, GPR(tmp + 0), C_ffffffff, GPR(ipcm->gpr_size));
        /* 18: */ OP(icode, &ptr, iSKIP, GPR_COND, GPR_COND, CC_REG_MINUS, C_00000001);
        /* 19: */ OP(icode, &ptr, iACC3, GPR(tmp + 0), C_00000000, C_00000000, C_00000000);
        /* 1a: */ OP(icode, &ptr, iACC3, GPR(ipcm->gpr_ptr), GPR(tmp + 0), C_00000000, C_00000000);
        
        /* 1b: */ OP(icode, &ptr, iACC3, GPR(ipcm->gpr_tmpcount), GPR(ipcm->gpr_tmpcount), C_ffffffff, C_00000000);
        /* 1c: */ OP(icode, &ptr, iSKIP, GPR_COND, GPR_COND, CC_REG_NONZERO, C_00000002);
        /* 1d: */ OP(icode, &ptr, iACC3, GPR(ipcm->gpr_tmpcount), GPR(ipcm->gpr_count), C_00000000, C_00000000);
        /* 1e: */ OP(icode, &ptr, iACC3, GPR_IRQ, C_80000000, C_00000000, C_00000000);
        /* 1f: */ OP(icode, &ptr, iANDXOR, GPR(ipcm->gpr_running), GPR(ipcm->gpr_running), C_00000001, C_00010000);

        /* 20: */ OP(icode, &ptr, iANDXOR, GPR(ipcm->gpr_running), GPR(ipcm->gpr_running), C_00010000, C_00000001);
        /* 21: */ OP(icode, &ptr, iSKIP, C_00000000, C_7fffffff, C_7fffffff, C_00000002);

        /* 22: */ OP(icode, &ptr, iMACINT1, ETRAM_ADDR(ipcm->etram[0]), GPR(gpr + 8), GPR_DBAC, C_ffffffff);
        /* 23: */ OP(icode, &ptr, iMACINT1, ETRAM_ADDR(ipcm->etram[1]), GPR(gpr + 9), GPR_DBAC, C_ffffffff);

        /* 24: */
        gpr += 13;

        /* Wave Playback Volume */

        for (z = 0; z < 2; z++)
                VOLUME(icode, &ptr, playback + z, z, gpr + z);
        snd_emu10k1_init_stereo_control(controls + i++, "Wave Playback Volume", gpr, 100);
        gpr += 2;

        /* Wave Surround Playback Volume */
        for (z = 0; z < 2; z++)
                VOLUME(icode, &ptr, playback + 2 + z, z, gpr + z);
        snd_emu10k1_init_stereo_control(controls + i++, "Wave Surround Playback Volume", gpr, 0);
        gpr += 2;
        
        /* Wave Center/LFE Playback Volume */
        OP(icode, &ptr, iACC3, GPR(tmp + 0), FXBUS(FXBUS_PCM_LEFT), FXBUS(FXBUS_PCM_RIGHT), C_00000000);
        OP(icode, &ptr, iMACINT0, GPR(tmp + 0), C_00000000, GPR(tmp + 0), C_00000002);
        VOLUME(icode, &ptr, playback + 4, tmp + 0, gpr);
        snd_emu10k1_init_mono_control(controls + i++, "Wave Center Playback Volume", gpr++, 0);
        VOLUME(icode, &ptr, playback + 5, tmp + 0, gpr);
        snd_emu10k1_init_mono_control(controls + i++, "Wave LFE Playback Volume", gpr++, 0);

        /* Wave Capture Volume + Switch */
        for (z = 0; z < 2; z++) {
                SWITCH(icode, &ptr, tmp + 0, z, gpr + 2 + z);
                VOLUME(icode, &ptr, capture + z, tmp + 0, gpr + z);
        }
        snd_emu10k1_init_stereo_control(controls + i++, "Wave Capture Volume", gpr, 0);
        snd_emu10k1_init_stereo_onoff_control(controls + i++, "Wave Capture Switch", gpr + 2, 0);
        gpr += 4;

        /* Synth Playback Volume */
        for (z = 0; z < 2; z++)
                VOLUME_ADD(icode, &ptr, playback + z, 2 + z, gpr + z);
        snd_emu10k1_init_stereo_control(controls + i++, "Synth Playback Volume", gpr, 100);
        gpr += 2;

        /* Synth Capture Volume + Switch */
        for (z = 0; z < 2; z++) {
                SWITCH(icode, &ptr, tmp + 0, 2 + z, gpr + 2 + z);
                VOLUME_ADD(icode, &ptr, capture + z, tmp + 0, gpr + z);
        }
        snd_emu10k1_init_stereo_control(controls + i++, "Synth Capture Volume", gpr, 0);
        snd_emu10k1_init_stereo_onoff_control(controls + i++, "Synth Capture Switch", gpr + 2, 0);
        gpr += 4;

        /* Surround Digital Playback Volume (renamed later without Digital) */
        for (z = 0; z < 2; z++)
                VOLUME_ADD(icode, &ptr, playback + 2 + z, 4 + z, gpr + z);
        snd_emu10k1_init_stereo_control(controls + i++, "Surround Digital Playback Volume", gpr, 100);
        gpr += 2;

        /* Surround Capture Volume + Switch */
        for (z = 0; z < 2; z++) {
                SWITCH(icode, &ptr, tmp + 0, 4 + z, gpr + 2 + z);
                VOLUME_ADD(icode, &ptr, capture + z, tmp + 0, gpr + z);
        }
        snd_emu10k1_init_stereo_control(controls + i++, "Surround Capture Volume", gpr, 0);
        snd_emu10k1_init_stereo_onoff_control(controls + i++, "Surround Capture Switch", gpr + 2, 0);
        gpr += 4;

        /* Center Playback Volume (renamed later without Digital) */
        VOLUME_ADD(icode, &ptr, playback + 4, 6, gpr);
        snd_emu10k1_init_mono_control(controls + i++, "Center Digital Playback Volume", gpr++, 100);

        /* LFE Playback Volume + Switch (renamed later without Digital) */
        VOLUME_ADD(icode, &ptr, playback + 5, 7, gpr);
        snd_emu10k1_init_mono_control(controls + i++, "LFE Digital Playback Volume", gpr++, 100);

        /* Front Playback Volume */
        for (z = 0; z < 2; z++)
                VOLUME_ADD(icode, &ptr, playback + z, 10 + z, gpr + z);
        snd_emu10k1_init_stereo_control(controls + i++, "Front Playback Volume", gpr, 100);
        gpr += 2;

        /* Front Capture Volume + Switch */
        for (z = 0; z < 2; z++) {
                SWITCH(icode, &ptr, tmp + 0, 10 + z, gpr + 2);
                VOLUME_ADD(icode, &ptr, capture + z, tmp + 0, gpr + z);
        }
        snd_emu10k1_init_stereo_control(controls + i++, "Front Capture Volume", gpr, 0);
        snd_emu10k1_init_mono_onoff_control(controls + i++, "Front Capture Switch", gpr + 2, 0);
        gpr += 3;

        /*
         *  Process inputs
         */

        if (emu->fx8010.extin_mask & ((1<<EXTIN_AC97_L)|(1<<EXTIN_AC97_R))) {
                /* AC'97 Playback Volume */
                VOLUME_ADDIN(icode, &ptr, playback + 0, EXTIN_AC97_L, gpr); gpr++;
                VOLUME_ADDIN(icode, &ptr, playback + 1, EXTIN_AC97_R, gpr); gpr++;
                snd_emu10k1_init_stereo_control(controls + i++, "AC97 Playback Volume", gpr-2, 0);
                /* AC'97 Capture Volume */
                VOLUME_ADDIN(icode, &ptr, capture + 0, EXTIN_AC97_L, gpr); gpr++;
                VOLUME_ADDIN(icode, &ptr, capture + 1, EXTIN_AC97_R, gpr); gpr++;
                snd_emu10k1_init_stereo_control(controls + i++, "AC97 Capture Volume", gpr-2, 100);
        }
        
        if (emu->fx8010.extin_mask & ((1<<EXTIN_SPDIF_CD_L)|(1<<EXTIN_SPDIF_CD_R))) {
                /* IEC958 TTL Playback Volume */
                for (z = 0; z < 2; z++)
                        VOLUME_ADDIN(icode, &ptr, playback + z, EXTIN_SPDIF_CD_L + z, gpr + z);
                snd_emu10k1_init_stereo_control(controls + i++, SNDRV_CTL_NAME_IEC958("TTL ",PLAYBACK,VOLUME), gpr, 0);
                gpr += 2;
        
                /* IEC958 TTL Capture Volume + Switch */
                for (z = 0; z < 2; z++) {
                        SWITCH_IN(icode, &ptr, tmp + 0, EXTIN_SPDIF_CD_L + z, gpr + 2 + z);
                        VOLUME_ADD(icode, &ptr, capture + z, tmp + 0, gpr + z);
                }
                snd_emu10k1_init_stereo_control(controls + i++, SNDRV_CTL_NAME_IEC958("TTL ",CAPTURE,VOLUME), gpr, 0);
                snd_emu10k1_init_stereo_onoff_control(controls + i++, SNDRV_CTL_NAME_IEC958("TTL ",CAPTURE,SWITCH), gpr + 2, 0);
                gpr += 4;
        }
        
        if (emu->fx8010.extin_mask & ((1<<EXTIN_ZOOM_L)|(1<<EXTIN_ZOOM_R))) {
                /* Zoom Video Playback Volume */
                for (z = 0; z < 2; z++)
                        VOLUME_ADDIN(icode, &ptr, playback + z, EXTIN_ZOOM_L + z, gpr + z);
                snd_emu10k1_init_stereo_control(controls + i++, "Zoom Video Playback Volume", gpr, 0);
                gpr += 2;
        
                /* Zoom Video Capture Volume + Switch */
                for (z = 0; z < 2; z++) {
                        SWITCH_IN(icode, &ptr, tmp + 0, EXTIN_ZOOM_L + z, gpr + 2 + z);
                        VOLUME_ADD(icode, &ptr, capture + z, tmp + 0, gpr + z);
                }
                snd_emu10k1_init_stereo_control(controls + i++, "Zoom Video Capture Volume", gpr, 0);
                snd_emu10k1_init_stereo_onoff_control(controls + i++, "Zoom Video Capture Switch", gpr + 2, 0);
                gpr += 4;
        }
        
        if (emu->fx8010.extin_mask & ((1<<EXTIN_TOSLINK_L)|(1<<EXTIN_TOSLINK_R))) {
                /* IEC958 Optical Playback Volume */
                for (z = 0; z < 2; z++)
                        VOLUME_ADDIN(icode, &ptr, playback + z, EXTIN_TOSLINK_L + z, gpr + z);
                snd_emu10k1_init_stereo_control(controls + i++, SNDRV_CTL_NAME_IEC958("LiveDrive ",PLAYBACK,VOLUME), gpr, 0);
                gpr += 2;
        
                /* IEC958 Optical Capture Volume */
                for (z = 0; z < 2; z++) {
                        SWITCH_IN(icode, &ptr, tmp + 0, EXTIN_TOSLINK_L + z, gpr + 2 + z);
                        VOLUME_ADD(icode, &ptr, capture + z, tmp + 0, gpr + z);
                }
                snd_emu10k1_init_stereo_control(controls + i++, SNDRV_CTL_NAME_IEC958("LiveDrive ",CAPTURE,VOLUME), gpr, 0);
                snd_emu10k1_init_stereo_onoff_control(controls + i++, SNDRV_CTL_NAME_IEC958("LiveDrive ",CAPTURE,SWITCH), gpr + 2, 0);
                gpr += 4;
        }
        
        if (emu->fx8010.extin_mask & ((1<<EXTIN_LINE1_L)|(1<<EXTIN_LINE1_R))) {
                /* Line LiveDrive Playback Volume */
                for (z = 0; z < 2; z++)
                        VOLUME_ADDIN(icode, &ptr, playback + z, EXTIN_LINE1_L + z, gpr + z);
                snd_emu10k1_init_stereo_control(controls + i++, "Line LiveDrive Playback Volume", gpr, 0);
                gpr += 2;
        
                /* Line LiveDrive Capture Volume + Switch */
                for (z = 0; z < 2; z++) {
                        SWITCH_IN(icode, &ptr, tmp + 0, EXTIN_LINE1_L + z, gpr + 2 + z);
                        VOLUME_ADD(icode, &ptr, capture + z, tmp + 0, gpr + z);
                }
                snd_emu10k1_init_stereo_control(controls + i++, "Line LiveDrive Capture Volume", gpr, 0);
                snd_emu10k1_init_stereo_onoff_control(controls + i++, "Line LiveDrive Capture Switch", gpr + 2, 0);
                gpr += 4;
        }
        
        if (emu->fx8010.extin_mask & ((1<<EXTIN_COAX_SPDIF_L)|(1<<EXTIN_COAX_SPDIF_R))) {
                /* IEC958 Coax Playback Volume */
                for (z = 0; z < 2; z++)
                        VOLUME_ADDIN(icode, &ptr, playback + z, EXTIN_COAX_SPDIF_L + z, gpr + z);
                snd_emu10k1_init_stereo_control(controls + i++, SNDRV_CTL_NAME_IEC958("Coaxial ",PLAYBACK,VOLUME), gpr, 0);
                gpr += 2;
        
                /* IEC958 Coax Capture Volume + Switch */
                for (z = 0; z < 2; z++) {
                        SWITCH_IN(icode, &ptr, tmp + 0, EXTIN_COAX_SPDIF_L + z, gpr + 2 + z);
                        VOLUME_ADD(icode, &ptr, capture + z, tmp + 0, gpr + z);
                }
                snd_emu10k1_init_stereo_control(controls + i++, SNDRV_CTL_NAME_IEC958("Coaxial ",CAPTURE,VOLUME), gpr, 0);
                snd_emu10k1_init_stereo_onoff_control(controls + i++, SNDRV_CTL_NAME_IEC958("Coaxial ",CAPTURE,SWITCH), gpr + 2, 0);
                gpr += 4;
        }
        
        if (emu->fx8010.extin_mask & ((1<<EXTIN_LINE2_L)|(1<<EXTIN_LINE2_R))) {
                /* Line LiveDrive Playback Volume */
                for (z = 0; z < 2; z++)
                        VOLUME_ADDIN(icode, &ptr, playback + z, EXTIN_LINE2_L + z, gpr + z);
                snd_emu10k1_init_stereo_control(controls + i++, "Line2 LiveDrive Playback Volume", gpr, 0);
                controls[i-1].id.index = 1;
                gpr += 2;
        
                /* Line LiveDrive Capture Volume */
                for (z = 0; z < 2; z++) {
                        SWITCH_IN(icode, &ptr, tmp + 0, EXTIN_LINE2_L + z, gpr + 2 + z);
                        VOLUME_ADD(icode, &ptr, capture + z, tmp + 0, gpr + z);
                }
                snd_emu10k1_init_stereo_control(controls + i++, "Line2 LiveDrive Capture Volume", gpr, 0);
                controls[i-1].id.index = 1;
                snd_emu10k1_init_stereo_onoff_control(controls + i++, "Line2 LiveDrive Capture Switch", gpr + 2, 0);
                controls[i-1].id.index = 1;
                gpr += 4;
        }

        /*
         *  Process tone control
         */
        OP(icode, &ptr, iACC3, GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 0), GPR(playback + 0), C_00000000, C_00000000); /* left */
        OP(icode, &ptr, iACC3, GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 1), GPR(playback + 1), C_00000000, C_00000000); /* right */
        OP(icode, &ptr, iACC3, GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 2), GPR(playback + 2), C_00000000, C_00000000); /* rear left */
        OP(icode, &ptr, iACC3, GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 3), GPR(playback + 3), C_00000000, C_00000000); /* rear right */
        OP(icode, &ptr, iACC3, GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 4), GPR(playback + 4), C_00000000, C_00000000); /* center */
        OP(icode, &ptr, iACC3, GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 5), GPR(playback + 5), C_00000000, C_00000000); /* LFE */

        ctl = &controls[i + 0];
        ctl->id.iface = (__force int)SNDRV_CTL_ELEM_IFACE_MIXER;
        strcpy(ctl->id.name, "Tone Control - Bass");
        ctl->vcount = 2;
        ctl->count = 10;
        ctl->min = 0;
        ctl->max = 40;
        ctl->value[0] = ctl->value[1] = 20;
        ctl->tlv = snd_emu10k1_bass_treble_db_scale;
        ctl->translation = EMU10K1_GPR_TRANSLATION_BASS;
        ctl = &controls[i + 1];
        ctl->id.iface = (__force int)SNDRV_CTL_ELEM_IFACE_MIXER;
        strcpy(ctl->id.name, "Tone Control - Treble");
        ctl->vcount = 2;
        ctl->count = 10;
        ctl->min = 0;
        ctl->max = 40;
        ctl->value[0] = ctl->value[1] = 20;
        ctl->tlv = snd_emu10k1_bass_treble_db_scale;
        ctl->translation = EMU10K1_GPR_TRANSLATION_TREBLE;

#define BASS_GPR        0x8c
#define TREBLE_GPR      0x96

        for (z = 0; z < 5; z++) {
                int j;
                for (j = 0; j < 2; j++) {
                        controls[i + 0].gpr[z * 2 + j] = BASS_GPR + z * 2 + j;
                        controls[i + 1].gpr[z * 2 + j] = TREBLE_GPR + z * 2 + j;
                }
        }
        for (z = 0; z < 3; z++) {               /* front/rear/center-lfe */
                int j, k, l, d;
                for (j = 0; j < 2; j++) {       /* left/right */
                        k = 0xa0 + (z * 8) + (j * 4);
                        l = 0xd0 + (z * 8) + (j * 4);
                        d = playback + SND_EMU10K1_PLAYBACK_CHANNELS + z * 2 + j;

                        OP(icode, &ptr, iMAC0, C_00000000, C_00000000, GPR(d), GPR(BASS_GPR + 0 + j));
                        OP(icode, &ptr, iMACMV, GPR(k+1), GPR(k), GPR(k+1), GPR(BASS_GPR + 4 + j));
                        OP(icode, &ptr, iMACMV, GPR(k), GPR(d), GPR(k), GPR(BASS_GPR + 2 + j));
                        OP(icode, &ptr, iMACMV, GPR(k+3), GPR(k+2), GPR(k+3), GPR(BASS_GPR + 8 + j));
                        OP(icode, &ptr, iMAC0, GPR(k+2), GPR_ACCU, GPR(k+2), GPR(BASS_GPR + 6 + j));
                        OP(icode, &ptr, iACC3, GPR(k+2), GPR(k+2), GPR(k+2), C_00000000);

                        OP(icode, &ptr, iMAC0, C_00000000, C_00000000, GPR(k+2), GPR(TREBLE_GPR + 0 + j));
                        OP(icode, &ptr, iMACMV, GPR(l+1), GPR(l), GPR(l+1), GPR(TREBLE_GPR + 4 + j));
                        OP(icode, &ptr, iMACMV, GPR(l), GPR(k+2), GPR(l), GPR(TREBLE_GPR + 2 + j));
                        OP(icode, &ptr, iMACMV, GPR(l+3), GPR(l+2), GPR(l+3), GPR(TREBLE_GPR + 8 + j));
                        OP(icode, &ptr, iMAC0, GPR(l+2), GPR_ACCU, GPR(l+2), GPR(TREBLE_GPR + 6 + j));
                        OP(icode, &ptr, iMACINT0, GPR(l+2), C_00000000, GPR(l+2), C_00000010);

                        OP(icode, &ptr, iACC3, GPR(d), GPR(l+2), C_00000000, C_00000000);

                        if (z == 2)     /* center */
                                break;
                }
        }
        i += 2;

#undef BASS_GPR
#undef TREBLE_GPR

        for (z = 0; z < 6; z++) {
                SWITCH(icode, &ptr, tmp + 0, playback + SND_EMU10K1_PLAYBACK_CHANNELS + z, gpr + 0);
                SWITCH_NEG(icode, &ptr, tmp + 1, gpr + 0);
                SWITCH(icode, &ptr, tmp + 1, playback + z, tmp + 1);
                OP(icode, &ptr, iACC3, GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + z), GPR(tmp + 0), GPR(tmp + 1), C_00000000);
        }
        snd_emu10k1_init_stereo_onoff_control(controls + i++, "Tone Control - Switch", gpr, 0);
        gpr += 2;

        /*
         *  Process outputs
         */
        if (emu->fx8010.extout_mask & ((1<<EXTOUT_AC97_L)|(1<<EXTOUT_AC97_R))) {
                /* AC'97 Playback Volume */

                for (z = 0; z < 2; z++)
                        OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_AC97_L + z), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + z), C_00000000, C_00000000);
        }

        if (emu->fx8010.extout_mask & ((1<<EXTOUT_TOSLINK_L)|(1<<EXTOUT_TOSLINK_R))) {
                /* IEC958 Optical Raw Playback Switch */

                for (z = 0; z < 2; z++) {
                        SWITCH(icode, &ptr, tmp + 0, 8 + z, gpr + z);
                        SWITCH_NEG(icode, &ptr, tmp + 1, gpr + z);
                        SWITCH(icode, &ptr, tmp + 1, playback + SND_EMU10K1_PLAYBACK_CHANNELS + z, tmp + 1);
                        OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_TOSLINK_L + z), GPR(tmp + 0), GPR(tmp + 1), C_00000000);
#ifdef EMU10K1_CAPTURE_DIGITAL_OUT
                        OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_ADC_CAP_L + z), GPR(tmp + 0), GPR(tmp + 1), C_00000000);
#endif
                }

                snd_emu10k1_init_stereo_onoff_control(controls + i++, SNDRV_CTL_NAME_IEC958("Optical Raw ",PLAYBACK,SWITCH), gpr, 0);
                gpr += 2;
        }

        if (emu->fx8010.extout_mask & ((1<<EXTOUT_HEADPHONE_L)|(1<<EXTOUT_HEADPHONE_R))) {
                /* Headphone Playback Volume */

                for (z = 0; z < 2; z++) {
                        SWITCH(icode, &ptr, tmp + 0, playback + SND_EMU10K1_PLAYBACK_CHANNELS + 4 + z, gpr + 2 + z);
                        SWITCH_NEG(icode, &ptr, tmp + 1, gpr + 2 + z);
                        SWITCH(icode, &ptr, tmp + 1, playback + SND_EMU10K1_PLAYBACK_CHANNELS + z, tmp + 1);
                        OP(icode, &ptr, iACC3, GPR(tmp + 0), GPR(tmp + 0), GPR(tmp + 1), C_00000000);
                        VOLUME_OUT(icode, &ptr, EXTOUT_HEADPHONE_L + z, tmp + 0, gpr + z);
                }

                snd_emu10k1_init_stereo_control(controls + i++, "Headphone Playback Volume", gpr + 0, 0);
                controls[i-1].id.index = 1;     /* AC'97 can have also Headphone control */
                snd_emu10k1_init_mono_onoff_control(controls + i++, "Headphone Center Playback Switch", gpr + 2, 0);
                controls[i-1].id.index = 1;
                snd_emu10k1_init_mono_onoff_control(controls + i++, "Headphone LFE Playback Switch", gpr + 3, 0);
                controls[i-1].id.index = 1;

                gpr += 4;
        }
        
        if (emu->fx8010.extout_mask & ((1<<EXTOUT_REAR_L)|(1<<EXTOUT_REAR_R)))
                for (z = 0; z < 2; z++)
                        OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_REAR_L + z), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 2 + z), C_00000000, C_00000000);

        if (emu->fx8010.extout_mask & ((1<<EXTOUT_AC97_REAR_L)|(1<<EXTOUT_AC97_REAR_R)))
                for (z = 0; z < 2; z++)
                        OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_AC97_REAR_L + z), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 2 + z), C_00000000, C_00000000);

        if (emu->fx8010.extout_mask & (1<<EXTOUT_AC97_CENTER)) {
#ifndef EMU10K1_CENTER_LFE_FROM_FRONT
                OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_AC97_CENTER), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 4), C_00000000, C_00000000);
                OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_ACENTER), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 4), C_00000000, C_00000000);
#else
                OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_AC97_CENTER), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 0), C_00000000, C_00000000);
                OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_ACENTER), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 0), C_00000000, C_00000000);
#endif
        }

        if (emu->fx8010.extout_mask & (1<<EXTOUT_AC97_LFE)) {
#ifndef EMU10K1_CENTER_LFE_FROM_FRONT
                OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_AC97_LFE), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 5), C_00000000, C_00000000);
                OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_ALFE), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 5), C_00000000, C_00000000);
#else
                OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_AC97_LFE), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 1), C_00000000, C_00000000);
                OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_ALFE), GPR(playback + SND_EMU10K1_PLAYBACK_CHANNELS + 1), C_00000000, C_00000000);
#endif
        }
        
#ifndef EMU10K1_CAPTURE_DIGITAL_OUT
        for (z = 0; z < 2; z++)
                OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_ADC_CAP_L + z), GPR(capture + z), C_00000000, C_00000000);
#endif
        
        if (emu->fx8010.extout_mask & (1<<EXTOUT_MIC_CAP))
                OP(icode, &ptr, iACC3, EXTOUT(EXTOUT_MIC_CAP), GPR(capture + 2), C_00000000, C_00000000);

        /* EFX capture - capture the 16 EXTINS */
        if (emu->card_capabilities->sblive51) {
                /* On the Live! 5.1, FXBUS2(1) and FXBUS(2) are shared with EXTOUT_ACENTER
                 * and EXTOUT_ALFE, so we can't connect inputs to them for multitrack recording.
                 *
                 * Since only 14 of the 16 EXTINs are used, this is not a big problem.  
                 * We route AC97L and R to FX capture 14 and 15, SPDIF CD in to FX capture 
                 * 0 and 3, then the rest of the EXTINs to the corresponding FX capture 
                 * channel.  Multitrack recorders will still see the center/lfe output signal 
                 * on the second and third channels.
                 */
                OP(icode, &ptr, iACC3, FXBUS2(14), C_00000000, C_00000000, EXTIN(0));
                OP(icode, &ptr, iACC3, FXBUS2(15), C_00000000, C_00000000, EXTIN(1));
                OP(icode, &ptr, iACC3, FXBUS2(0), C_00000000, C_00000000, EXTIN(2));
                OP(icode, &ptr, iACC3, FXBUS2(3), C_00000000, C_00000000, EXTIN(3));
                for (z = 4; z < 14; z++)
                        OP(icode, &ptr, iACC3, FXBUS2(z), C_00000000, C_00000000, EXTIN(z));
        } else {
                for (z = 0; z < 16; z++)
                        OP(icode, &ptr, iACC3, FXBUS2(z), C_00000000, C_00000000, EXTIN(z));
        }
            

        if (gpr > tmp) {
                snd_BUG();
                err = -EIO;
                goto __err;
        }
        if (i > SND_EMU10K1_GPR_CONTROLS) {
                snd_BUG();
                err = -EIO;
                goto __err;
        }
        
        /* clear remaining instruction memory */
        while (ptr < 0x200)
                OP(icode, &ptr, iACC3, C_00000000, C_00000000, C_00000000, C_00000000);

        if ((err = snd_emu10k1_fx8010_tram_setup(emu, ipcm->buffer_size)) < 0)
                goto __err;
        icode->gpr_add_control_count = i;
        icode->gpr_add_controls = controls;
        emu->support_tlv = 1; /* support TLV */
        err = snd_emu10k1_icode_poke(emu, icode, true);
        emu->support_tlv = 0; /* clear again */
        if (err >= 0)
                err = snd_emu10k1_ipcm_poke(emu, ipcm);
__err:
        kfree(ipcm);
__err_ipcm:
        kfree(controls);
__err_ctrls:
        kfree(icode->gpr_map);
__err_gpr:
        kfree(icode);
        return err;
}

int snd_emu10k1_init_efx(struct snd_emu10k1 *emu)
{
        spin_lock_init(&emu->fx8010.irq_lock);
        INIT_LIST_HEAD(&emu->fx8010.gpr_ctl);
        if (emu->audigy)
                return _snd_emu10k1_audigy_init_efx(emu);
        else
                return _snd_emu10k1_init_efx(emu);
}

void snd_emu10k1_free_efx(struct snd_emu10k1 *emu)
{
        /* stop processor */
        if (emu->audigy)
                snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg = A_DBG_SINGLE_STEP);
        else
                snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg = EMU10K1_DBG_SINGLE_STEP);
}

#if 0 /* FIXME: who use them? */
int snd_emu10k1_fx8010_tone_control_activate(struct snd_emu10k1 *emu, int output)
{
        if (output < 0 || output >= 6)
                return -EINVAL;
        snd_emu10k1_ptr_write(emu, emu->gpr_base + 0x94 + output, 0, 1);
        return 0;
}

int snd_emu10k1_fx8010_tone_control_deactivate(struct snd_emu10k1 *emu, int output)
{
        if (output < 0 || output >= 6)
                return -EINVAL;
        snd_emu10k1_ptr_write(emu, emu->gpr_base + 0x94 + output, 0, 0);
        return 0;
}
#endif

int snd_emu10k1_fx8010_tram_setup(struct snd_emu10k1 *emu, u32 size)
{
        u8 size_reg = 0;

        /* size is in samples */
        if (size != 0) {
                size = (size - 1) >> 13;

                while (size) {
                        size >>= 1;
                        size_reg++;
                }
                size = 0x2000 << size_reg;
        }
        if ((emu->fx8010.etram_pages.bytes / 2) == size)
                return 0;
        spin_lock_irq(&emu->emu_lock);
        outl(HCFG_LOCKTANKCACHE_MASK | inl(emu->port + HCFG), emu->port + HCFG);
        spin_unlock_irq(&emu->emu_lock);
        snd_emu10k1_ptr_write(emu, TCB, 0, 0);
        snd_emu10k1_ptr_write(emu, TCBS, 0, 0);
        if (emu->fx8010.etram_pages.area != NULL) {
                snd_dma_free_pages(&emu->fx8010.etram_pages);
                emu->fx8010.etram_pages.area = NULL;
                emu->fx8010.etram_pages.bytes = 0;
        }

        if (size > 0) {
                if (snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, &emu->pci->dev,
                                        size * 2, &emu->fx8010.etram_pages) < 0)
                        return -ENOMEM;
                memset(emu->fx8010.etram_pages.area, 0, size * 2);
                snd_emu10k1_ptr_write(emu, TCB, 0, emu->fx8010.etram_pages.addr);
                snd_emu10k1_ptr_write(emu, TCBS, 0, size_reg);
                spin_lock_irq(&emu->emu_lock);
                outl(inl(emu->port + HCFG) & ~HCFG_LOCKTANKCACHE_MASK, emu->port + HCFG);
                spin_unlock_irq(&emu->emu_lock);
        }

        return 0;
}

static int snd_emu10k1_fx8010_open(struct snd_hwdep * hw, struct file *file)
{
        return 0;
}

static void copy_string(char *dst, const char *src, const char *null, int idx)
{
        if (src == NULL)
                sprintf(dst, "%s %02X", null, idx);
        else
                strcpy(dst, src);
}

static void snd_emu10k1_fx8010_info(struct snd_emu10k1 *emu,
                                   struct snd_emu10k1_fx8010_info *info)
{
        const char * const *fxbus, * const *extin, * const *extout;
        unsigned short fxbus_mask, extin_mask, extout_mask;
        int res;

        info->internal_tram_size = emu->fx8010.itram_size;
        info->external_tram_size = emu->fx8010.etram_pages.bytes / 2;
        fxbus = fxbuses;
        extin = emu->audigy ? audigy_ins : creative_ins;
        extout = emu->audigy ? audigy_outs : creative_outs;
        fxbus_mask = emu->fx8010.fxbus_mask;
        extin_mask = emu->fx8010.extin_mask;
        extout_mask = emu->fx8010.extout_mask;
        for (res = 0; res < 16; res++, fxbus++, extin++, extout++) {
                copy_string(info->fxbus_names[res], fxbus_mask & (1 << res) ? *fxbus : NULL, "FXBUS", res);
                copy_string(info->extin_names[res], extin_mask & (1 << res) ? *extin : NULL, "Unused", res);
                copy_string(info->extout_names[res], extout_mask & (1 << res) ? *extout : NULL, "Unused", res);
        }
        for (res = 16; res < 32; res++, extout++)
                copy_string(info->extout_names[res], extout_mask & (1 << res) ? *extout : NULL, "Unused", res);
        info->gpr_controls = emu->fx8010.gpr_count;
}

static int snd_emu10k1_fx8010_ioctl(struct snd_hwdep * hw, struct file *file, unsigned int cmd, unsigned long arg)
{
        struct snd_emu10k1 *emu = hw->private_data;
        struct snd_emu10k1_fx8010_info *info;
        struct snd_emu10k1_fx8010_code *icode;
        struct snd_emu10k1_fx8010_pcm_rec *ipcm;
        unsigned int addr;
        void __user *argp = (void __user *)arg;
        int res;
        
        switch (cmd) {
        case SNDRV_EMU10K1_IOCTL_PVERSION:
                emu->support_tlv = 1;
                return put_user(SNDRV_EMU10K1_VERSION, (int __user *)argp);
        case SNDRV_EMU10K1_IOCTL_INFO:
                info = kzalloc(sizeof(*info), GFP_KERNEL);
                if (!info)
                        return -ENOMEM;
                snd_emu10k1_fx8010_info(emu, info);
                if (copy_to_user(argp, info, sizeof(*info))) {
                        kfree(info);
                        return -EFAULT;
                }
                kfree(info);
                return 0;
        case SNDRV_EMU10K1_IOCTL_CODE_POKE:
                if (!capable(CAP_SYS_ADMIN))
                        return -EPERM;

                icode = memdup_user(argp, sizeof(*icode));
                if (IS_ERR(icode))
                        return PTR_ERR(icode);
                res = snd_emu10k1_icode_poke(emu, icode, false);
                kfree(icode);
                return res;
        case SNDRV_EMU10K1_IOCTL_CODE_PEEK:
                icode = memdup_user(argp, sizeof(*icode));
                if (IS_ERR(icode))
                        return PTR_ERR(icode);
                res = snd_emu10k1_icode_peek(emu, icode);
                if (res == 0 && copy_to_user(argp, icode, sizeof(*icode))) {
                        kfree(icode);
                        return -EFAULT;
                }
                kfree(icode);
                return res;
        case SNDRV_EMU10K1_IOCTL_PCM_POKE:
                ipcm = memdup_user(argp, sizeof(*ipcm));
                if (IS_ERR(ipcm))
                        return PTR_ERR(ipcm);
                res = snd_emu10k1_ipcm_poke(emu, ipcm);
                kfree(ipcm);
                return res;
        case SNDRV_EMU10K1_IOCTL_PCM_PEEK:
                ipcm = memdup_user(argp, sizeof(*ipcm));
                if (IS_ERR(ipcm))
                        return PTR_ERR(ipcm);
                res = snd_emu10k1_ipcm_peek(emu, ipcm);
                if (res == 0 && copy_to_user(argp, ipcm, sizeof(*ipcm))) {
                        kfree(ipcm);
                        return -EFAULT;
                }
                kfree(ipcm);
                return res;
        case SNDRV_EMU10K1_IOCTL_TRAM_SETUP:
                if (!capable(CAP_SYS_ADMIN))
                        return -EPERM;
                if (get_user(addr, (unsigned int __user *)argp))
                        return -EFAULT;
                mutex_lock(&emu->fx8010.lock);
                res = snd_emu10k1_fx8010_tram_setup(emu, addr);
                mutex_unlock(&emu->fx8010.lock);
                return res;
        case SNDRV_EMU10K1_IOCTL_STOP:
                if (!capable(CAP_SYS_ADMIN))
                        return -EPERM;
                if (emu->audigy)
                        snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg |= A_DBG_SINGLE_STEP);
                else
                        snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg |= EMU10K1_DBG_SINGLE_STEP);
                return 0;
        case SNDRV_EMU10K1_IOCTL_CONTINUE:
                if (!capable(CAP_SYS_ADMIN))
                        return -EPERM;
                if (emu->audigy)
                        snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg = 0);
                else
                        snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg = 0);
                return 0;
        case SNDRV_EMU10K1_IOCTL_ZERO_TRAM_COUNTER:
                if (!capable(CAP_SYS_ADMIN))
                        return -EPERM;
                if (emu->audigy)
                        snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg | A_DBG_ZC);
                else
                        snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg | EMU10K1_DBG_ZC);
                udelay(10);
                if (emu->audigy)
                        snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg);
                else
                        snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg);
                return 0;
        case SNDRV_EMU10K1_IOCTL_SINGLE_STEP:
                if (!capable(CAP_SYS_ADMIN))
                        return -EPERM;
                if (get_user(addr, (unsigned int __user *)argp))
                        return -EFAULT;
                if (addr > 0x1ff)
                        return -EINVAL;
                if (emu->audigy)
                        snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg |= A_DBG_SINGLE_STEP | addr);
                else
                        snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg |= EMU10K1_DBG_SINGLE_STEP | addr);
                udelay(10);
                if (emu->audigy)
                        snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg |= A_DBG_SINGLE_STEP | A_DBG_STEP_ADDR | addr);
                else
                        snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg |= EMU10K1_DBG_SINGLE_STEP | EMU10K1_DBG_STEP | addr);
                return 0;
        case SNDRV_EMU10K1_IOCTL_DBG_READ:
                if (emu->audigy)
                        addr = snd_emu10k1_ptr_read(emu, A_DBG, 0);
                else
                        addr = snd_emu10k1_ptr_read(emu, DBG, 0);
                if (put_user(addr, (unsigned int __user *)argp))
                        return -EFAULT;
                return 0;
        }
        return -ENOTTY;
}

static int snd_emu10k1_fx8010_release(struct snd_hwdep * hw, struct file *file)
{
        return 0;
}

int snd_emu10k1_fx8010_new(struct snd_emu10k1 *emu, int device)
{
        struct snd_hwdep *hw;
        int err;
        
        if ((err = snd_hwdep_new(emu->card, "FX8010", device, &hw)) < 0)
                return err;
        strcpy(hw->name, "EMU10K1 (FX8010)");
        hw->iface = SNDRV_HWDEP_IFACE_EMU10K1;
        hw->ops.open = snd_emu10k1_fx8010_open;
        hw->ops.ioctl = snd_emu10k1_fx8010_ioctl;
        hw->ops.release = snd_emu10k1_fx8010_release;
        hw->private_data = emu;
        return 0;
}

#ifdef CONFIG_PM_SLEEP
int snd_emu10k1_efx_alloc_pm_buffer(struct snd_emu10k1 *emu)
{
        int len;

        len = emu->audigy ? 0x200 : 0x100;
        emu->saved_gpr = kmalloc_array(len, 4, GFP_KERNEL);
        if (! emu->saved_gpr)
                return -ENOMEM;
        len = emu->audigy ? 0x100 : 0xa0;
        emu->tram_val_saved = kmalloc_array(len, 4, GFP_KERNEL);
        emu->tram_addr_saved = kmalloc_array(len, 4, GFP_KERNEL);
        if (! emu->tram_val_saved || ! emu->tram_addr_saved)
                return -ENOMEM;
        len = emu->audigy ? 2 * 1024 : 2 * 512;
        emu->saved_icode = vmalloc(array_size(len, 4));
        if (! emu->saved_icode)
                return -ENOMEM;
        return 0;
}

void snd_emu10k1_efx_free_pm_buffer(struct snd_emu10k1 *emu)
{
        kfree(emu->saved_gpr);
        kfree(emu->tram_val_saved);
        kfree(emu->tram_addr_saved);
        vfree(emu->saved_icode);
}

/*
 * save/restore GPR, TRAM and codes
 */
void snd_emu10k1_efx_suspend(struct snd_emu10k1 *emu)
{
        int i, len;

        len = emu->audigy ? 0x200 : 0x100;
        for (i = 0; i < len; i++)
                emu->saved_gpr[i] = snd_emu10k1_ptr_read(emu, emu->gpr_base + i, 0);

        len = emu->audigy ? 0x100 : 0xa0;
        for (i = 0; i < len; i++) {
                emu->tram_val_saved[i] = snd_emu10k1_ptr_read(emu, TANKMEMDATAREGBASE + i, 0);
                emu->tram_addr_saved[i] = snd_emu10k1_ptr_read(emu, TANKMEMADDRREGBASE + i, 0);
                if (emu->audigy) {
                        emu->tram_addr_saved[i] >>= 12;
                        emu->tram_addr_saved[i] |=
                                snd_emu10k1_ptr_read(emu, A_TANKMEMCTLREGBASE + i, 0) << 20;
                }
        }

        len = emu->audigy ? 2 * 1024 : 2 * 512;
        for (i = 0; i < len; i++)
                emu->saved_icode[i] = snd_emu10k1_efx_read(emu, i);
}

void snd_emu10k1_efx_resume(struct snd_emu10k1 *emu)
{
        int i, len;

        /* set up TRAM */
        if (emu->fx8010.etram_pages.bytes > 0) {
                unsigned size, size_reg = 0;
                size = emu->fx8010.etram_pages.bytes / 2;
                size = (size - 1) >> 13;
                while (size) {
                        size >>= 1;
                        size_reg++;
                }
                outl(HCFG_LOCKTANKCACHE_MASK | inl(emu->port + HCFG), emu->port + HCFG);
                snd_emu10k1_ptr_write(emu, TCB, 0, emu->fx8010.etram_pages.addr);
                snd_emu10k1_ptr_write(emu, TCBS, 0, size_reg);
                outl(inl(emu->port + HCFG) & ~HCFG_LOCKTANKCACHE_MASK, emu->port + HCFG);
        }

        if (emu->audigy)
                snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg | A_DBG_SINGLE_STEP);
        else
                snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg | EMU10K1_DBG_SINGLE_STEP);

        len = emu->audigy ? 0x200 : 0x100;
        for (i = 0; i < len; i++)
                snd_emu10k1_ptr_write(emu, emu->gpr_base + i, 0, emu->saved_gpr[i]);

        len = emu->audigy ? 0x100 : 0xa0;
        for (i = 0; i < len; i++) {
                snd_emu10k1_ptr_write(emu, TANKMEMDATAREGBASE + i, 0,
                                      emu->tram_val_saved[i]);
                if (! emu->audigy)
                        snd_emu10k1_ptr_write(emu, TANKMEMADDRREGBASE + i, 0,
                                              emu->tram_addr_saved[i]);
                else {
                        snd_emu10k1_ptr_write(emu, TANKMEMADDRREGBASE + i, 0,
                                              emu->tram_addr_saved[i] << 12);
                        snd_emu10k1_ptr_write(emu, TANKMEMADDRREGBASE + i, 0,
                                              emu->tram_addr_saved[i] >> 20);
                }
        }

        len = emu->audigy ? 2 * 1024 : 2 * 512;
        for (i = 0; i < len; i++)
                snd_emu10k1_efx_write(emu, i, emu->saved_icode[i]);

        /* start FX processor when the DSP code is updated */
        if (emu->audigy)
                snd_emu10k1_ptr_write(emu, A_DBG, 0, emu->fx8010.dbg);
        else
                snd_emu10k1_ptr_write(emu, DBG, 0, emu->fx8010.dbg);
}
#endif