Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / sound / ppc / daca.c
diff --git a/kernel/sound/ppc/daca.c b/kernel/sound/ppc/daca.c
new file mode 100644 (file)
index 0000000..b865262
--- /dev/null
@@ -0,0 +1,282 @@
+/*
+ * PMac DACA lowlevel functions
+ *
+ * Copyright (c) by Takashi Iwai <tiwai@suse.de>
+ *
+ *   This program is free software; you can redistribute it and/or modify
+ *   it under the terms of the GNU General Public License as published by
+ *   the Free Software Foundation; either version 2 of the License, or
+ *   (at your option) any later version.
+ *
+ *   This program is distributed in the hope that it will be useful,
+ *   but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *   GNU General Public License for more details.
+ *
+ *   You should have received a copy of the GNU General Public License
+ *   along with this program; if not, write to the Free Software
+ *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
+ */
+
+
+#include <linux/init.h>
+#include <linux/i2c.h>
+#include <linux/kmod.h>
+#include <linux/slab.h>
+#include <sound/core.h>
+#include "pmac.h"
+
+/* i2c address */
+#define DACA_I2C_ADDR  0x4d
+
+/* registers */
+#define DACA_REG_SR    0x01
+#define DACA_REG_AVOL  0x02
+#define DACA_REG_GCFG  0x03
+
+/* maximum volume value */
+#define DACA_VOL_MAX   0x38
+
+
+struct pmac_daca {
+       struct pmac_keywest i2c;
+       int left_vol, right_vol;
+       unsigned int deemphasis : 1;
+       unsigned int amp_on : 1;
+};
+
+
+/*
+ * initialize / detect DACA
+ */
+static int daca_init_client(struct pmac_keywest *i2c)
+{
+       unsigned short wdata = 0x00;
+       /* SR: no swap, 1bit delay, 32-48kHz */
+       /* GCFG: power amp inverted, DAC on */
+       if (i2c_smbus_write_byte_data(i2c->client, DACA_REG_SR, 0x08) < 0 ||
+           i2c_smbus_write_byte_data(i2c->client, DACA_REG_GCFG, 0x05) < 0)
+               return -EINVAL;
+       return i2c_smbus_write_block_data(i2c->client, DACA_REG_AVOL,
+                                         2, (unsigned char*)&wdata);
+}
+
+/*
+ * update volume
+ */
+static int daca_set_volume(struct pmac_daca *mix)
+{
+       unsigned char data[2];
+  
+       if (! mix->i2c.client)
+               return -ENODEV;
+  
+       if (mix->left_vol > DACA_VOL_MAX)
+               data[0] = DACA_VOL_MAX;
+       else
+               data[0] = mix->left_vol;
+       if (mix->right_vol > DACA_VOL_MAX)
+               data[1] = DACA_VOL_MAX;
+       else
+               data[1] = mix->right_vol;
+       data[1] |= mix->deemphasis ? 0x40 : 0;
+       if (i2c_smbus_write_block_data(mix->i2c.client, DACA_REG_AVOL,
+                                      2, data) < 0) {
+               snd_printk(KERN_ERR "failed to set volume \n");
+               return -EINVAL;
+       }
+       return 0;
+}
+
+
+/* deemphasis switch */
+#define daca_info_deemphasis           snd_ctl_boolean_mono_info
+
+static int daca_get_deemphasis(struct snd_kcontrol *kcontrol,
+                              struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_pmac *chip = snd_kcontrol_chip(kcontrol);
+       struct pmac_daca *mix;
+       if (! (mix = chip->mixer_data))
+               return -ENODEV;
+       ucontrol->value.integer.value[0] = mix->deemphasis ? 1 : 0;
+       return 0;
+}
+
+static int daca_put_deemphasis(struct snd_kcontrol *kcontrol,
+                              struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_pmac *chip = snd_kcontrol_chip(kcontrol);
+       struct pmac_daca *mix;
+       int change;
+
+       if (! (mix = chip->mixer_data))
+               return -ENODEV;
+       change = mix->deemphasis != ucontrol->value.integer.value[0];
+       if (change) {
+               mix->deemphasis = !!ucontrol->value.integer.value[0];
+               daca_set_volume(mix);
+       }
+       return change;
+}
+
+/* output volume */
+static int daca_info_volume(struct snd_kcontrol *kcontrol,
+                           struct snd_ctl_elem_info *uinfo)
+{
+       uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
+       uinfo->count = 2;
+       uinfo->value.integer.min = 0;
+       uinfo->value.integer.max = DACA_VOL_MAX;
+       return 0;
+}
+
+static int daca_get_volume(struct snd_kcontrol *kcontrol,
+                          struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_pmac *chip = snd_kcontrol_chip(kcontrol);
+       struct pmac_daca *mix;
+       if (! (mix = chip->mixer_data))
+               return -ENODEV;
+       ucontrol->value.integer.value[0] = mix->left_vol;
+       ucontrol->value.integer.value[1] = mix->right_vol;
+       return 0;
+}
+
+static int daca_put_volume(struct snd_kcontrol *kcontrol,
+                          struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_pmac *chip = snd_kcontrol_chip(kcontrol);
+       struct pmac_daca *mix;
+       unsigned int vol[2];
+       int change;
+
+       if (! (mix = chip->mixer_data))
+               return -ENODEV;
+       vol[0] = ucontrol->value.integer.value[0];
+       vol[1] = ucontrol->value.integer.value[1];
+       if (vol[0] > DACA_VOL_MAX || vol[1] > DACA_VOL_MAX)
+               return -EINVAL;
+       change = mix->left_vol != vol[0] ||
+               mix->right_vol != vol[1];
+       if (change) {
+               mix->left_vol = vol[0];
+               mix->right_vol = vol[1];
+               daca_set_volume(mix);
+       }
+       return change;
+}
+
+/* amplifier switch */
+#define daca_info_amp  daca_info_deemphasis
+
+static int daca_get_amp(struct snd_kcontrol *kcontrol,
+                       struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_pmac *chip = snd_kcontrol_chip(kcontrol);
+       struct pmac_daca *mix;
+       if (! (mix = chip->mixer_data))
+               return -ENODEV;
+       ucontrol->value.integer.value[0] = mix->amp_on ? 1 : 0;
+       return 0;
+}
+
+static int daca_put_amp(struct snd_kcontrol *kcontrol,
+                       struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_pmac *chip = snd_kcontrol_chip(kcontrol);
+       struct pmac_daca *mix;
+       int change;
+
+       if (! (mix = chip->mixer_data))
+               return -ENODEV;
+       change = mix->amp_on != ucontrol->value.integer.value[0];
+       if (change) {
+               mix->amp_on = !!ucontrol->value.integer.value[0];
+               i2c_smbus_write_byte_data(mix->i2c.client, DACA_REG_GCFG,
+                                         mix->amp_on ? 0x05 : 0x04);
+       }
+       return change;
+}
+
+static struct snd_kcontrol_new daca_mixers[] = {
+       { .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
+         .name = "Deemphasis Switch",
+         .info = daca_info_deemphasis,
+         .get = daca_get_deemphasis,
+         .put = daca_put_deemphasis
+       },
+       { .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
+         .name = "Master Playback Volume",
+         .info = daca_info_volume,
+         .get = daca_get_volume,
+         .put = daca_put_volume
+       },
+       { .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
+         .name = "Power Amplifier Switch",
+         .info = daca_info_amp,
+         .get = daca_get_amp,
+         .put = daca_put_amp
+       },
+};
+
+
+#ifdef CONFIG_PM
+static void daca_resume(struct snd_pmac *chip)
+{
+       struct pmac_daca *mix = chip->mixer_data;
+       i2c_smbus_write_byte_data(mix->i2c.client, DACA_REG_SR, 0x08);
+       i2c_smbus_write_byte_data(mix->i2c.client, DACA_REG_GCFG,
+                                 mix->amp_on ? 0x05 : 0x04);
+       daca_set_volume(mix);
+}
+#endif /* CONFIG_PM */
+
+
+static void daca_cleanup(struct snd_pmac *chip)
+{
+       struct pmac_daca *mix = chip->mixer_data;
+       if (! mix)
+               return;
+       snd_pmac_keywest_cleanup(&mix->i2c);
+       kfree(mix);
+       chip->mixer_data = NULL;
+}
+
+/* exported */
+int snd_pmac_daca_init(struct snd_pmac *chip)
+{
+       int i, err;
+       struct pmac_daca *mix;
+
+       request_module("i2c-powermac");
+
+       mix = kzalloc(sizeof(*mix), GFP_KERNEL);
+       if (! mix)
+               return -ENOMEM;
+       chip->mixer_data = mix;
+       chip->mixer_free = daca_cleanup;
+       mix->amp_on = 1; /* default on */
+
+       mix->i2c.addr = DACA_I2C_ADDR;
+       mix->i2c.init_client = daca_init_client;
+       mix->i2c.name = "DACA";
+       if ((err = snd_pmac_keywest_init(&mix->i2c)) < 0)
+               return err;
+
+       /*
+        * build mixers
+        */
+       strcpy(chip->card->mixername, "PowerMac DACA");
+
+       for (i = 0; i < ARRAY_SIZE(daca_mixers); i++) {
+               if ((err = snd_ctl_add(chip->card, snd_ctl_new1(&daca_mixers[i], chip))) < 0)
+                       return err;
+       }
+
+#ifdef CONFIG_PM
+       chip->resume = daca_resume;
+#endif
+
+       return 0;
+}