1 files changed, 143 insertions, 0 deletions

diff --git a/sound/ppc/keywest.c b/sound/ppc/keywest.c
new file mode 100644
index 000000000000..df073a05b5d7
--- /dev/null
+++ b/sound/ppc/keywest.c
@@ -0,0 +1,143 @@
+/*
+ * common keywest i2c layer
+ *
+ * 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 <sound/driver.h>
+#include <linux/init.h>
+#include <linux/i2c.h>
+#include <linux/delay.h>
+#include <linux/i2c-dev.h>
+#include <linux/slab.h>
+#include <sound/core.h>
+#include "pmac.h"
+
+/*
+ * we have to keep a static variable here since i2c attach_adapter
+ * callback cannot pass a private data.
+ */
+static pmac_keywest_t *keywest_ctx;
+
+
+#define I2C_DRIVERID_KEYWEST    0xFEBA
+
+static int keywest_attach_adapter(struct i2c_adapter *adapter);
+static int keywest_detach_client(struct i2c_client *client);
+
+struct i2c_driver keywest_driver = {  
+        .name = "PMac Keywest Audio",
+        .id = I2C_DRIVERID_KEYWEST,
+        .flags = I2C_DF_NOTIFY,
+        .attach_adapter = &keywest_attach_adapter,
+        .detach_client = &keywest_detach_client,
+};
+
+
+#ifndef i2c_device_name
+#define i2c_device_name(x)      ((x)->name)
+#endif
+
+static int keywest_attach_adapter(struct i2c_adapter *adapter)
+{
+        int err;
+        struct i2c_client *new_client;
+
+        if (! keywest_ctx)
+                return -EINVAL;
+
+        if (strncmp(i2c_device_name(adapter), "mac-io", 6))
+                return 0; /* ignored */
+
+        new_client = kmalloc(sizeof(struct i2c_client), GFP_KERNEL);
+        if (! new_client)
+                return -ENOMEM;
+
+        memset(new_client, 0, sizeof(*new_client));
+        new_client->addr = keywest_ctx->addr;
+        i2c_set_clientdata(new_client, keywest_ctx);
+        new_client->adapter = adapter;
+        new_client->driver = &keywest_driver;
+        new_client->flags = 0;
+
+        strcpy(i2c_device_name(new_client), keywest_ctx->name);
+        keywest_ctx->client = new_client;
+        
+        /* Tell the i2c layer a new client has arrived */
+        if (i2c_attach_client(new_client)) {
+                snd_printk(KERN_ERR "tumbler: cannot attach i2c client\n");
+                err = -ENODEV;
+                goto __err;
+        }
+
+        return 0;
+
+ __err:
+        kfree(new_client);
+        keywest_ctx->client = NULL;
+        return err;
+}
+
+static int keywest_detach_client(struct i2c_client *client)
+{
+        if (! keywest_ctx)
+                return 0;
+        if (client == keywest_ctx->client)
+                keywest_ctx->client = NULL;
+
+        i2c_detach_client(client);
+        kfree(client);
+        return 0;
+}
+
+/* exported */
+void snd_pmac_keywest_cleanup(pmac_keywest_t *i2c)
+{
+        if (keywest_ctx && keywest_ctx == i2c) {
+                i2c_del_driver(&keywest_driver);
+                keywest_ctx = NULL;
+        }
+}
+
+int __init snd_pmac_tumbler_post_init(void)
+{
+        int err;
+        
+        if ((err = keywest_ctx->init_client(keywest_ctx)) < 0) {
+                snd_printk(KERN_ERR "tumbler: %i :cannot initialize the MCS\n", err);
+                return err;
+        }
+        return 0;
+}
+
+/* exported */
+int __init snd_pmac_keywest_init(pmac_keywest_t *i2c)
+{
+        int err;
+
+        if (keywest_ctx)
+                return -EBUSY;
+
+        keywest_ctx = i2c;
+
+        if ((err = i2c_add_driver(&keywest_driver))) {
+                snd_printk(KERN_ERR "cannot register keywest i2c driver\n");
+                return err;
+        }
+        return 0;
+}