1 files changed, 380 insertions, 0 deletions

diff --git a/sound/ppc/toonie.c b/sound/ppc/toonie.c
new file mode 100644
index 000000000000..0f909193b4fb
--- /dev/null
+++ b/sound/ppc/toonie.c
@@ -0,0 +1,380 @@
+/*
+ * Mac Mini "toonie" mixer control
+ *
+ * Copyright (c) 2005 by Benjamin Herrenschmidt <benh@kernel.crashing.org>
+ *
+ *   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 <sound/driver.h>
+#include <linux/init.h>
+#include <linux/delay.h>
+#include <linux/i2c.h>
+#include <linux/i2c-dev.h>
+#include <linux/kmod.h>
+#include <linux/slab.h>
+#include <linux/interrupt.h>
+#include <sound/core.h>
+#include <asm/io.h>
+#include <asm/irq.h>
+#include <asm/machdep.h>
+#include <asm/pmac_feature.h>
+#include "pmac.h"
+
+#undef DEBUG
+
+#ifdef DEBUG
+#define DBG(fmt...) printk(fmt)
+#else
+#define DBG(fmt...)
+#endif
+
+struct pmac_gpio {
+        unsigned int addr;
+        u8 active_val;
+        u8 inactive_val;
+        u8 active_state;
+};
+
+struct pmac_toonie
+{
+        struct pmac_gpio        hp_detect_gpio;
+        struct pmac_gpio        hp_mute_gpio;
+        struct pmac_gpio        amp_mute_gpio;
+        int                     hp_detect_irq;
+        int                     auto_mute_notify;
+        struct work_struct      detect_work;
+};
+
+
+/*
+ * gpio access
+ */
+#define do_gpio_write(gp, val) \
+        pmac_call_feature(PMAC_FTR_WRITE_GPIO, NULL, (gp)->addr, val)
+#define do_gpio_read(gp) \
+        pmac_call_feature(PMAC_FTR_READ_GPIO, NULL, (gp)->addr, 0)
+#define tumbler_gpio_free(gp) /* NOP */
+
+static void write_audio_gpio(struct pmac_gpio *gp, int active)
+{
+        if (! gp->addr)
+                return;
+        active = active ? gp->active_val : gp->inactive_val;
+        do_gpio_write(gp, active);
+        DBG("(I) gpio %x write %d\n", gp->addr, active);
+}
+
+static int check_audio_gpio(struct pmac_gpio *gp)
+{
+        int ret;
+
+        if (! gp->addr)
+                return 0;
+
+        ret = do_gpio_read(gp);
+
+        return (ret & 0xd) == (gp->active_val & 0xd);
+}
+
+static int read_audio_gpio(struct pmac_gpio *gp)
+{
+        int ret;
+        if (! gp->addr)
+                return 0;
+        ret = ((do_gpio_read(gp) & 0x02) !=0);
+        return ret == gp->active_state;
+}
+
+
+enum { TOONIE_MUTE_HP, TOONIE_MUTE_AMP };
+
+static int toonie_get_mute_switch(snd_kcontrol_t *kcontrol,
+                                  snd_ctl_elem_value_t *ucontrol)
+{
+        pmac_t *chip = snd_kcontrol_chip(kcontrol);
+        struct pmac_toonie *mix = chip->mixer_data;
+        struct pmac_gpio *gp;
+
+        if (mix == NULL)
+                return -ENODEV;
+        switch(kcontrol->private_value) {
+        case TOONIE_MUTE_HP:
+                gp = &mix->hp_mute_gpio;
+                break;
+        case TOONIE_MUTE_AMP:
+                gp = &mix->amp_mute_gpio;
+                break;
+        default:
+                return -EINVAL;;
+        }
+        ucontrol->value.integer.value[0] = !check_audio_gpio(gp);
+        return 0;
+}
+
+static int toonie_put_mute_switch(snd_kcontrol_t *kcontrol,
+                                   snd_ctl_elem_value_t *ucontrol)
+{
+        pmac_t *chip = snd_kcontrol_chip(kcontrol);
+        struct pmac_toonie *mix = chip->mixer_data;
+        struct pmac_gpio *gp;
+        int val;
+
+        if (chip->update_automute && chip->auto_mute)
+                return 0; /* don't touch in the auto-mute mode */
+
+        if (mix == NULL)
+                return -ENODEV;
+
+        switch(kcontrol->private_value) {
+        case TOONIE_MUTE_HP:
+                gp = &mix->hp_mute_gpio;
+                break;
+        case TOONIE_MUTE_AMP:
+                gp = &mix->amp_mute_gpio;
+                break;
+        default:
+                return -EINVAL;;
+        }
+        val = ! check_audio_gpio(gp);
+        if (val != ucontrol->value.integer.value[0]) {
+                write_audio_gpio(gp, ! ucontrol->value.integer.value[0]);
+                return 1;
+        }
+        return 0;
+}
+
+static snd_kcontrol_new_t toonie_hp_sw __initdata = {
+        .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
+        .name = "Headphone Playback Switch",
+        .info = snd_pmac_boolean_mono_info,
+        .get = toonie_get_mute_switch,
+        .put = toonie_put_mute_switch,
+        .private_value = TOONIE_MUTE_HP,
+};
+static snd_kcontrol_new_t toonie_speaker_sw __initdata = {
+        .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
+        .name = "PC Speaker Playback Switch",
+        .info = snd_pmac_boolean_mono_info,
+        .get = toonie_get_mute_switch,
+        .put = toonie_put_mute_switch,
+        .private_value = TOONIE_MUTE_AMP,
+};
+
+/*
+ * auto-mute stuffs
+ */
+static int toonie_detect_headphone(pmac_t *chip)
+{
+        struct pmac_toonie *mix = chip->mixer_data;
+        int detect = 0;
+
+        if (mix->hp_detect_gpio.addr)
+                detect |= read_audio_gpio(&mix->hp_detect_gpio);
+        return detect;
+}
+
+static void toonie_check_mute(pmac_t *chip, struct pmac_gpio *gp, int val,
+                              int do_notify, snd_kcontrol_t *sw)
+{
+        if (check_audio_gpio(gp) != val) {
+                write_audio_gpio(gp, val);
+                if (do_notify)
+                        snd_ctl_notify(chip->card, SNDRV_CTL_EVENT_MASK_VALUE,
+                                       &sw->id);
+        }
+}
+
+static void toonie_detect_handler(void *self)
+{
+        pmac_t *chip = (pmac_t*) self;
+        struct pmac_toonie *mix;
+        int headphone;
+
+        if (!chip)
+                return;
+
+        mix = chip->mixer_data;
+        snd_assert(mix, return);
+
+        headphone = toonie_detect_headphone(chip);
+
+        DBG("headphone: %d, lineout: %d\n", headphone, lineout);
+
+        if (headphone) {
+                /* unmute headphone/lineout & mute speaker */
+                toonie_check_mute(chip, &mix->hp_mute_gpio, 0,
+                                  mix->auto_mute_notify, chip->master_sw_ctl);
+                toonie_check_mute(chip, &mix->amp_mute_gpio, 1,
+                                  mix->auto_mute_notify, chip->speaker_sw_ctl);
+        } else {
+                /* unmute speaker, mute others */
+                toonie_check_mute(chip, &mix->amp_mute_gpio, 0,
+                                  mix->auto_mute_notify, chip->speaker_sw_ctl);
+                toonie_check_mute(chip, &mix->hp_mute_gpio, 1,
+                                  mix->auto_mute_notify, chip->master_sw_ctl);
+        }
+        if (mix->auto_mute_notify) {
+                snd_ctl_notify(chip->card, SNDRV_CTL_EVENT_MASK_VALUE,
+                                       &chip->hp_detect_ctl->id);
+        }
+}
+
+static void toonie_update_automute(pmac_t *chip, int do_notify)
+{
+        if (chip->auto_mute) {
+                struct pmac_toonie *mix;
+                mix = chip->mixer_data;
+                snd_assert(mix, return);
+                mix->auto_mute_notify = do_notify;
+                schedule_work(&mix->detect_work);
+        }
+}
+
+/* interrupt - headphone plug changed */
+static irqreturn_t toonie_hp_intr(int irq, void *devid, struct pt_regs *regs)
+{
+        pmac_t *chip = devid;
+
+        if (chip->update_automute && chip->initialized) {
+                chip->update_automute(chip, 1);
+                return IRQ_HANDLED;
+        }
+        return IRQ_NONE;
+}
+
+/* look for audio gpio device */
+static int find_audio_gpio(const char *name, const char *platform,
+                           struct pmac_gpio *gp)
+{
+        struct device_node *np;
+        u32 *base, addr;
+
+        if (! (np = find_devices("gpio")))
+                return -ENODEV;
+
+        for (np = np->child; np; np = np->sibling) {
+                char *property = get_property(np, "audio-gpio", NULL);
+                if (property && strcmp(property, name) == 0)
+                        break;
+                if (device_is_compatible(np, name))
+                        break;
+        }
+        if (np == NULL)
+                return -ENODEV;
+
+        base = (u32 *)get_property(np, "AAPL,address", NULL);
+        if (! base) {
+                base = (u32 *)get_property(np, "reg", NULL);
+                if (!base) {
+                        DBG("(E) cannot find address for device %s !\n", device);
+                        snd_printd("cannot find address for device %s\n", device);
+                        return -ENODEV;
+                }
+                addr = *base;
+                if (addr < 0x50)
+                        addr += 0x50;
+        } else
+                addr = *base;
+
+        gp->addr = addr & 0x0000ffff;
+
+        /* Try to find the active state, default to 0 ! */
+        base = (u32 *)get_property(np, "audio-gpio-active-state", NULL);
+        if (base) {
+                gp->active_state = *base;
+                gp->active_val = (*base) ? 0x5 : 0x4;
+                gp->inactive_val = (*base) ? 0x4 : 0x5;
+        } else {
+                u32 *prop = NULL;
+                gp->active_state = 0;
+                gp->active_val = 0x4;
+                gp->inactive_val = 0x5;
+                /* Here are some crude hacks to extract the GPIO polarity and
+                 * open collector informations out of the do-platform script
+                 * as we don't yet have an interpreter for these things
+                 */
+                if (platform)
+                        prop = (u32 *)get_property(np, platform, NULL);
+                if (prop) {
+                        if (prop[3] == 0x9 && prop[4] == 0x9) {
+                                gp->active_val = 0xd;
+                                gp->inactive_val = 0xc;
+                        }
+                        if (prop[3] == 0x1 && prop[4] == 0x1) {
+                                gp->active_val = 0x5;
+                                gp->inactive_val = 0x4;
+                        }
+                }
+        }
+
+        DBG("(I) GPIO device %s found, offset: %x, active state: %d !\n",
+            device, gp->addr, gp->active_state);
+
+        return (np->n_intrs > 0) ? np->intrs[0].line : 0;
+}
+
+static void toonie_cleanup(pmac_t *chip)
+{
+        struct pmac_toonie *mix = chip->mixer_data;
+        if (! mix)
+                return;
+        if (mix->hp_detect_irq >= 0)
+                free_irq(mix->hp_detect_irq, chip);
+        kfree(mix);
+        chip->mixer_data = NULL;
+}
+
+int snd_pmac_toonie_init(pmac_t *chip)
+{
+        struct pmac_toonie *mix;
+
+        mix = kmalloc(sizeof(*mix), GFP_KERNEL);
+        if (! mix)
+                return -ENOMEM;
+
+        chip->mixer_data = mix;
+        chip->mixer_free = toonie_cleanup;
+
+        find_audio_gpio("headphone-mute", NULL, &mix->hp_mute_gpio);
+        find_audio_gpio("amp-mute", NULL, &mix->amp_mute_gpio);
+        mix->hp_detect_irq = find_audio_gpio("headphone-detect",
+                                             NULL, &mix->hp_detect_gpio);
+
+        strcpy(chip->card->mixername, "PowerMac Toonie");
+
+        chip->master_sw_ctl = snd_ctl_new1(&toonie_hp_sw, chip);
+        snd_ctl_add(chip->card, chip->master_sw_ctl);
+
+        chip->speaker_sw_ctl = snd_ctl_new1(&toonie_speaker_sw, chip);
+        snd_ctl_add(chip->card, chip->speaker_sw_ctl);
+
+        INIT_WORK(&mix->detect_work, toonie_detect_handler, (void *)chip);
+
+        if (mix->hp_detect_irq >= 0) {
+                snd_pmac_add_automute(chip);
+
+                chip->detect_headphone = toonie_detect_headphone;
+                chip->update_automute = toonie_update_automute;
+                toonie_update_automute(chip, 0);
+
+                if (request_irq(mix->hp_detect_irq, toonie_hp_intr, 0,
+                                "Sound Headphone Detection", chip) < 0)
+                        mix->hp_detect_irq = -1;
+        }
+
+        return 0;
+}
+