Merge branch 'fix/asoc' into for-linus
[linux-2.6] / arch / powerpc / platforms / 83xx / mcu_mpc8349emitx.c
1 /*
2  * Power Management and GPIO expander driver for MPC8349E-mITX-compatible MCU
3  *
4  * Copyright (c) 2008  MontaVista Software, Inc.
5  *
6  * Author: Anton Vorontsov <avorontsov@ru.mvista.com>
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License as published by
10  * the Free Software Foundation; either version 2 of the License, or
11  * (at your option) any later version.
12  */
13
14 #include <linux/init.h>
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/device.h>
18 #include <linux/mutex.h>
19 #include <linux/i2c.h>
20 #include <linux/gpio.h>
21 #include <linux/of.h>
22 #include <linux/of_gpio.h>
23 #include <asm/prom.h>
24 #include <asm/machdep.h>
25
26 /*
27  * I don't have specifications for the MCU firmware, I found this register
28  * and bits positions by the trial&error method.
29  */
30 #define MCU_REG_CTRL    0x20
31 #define MCU_CTRL_POFF   0x40
32
33 #define MCU_NUM_GPIO    2
34
35 struct mcu {
36         struct mutex lock;
37         struct device_node *np;
38         struct i2c_client *client;
39         struct of_gpio_chip of_gc;
40         u8 reg_ctrl;
41 };
42
43 static struct mcu *glob_mcu;
44
45 static void mcu_power_off(void)
46 {
47         struct mcu *mcu = glob_mcu;
48
49         pr_info("Sending power-off request to the MCU...\n");
50         mutex_lock(&mcu->lock);
51         i2c_smbus_write_byte_data(glob_mcu->client, MCU_REG_CTRL,
52                                   mcu->reg_ctrl | MCU_CTRL_POFF);
53         mutex_unlock(&mcu->lock);
54 }
55
56 static void mcu_gpio_set(struct gpio_chip *gc, unsigned int gpio, int val)
57 {
58         struct of_gpio_chip *of_gc = to_of_gpio_chip(gc);
59         struct mcu *mcu = container_of(of_gc, struct mcu, of_gc);
60         u8 bit = 1 << (4 + gpio);
61
62         mutex_lock(&mcu->lock);
63         if (val)
64                 mcu->reg_ctrl &= ~bit;
65         else
66                 mcu->reg_ctrl |= bit;
67
68         i2c_smbus_write_byte_data(mcu->client, MCU_REG_CTRL, mcu->reg_ctrl);
69         mutex_unlock(&mcu->lock);
70 }
71
72 static int mcu_gpio_dir_out(struct gpio_chip *gc, unsigned int gpio, int val)
73 {
74         mcu_gpio_set(gc, gpio, val);
75         return 0;
76 }
77
78 static int mcu_gpiochip_add(struct mcu *mcu)
79 {
80         struct device_node *np;
81         struct of_gpio_chip *of_gc = &mcu->of_gc;
82         struct gpio_chip *gc = &of_gc->gc;
83         int ret;
84
85         np = of_find_compatible_node(NULL, NULL, "fsl,mcu-mpc8349emitx");
86         if (!np)
87                 return -ENODEV;
88
89         gc->owner = THIS_MODULE;
90         gc->label = np->full_name;
91         gc->can_sleep = 1;
92         gc->ngpio = MCU_NUM_GPIO;
93         gc->base = -1;
94         gc->set = mcu_gpio_set;
95         gc->direction_output = mcu_gpio_dir_out;
96         of_gc->gpio_cells = 2;
97         of_gc->xlate = of_gpio_simple_xlate;
98
99         np->data = of_gc;
100         mcu->np = np;
101
102         /*
103          * We don't want to lose the node, its ->data and ->full_name...
104          * So, if succeeded, we don't put the node here.
105          */
106         ret = gpiochip_add(gc);
107         if (ret)
108                 of_node_put(np);
109         return ret;
110 }
111
112 static int mcu_gpiochip_remove(struct mcu *mcu)
113 {
114         int ret;
115
116         ret = gpiochip_remove(&mcu->of_gc.gc);
117         if (ret)
118                 return ret;
119         of_node_put(mcu->np);
120
121         return 0;
122 }
123
124 static int __devinit mcu_probe(struct i2c_client *client,
125                                const struct i2c_device_id *id)
126 {
127         struct mcu *mcu;
128         int ret;
129
130         mcu = kzalloc(sizeof(*mcu), GFP_KERNEL);
131         if (!mcu)
132                 return -ENOMEM;
133
134         mutex_init(&mcu->lock);
135         mcu->client = client;
136         i2c_set_clientdata(client, mcu);
137
138         ret = i2c_smbus_read_byte_data(mcu->client, MCU_REG_CTRL);
139         if (ret < 0)
140                 goto err;
141         mcu->reg_ctrl = ret;
142
143         ret = mcu_gpiochip_add(mcu);
144         if (ret)
145                 goto err;
146
147         /* XXX: this is potentially racy, but there is no lock for ppc_md */
148         if (!ppc_md.power_off) {
149                 glob_mcu = mcu;
150                 ppc_md.power_off = mcu_power_off;
151                 dev_info(&client->dev, "will provide power-off service\n");
152         }
153
154         return 0;
155 err:
156         kfree(mcu);
157         return ret;
158 }
159
160 static int __devexit mcu_remove(struct i2c_client *client)
161 {
162         struct mcu *mcu = i2c_get_clientdata(client);
163         int ret;
164
165         if (glob_mcu == mcu) {
166                 ppc_md.power_off = NULL;
167                 glob_mcu = NULL;
168         }
169
170         ret = mcu_gpiochip_remove(mcu);
171         if (ret)
172                 return ret;
173         i2c_set_clientdata(client, NULL);
174         kfree(mcu);
175         return 0;
176 }
177
178 static const struct i2c_device_id mcu_ids[] = {
179         { "mcu-mpc8349emitx", },
180         {},
181 };
182 MODULE_DEVICE_TABLE(i2c, mcu_ids);
183
184 static struct i2c_driver mcu_driver = {
185         .driver = {
186                 .name = "mcu-mpc8349emitx",
187                 .owner = THIS_MODULE,
188         },
189         .probe = mcu_probe,
190         .remove = __devexit_p(mcu_remove),
191         .id_table = mcu_ids,
192 };
193
194 static int __init mcu_init(void)
195 {
196         return i2c_add_driver(&mcu_driver);
197 }
198 module_init(mcu_init);
199
200 static void __exit mcu_exit(void)
201 {
202         i2c_del_driver(&mcu_driver);
203 }
204 module_exit(mcu_exit);
205
206 MODULE_DESCRIPTION("Power Management and GPIO expander driver for "
207                    "MPC8349E-mITX-compatible MCU");
208 MODULE_AUTHOR("Anton Vorontsov <avorontsov@ru.mvista.com>");
209 MODULE_LICENSE("GPL");