123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176 |
- #include <linux/init.h>
- #include <linux/i2c.h>
- #include <linux/delay.h>
- #include <linux/module.h>
- #include <sound/core.h>
- #include "pmac.h"
- static struct pmac_keywest *keywest_ctx;
- static bool keywest_probed;
- static int keywest_probe(struct i2c_client *client,
- const struct i2c_device_id *id)
- {
- keywest_probed = true;
-
- if (!keywest_ctx->client)
- keywest_ctx->client = client;
- i2c_set_clientdata(client, keywest_ctx);
- return 0;
- }
- static int keywest_attach_adapter(struct i2c_adapter *adapter)
- {
- struct i2c_board_info info;
- if (! keywest_ctx)
- return -EINVAL;
- if (strncmp(adapter->name, "mac-io", 6))
- return -EINVAL;
- memset(&info, 0, sizeof(struct i2c_board_info));
- strlcpy(info.type, "keywest", I2C_NAME_SIZE);
- info.addr = keywest_ctx->addr;
- keywest_ctx->client = i2c_new_device(adapter, &info);
- if (!keywest_ctx->client)
- return -ENODEV;
-
- if (!keywest_ctx->client->dev.driver) {
- i2c_unregister_device(keywest_ctx->client);
- keywest_ctx->client = NULL;
- return -ENODEV;
- }
-
-
- list_add_tail(&keywest_ctx->client->detected,
- &to_i2c_driver(keywest_ctx->client->dev.driver)->clients);
- return 0;
- }
- static int keywest_remove(struct i2c_client *client)
- {
- if (! keywest_ctx)
- return 0;
- if (client == keywest_ctx->client)
- keywest_ctx->client = NULL;
- return 0;
- }
- static const struct i2c_device_id keywest_i2c_id[] = {
- { "MAC,tas3004", 0 },
- { "keywest", 0 },
- { }
- };
- MODULE_DEVICE_TABLE(i2c, keywest_i2c_id);
- static struct i2c_driver keywest_driver = {
- .driver = {
- .name = "PMac Keywest Audio",
- },
- .probe = keywest_probe,
- .remove = keywest_remove,
- .id_table = keywest_i2c_id,
- };
- void snd_pmac_keywest_cleanup(struct pmac_keywest *i2c)
- {
- if (keywest_ctx && keywest_ctx == i2c) {
- i2c_del_driver(&keywest_driver);
- keywest_ctx = NULL;
- }
- }
- int snd_pmac_tumbler_post_init(void)
- {
- int err;
-
- if (!keywest_ctx || !keywest_ctx->client)
- return -ENXIO;
- 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;
- }
- int snd_pmac_keywest_init(struct pmac_keywest *i2c)
- {
- struct i2c_adapter *adap;
- int err, i = 0;
- if (keywest_ctx)
- return -EBUSY;
- adap = i2c_get_adapter(0);
- if (!adap)
- return -EPROBE_DEFER;
- keywest_ctx = i2c;
- if ((err = i2c_add_driver(&keywest_driver))) {
- snd_printk(KERN_ERR "cannot register keywest i2c driver\n");
- i2c_put_adapter(adap);
- return err;
- }
-
- if (keywest_probed)
- return 0;
-
- while (adap) {
-
- err = keywest_attach_adapter(adap);
- if (!err)
- return 0;
- i2c_put_adapter(adap);
- adap = i2c_get_adapter(++i);
- }
- return -ENODEV;
- }
|