899274f2f9b1dd1da0aac0442807b6e42b0cddc2
[linux-3.10.git] / drivers / net / phy / mdio-gpio.c
1 /*
2  * GPIO based MDIO bitbang driver.
3  * Supports OpenFirmware.
4  *
5  * Copyright (c) 2008 CSE Semaphore Belgium.
6  *  by Laurent Pinchart <laurentp@cse-semaphore.com>
7  *
8  * Copyright (C) 2008, Paulius Zaleckas <paulius.zaleckas@teltonika.lt>
9  *
10  * Based on earlier work by
11  *
12  * Copyright (c) 2003 Intracom S.A.
13  *  by Pantelis Antoniou <panto@intracom.gr>
14  *
15  * 2005 (c) MontaVista Software, Inc.
16  * Vitaly Bordug <vbordug@ru.mvista.com>
17  *
18  * This file is licensed under the terms of the GNU General Public License
19  * version 2. This program is licensed "as is" without any warranty of any
20  * kind, whether express or implied.
21  */
22
23 #include <linux/module.h>
24 #include <linux/slab.h>
25 #include <linux/init.h>
26 #include <linux/interrupt.h>
27 #include <linux/platform_device.h>
28 #include <linux/gpio.h>
29 #include <linux/mdio-gpio.h>
30
31 #include <linux/of_gpio.h>
32 #include <linux/of_mdio.h>
33
34 struct mdio_gpio_info {
35         struct mdiobb_ctrl ctrl;
36         int mdc, mdio;
37 };
38
39 static void *mdio_gpio_of_get_data(struct platform_device *pdev)
40 {
41         struct device_node *np = pdev->dev.of_node;
42         struct mdio_gpio_platform_data *pdata;
43         int ret;
44
45         pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
46         if (!pdata)
47                 return NULL;
48
49         ret = of_get_gpio(np, 0);
50         if (ret < 0)
51                 return NULL;
52
53         pdata->mdc = ret;
54
55         ret = of_get_gpio(np, 1);
56         if (ret < 0)
57                 return NULL;
58         pdata->mdio = ret;
59
60         return pdata;
61 }
62
63 static void mdio_dir(struct mdiobb_ctrl *ctrl, int dir)
64 {
65         struct mdio_gpio_info *bitbang =
66                 container_of(ctrl, struct mdio_gpio_info, ctrl);
67
68         if (dir)
69                 gpio_direction_output(bitbang->mdio, 1);
70         else
71                 gpio_direction_input(bitbang->mdio);
72 }
73
74 static int mdio_get(struct mdiobb_ctrl *ctrl)
75 {
76         struct mdio_gpio_info *bitbang =
77                 container_of(ctrl, struct mdio_gpio_info, ctrl);
78
79         return gpio_get_value(bitbang->mdio);
80 }
81
82 static void mdio_set(struct mdiobb_ctrl *ctrl, int what)
83 {
84         struct mdio_gpio_info *bitbang =
85                 container_of(ctrl, struct mdio_gpio_info, ctrl);
86
87         gpio_set_value(bitbang->mdio, what);
88 }
89
90 static void mdc_set(struct mdiobb_ctrl *ctrl, int what)
91 {
92         struct mdio_gpio_info *bitbang =
93                 container_of(ctrl, struct mdio_gpio_info, ctrl);
94
95         gpio_set_value(bitbang->mdc, what);
96 }
97
98 static struct mdiobb_ops mdio_gpio_ops = {
99         .owner = THIS_MODULE,
100         .set_mdc = mdc_set,
101         .set_mdio_dir = mdio_dir,
102         .set_mdio_data = mdio_set,
103         .get_mdio_data = mdio_get,
104 };
105
106 static struct mii_bus * __devinit mdio_gpio_bus_init(struct device *dev,
107                                         struct mdio_gpio_platform_data *pdata,
108                                         int bus_id)
109 {
110         struct mii_bus *new_bus;
111         struct mdio_gpio_info *bitbang;
112         int i;
113
114         bitbang = kzalloc(sizeof(*bitbang), GFP_KERNEL);
115         if (!bitbang)
116                 goto out;
117
118         bitbang->ctrl.ops = &mdio_gpio_ops;
119         bitbang->ctrl.reset = pdata->reset;
120         bitbang->mdc = pdata->mdc;
121         bitbang->mdio = pdata->mdio;
122
123         new_bus = alloc_mdio_bitbang(&bitbang->ctrl);
124         if (!new_bus)
125                 goto out_free_bitbang;
126
127         new_bus->name = "GPIO Bitbanged MDIO",
128
129         new_bus->phy_mask = pdata->phy_mask;
130         new_bus->irq = pdata->irqs;
131         new_bus->parent = dev;
132
133         if (new_bus->phy_mask == ~0)
134                 goto out_free_bus;
135
136         for (i = 0; i < PHY_MAX_ADDR; i++)
137                 if (!new_bus->irq[i])
138                         new_bus->irq[i] = PHY_POLL;
139
140         snprintf(new_bus->id, MII_BUS_ID_SIZE, "gpio-%x", bus_id);
141
142         if (gpio_request(bitbang->mdc, "mdc"))
143                 goto out_free_bus;
144
145         if (gpio_request(bitbang->mdio, "mdio"))
146                 goto out_free_mdc;
147
148         gpio_direction_output(bitbang->mdc, 0);
149
150         dev_set_drvdata(dev, new_bus);
151
152         return new_bus;
153
154 out_free_mdc:
155         gpio_free(bitbang->mdc);
156 out_free_bus:
157         free_mdio_bitbang(new_bus);
158 out_free_bitbang:
159         kfree(bitbang);
160 out:
161         return NULL;
162 }
163
164 static void mdio_gpio_bus_deinit(struct device *dev)
165 {
166         struct mii_bus *bus = dev_get_drvdata(dev);
167         struct mdio_gpio_info *bitbang = bus->priv;
168
169         dev_set_drvdata(dev, NULL);
170         gpio_free(bitbang->mdio);
171         gpio_free(bitbang->mdc);
172         free_mdio_bitbang(bus);
173         kfree(bitbang);
174 }
175
176 static void __devexit mdio_gpio_bus_destroy(struct device *dev)
177 {
178         struct mii_bus *bus = dev_get_drvdata(dev);
179
180         mdiobus_unregister(bus);
181         mdio_gpio_bus_deinit(dev);
182 }
183
184 static int __devinit mdio_gpio_probe(struct platform_device *pdev)
185 {
186         struct mdio_gpio_platform_data *pdata;
187         struct mii_bus *new_bus;
188         int ret;
189
190         if (pdev->dev.of_node)
191                 pdata = mdio_gpio_of_get_data(pdev);
192         else
193                 pdata = pdev->dev.platform_data;
194
195         if (!pdata)
196                 return -ENODEV;
197
198         new_bus = mdio_gpio_bus_init(&pdev->dev, pdata, pdev->id);
199         if (!new_bus)
200                 return -ENODEV;
201
202         if (pdev->dev.of_node)
203                 ret = of_mdiobus_register(new_bus, pdev->dev.of_node);
204         else
205                 ret = mdiobus_register(new_bus);
206
207         if (ret)
208                 mdio_gpio_bus_deinit(&pdev->dev);
209
210         return ret;
211 }
212
213 static int __devexit mdio_gpio_remove(struct platform_device *pdev)
214 {
215         mdio_gpio_bus_destroy(&pdev->dev);
216
217         return 0;
218 }
219
220 static struct of_device_id mdio_gpio_of_match[] = {
221         { .compatible = "virtual,mdio-gpio", },
222         { /* sentinel */ }
223 };
224
225 static struct platform_driver mdio_gpio_driver = {
226         .probe = mdio_gpio_probe,
227         .remove = __devexit_p(mdio_gpio_remove),
228         .driver         = {
229                 .name   = "mdio-gpio",
230                 .owner  = THIS_MODULE,
231                 .of_match_table = mdio_gpio_of_match,
232         },
233 };
234
235 static int __init mdio_gpio_init(void)
236 {
237         return platform_driver_register(&mdio_gpio_driver);
238 }
239 module_init(mdio_gpio_init);
240
241 static void __exit mdio_gpio_exit(void)
242 {
243         platform_driver_unregister(&mdio_gpio_driver);
244 }
245 module_exit(mdio_gpio_exit);
246
247 MODULE_ALIAS("platform:mdio-gpio");
248 MODULE_AUTHOR("Laurent Pinchart, Paulius Zaleckas");
249 MODULE_LICENSE("GPL");
250 MODULE_DESCRIPTION("Generic driver for MDIO bus emulation using GPIO");