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