1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/init.h>
23#include <linux/i2c.h>
24#include <linux/delay.h>
25#include <sound/core.h>
26#include "pmac.h"
27
28
29
30
31
32static struct pmac_keywest *keywest_ctx;
33
34
35static int keywest_probe(struct i2c_client *client,
36 const struct i2c_device_id *id)
37{
38 i2c_set_clientdata(client, keywest_ctx);
39 return 0;
40}
41
42
43
44
45
46
47static int keywest_attach_adapter(struct i2c_adapter *adapter)
48{
49 struct i2c_board_info info;
50
51 if (! keywest_ctx)
52 return -EINVAL;
53
54 if (strncmp(adapter->name, "mac-io", 6))
55 return 0;
56
57 memset(&info, 0, sizeof(struct i2c_board_info));
58 strlcpy(info.type, "keywest", I2C_NAME_SIZE);
59 info.addr = keywest_ctx->addr;
60 keywest_ctx->client = i2c_new_device(adapter, &info);
61 if (!keywest_ctx->client)
62 return -ENODEV;
63
64
65
66
67
68 if (!keywest_ctx->client->dev.driver) {
69 i2c_unregister_device(keywest_ctx->client);
70 keywest_ctx->client = NULL;
71 return -ENODEV;
72 }
73
74
75
76
77
78 list_add_tail(&keywest_ctx->client->detected,
79 &to_i2c_driver(keywest_ctx->client->dev.driver)->clients);
80 return 0;
81}
82
83static int keywest_remove(struct i2c_client *client)
84{
85 if (! keywest_ctx)
86 return 0;
87 if (client == keywest_ctx->client)
88 keywest_ctx->client = NULL;
89
90 return 0;
91}
92
93
94static const struct i2c_device_id keywest_i2c_id[] = {
95 { "keywest", 0 },
96 { }
97};
98
99static struct i2c_driver keywest_driver = {
100 .driver = {
101 .name = "PMac Keywest Audio",
102 },
103 .attach_adapter = keywest_attach_adapter,
104 .probe = keywest_probe,
105 .remove = keywest_remove,
106 .id_table = keywest_i2c_id,
107};
108
109
110void snd_pmac_keywest_cleanup(struct pmac_keywest *i2c)
111{
112 if (keywest_ctx && keywest_ctx == i2c) {
113 i2c_del_driver(&keywest_driver);
114 keywest_ctx = NULL;
115 }
116}
117
118int snd_pmac_tumbler_post_init(void)
119{
120 int err;
121
122 if (!keywest_ctx || !keywest_ctx->client)
123 return -ENXIO;
124
125 if ((err = keywest_ctx->init_client(keywest_ctx)) < 0) {
126 snd_printk(KERN_ERR "tumbler: %i :cannot initialize the MCS\n", err);
127 return err;
128 }
129 return 0;
130}
131
132
133int snd_pmac_keywest_init(struct pmac_keywest *i2c)
134{
135 int err;
136
137 if (keywest_ctx)
138 return -EBUSY;
139
140 keywest_ctx = i2c;
141
142 if ((err = i2c_add_driver(&keywest_driver))) {
143 snd_printk(KERN_ERR "cannot register keywest i2c driver\n");
144 return err;
145 }
146 return 0;
147}
148