1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* |
3 | * Copyright (C) 2011, 2012 Cavium, Inc. |
4 | */ |
5 | |
6 | #include <linux/device.h> |
7 | #include <linux/gpio/consumer.h> |
8 | #include <linux/mdio-mux.h> |
9 | #include <linux/module.h> |
10 | #include <linux/of_mdio.h> |
11 | #include <linux/phy.h> |
12 | #include <linux/platform_device.h> |
13 | |
14 | #define DRV_VERSION "1.1" |
15 | #define DRV_DESCRIPTION "GPIO controlled MDIO bus multiplexer driver" |
16 | |
17 | struct mdio_mux_gpio_state { |
18 | struct gpio_descs *gpios; |
19 | void *mux_handle; |
20 | }; |
21 | |
22 | static int mdio_mux_gpio_switch_fn(int current_child, int desired_child, |
23 | void *data) |
24 | { |
25 | struct mdio_mux_gpio_state *s = data; |
26 | DECLARE_BITMAP(values, BITS_PER_TYPE(desired_child)); |
27 | |
28 | if (current_child == desired_child) |
29 | return 0; |
30 | |
31 | values[0] = desired_child; |
32 | |
33 | gpiod_set_array_value_cansleep(array_size: s->gpios->ndescs, desc_array: s->gpios->desc, |
34 | array_info: s->gpios->info, value_bitmap: values); |
35 | |
36 | return 0; |
37 | } |
38 | |
39 | static int mdio_mux_gpio_probe(struct platform_device *pdev) |
40 | { |
41 | struct mdio_mux_gpio_state *s; |
42 | struct gpio_descs *gpios; |
43 | int r; |
44 | |
45 | gpios = devm_gpiod_get_array(dev: &pdev->dev, NULL, flags: GPIOD_OUT_LOW); |
46 | if (IS_ERR(ptr: gpios)) |
47 | return PTR_ERR(ptr: gpios); |
48 | |
49 | s = devm_kzalloc(dev: &pdev->dev, size: sizeof(*s), GFP_KERNEL); |
50 | if (!s) |
51 | return -ENOMEM; |
52 | |
53 | s->gpios = gpios; |
54 | |
55 | r = mdio_mux_init(dev: &pdev->dev, mux_node: pdev->dev.of_node, |
56 | switch_fn: mdio_mux_gpio_switch_fn, mux_handle: &s->mux_handle, data: s, NULL); |
57 | |
58 | if (r != 0) |
59 | return r; |
60 | |
61 | pdev->dev.platform_data = s; |
62 | return 0; |
63 | } |
64 | |
65 | static void mdio_mux_gpio_remove(struct platform_device *pdev) |
66 | { |
67 | struct mdio_mux_gpio_state *s = dev_get_platdata(dev: &pdev->dev); |
68 | mdio_mux_uninit(mux_handle: s->mux_handle); |
69 | } |
70 | |
71 | static const struct of_device_id mdio_mux_gpio_match[] = { |
72 | { |
73 | .compatible = "mdio-mux-gpio" , |
74 | }, |
75 | { |
76 | /* Legacy compatible property. */ |
77 | .compatible = "cavium,mdio-mux-sn74cbtlv3253" , |
78 | }, |
79 | {}, |
80 | }; |
81 | MODULE_DEVICE_TABLE(of, mdio_mux_gpio_match); |
82 | |
83 | static struct platform_driver mdio_mux_gpio_driver = { |
84 | .driver = { |
85 | .name = "mdio-mux-gpio" , |
86 | .of_match_table = mdio_mux_gpio_match, |
87 | }, |
88 | .probe = mdio_mux_gpio_probe, |
89 | .remove_new = mdio_mux_gpio_remove, |
90 | }; |
91 | |
92 | module_platform_driver(mdio_mux_gpio_driver); |
93 | |
94 | MODULE_DESCRIPTION(DRV_DESCRIPTION); |
95 | MODULE_VERSION(DRV_VERSION); |
96 | MODULE_AUTHOR("David Daney" ); |
97 | MODULE_LICENSE("GPL v2" ); |
98 | |