1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * Copyright (c) 2011, NVIDIA Corporation.
6 #include <linux/init.h>
7 #include <linux/kernel.h>
8 #include <linux/module.h>
9 #include <linux/mod_devicetable.h>
10 #include <linux/rfkill.h>
12 #include <linux/platform_device.h>
13 #include <linux/clk.h>
14 #include <linux/slab.h>
15 #include <linux/acpi.h>
16 #include <linux/gpio/consumer.h>
18 struct rfkill_gpio_data
{
20 enum rfkill_type type
;
21 struct gpio_desc
*reset_gpio
;
22 struct gpio_desc
*shutdown_gpio
;
24 struct rfkill
*rfkill_dev
;
30 static int rfkill_gpio_set_power(void *data
, bool blocked
)
32 struct rfkill_gpio_data
*rfkill
= data
;
34 if (!blocked
&& !IS_ERR(rfkill
->clk
) && !rfkill
->clk_enabled
)
35 clk_enable(rfkill
->clk
);
37 gpiod_set_value_cansleep(rfkill
->shutdown_gpio
, !blocked
);
38 gpiod_set_value_cansleep(rfkill
->reset_gpio
, !blocked
);
40 if (blocked
&& !IS_ERR(rfkill
->clk
) && rfkill
->clk_enabled
)
41 clk_disable(rfkill
->clk
);
43 rfkill
->clk_enabled
= !blocked
;
48 static const struct rfkill_ops rfkill_gpio_ops
= {
49 .set_block
= rfkill_gpio_set_power
,
52 static const struct acpi_gpio_params reset_gpios
= { 0, 0, false };
53 static const struct acpi_gpio_params shutdown_gpios
= { 1, 0, false };
55 static const struct acpi_gpio_mapping acpi_rfkill_default_gpios
[] = {
56 { "reset-gpios", &reset_gpios
, 1 },
57 { "shutdown-gpios", &shutdown_gpios
, 1 },
61 static int rfkill_gpio_acpi_probe(struct device
*dev
,
62 struct rfkill_gpio_data
*rfkill
)
64 const struct acpi_device_id
*id
;
66 id
= acpi_match_device(dev
->driver
->acpi_match_table
, dev
);
70 rfkill
->type
= (unsigned)id
->driver_data
;
72 return devm_acpi_dev_add_driver_gpios(dev
, acpi_rfkill_default_gpios
);
75 static int rfkill_gpio_probe(struct platform_device
*pdev
)
77 struct rfkill_gpio_data
*rfkill
;
78 struct gpio_desc
*gpio
;
79 const char *name_property
;
80 const char *type_property
;
81 const char *type_name
;
84 rfkill
= devm_kzalloc(&pdev
->dev
, sizeof(*rfkill
), GFP_KERNEL
);
88 if (dev_of_node(&pdev
->dev
)) {
89 name_property
= "label";
90 type_property
= "radio-type";
92 name_property
= "name";
93 type_property
= "type";
95 device_property_read_string(&pdev
->dev
, name_property
, &rfkill
->name
);
96 device_property_read_string(&pdev
->dev
, type_property
, &type_name
);
99 rfkill
->name
= dev_name(&pdev
->dev
);
101 rfkill
->type
= rfkill_find_type(type_name
);
103 if (ACPI_HANDLE(&pdev
->dev
)) {
104 ret
= rfkill_gpio_acpi_probe(&pdev
->dev
, rfkill
);
109 rfkill
->clk
= devm_clk_get(&pdev
->dev
, NULL
);
111 gpio
= devm_gpiod_get_optional(&pdev
->dev
, "reset", GPIOD_ASIS
);
113 return PTR_ERR(gpio
);
115 rfkill
->reset_gpio
= gpio
;
117 gpio
= devm_gpiod_get_optional(&pdev
->dev
, "shutdown", GPIOD_ASIS
);
119 return PTR_ERR(gpio
);
121 rfkill
->shutdown_gpio
= gpio
;
123 /* Make sure at-least one GPIO is defined for this instance */
124 if (!rfkill
->reset_gpio
&& !rfkill
->shutdown_gpio
) {
125 dev_err(&pdev
->dev
, "invalid platform data\n");
129 ret
= gpiod_direction_output(rfkill
->reset_gpio
, true);
133 ret
= gpiod_direction_output(rfkill
->shutdown_gpio
, true);
137 rfkill
->rfkill_dev
= rfkill_alloc(rfkill
->name
, &pdev
->dev
,
138 rfkill
->type
, &rfkill_gpio_ops
,
140 if (!rfkill
->rfkill_dev
)
143 ret
= rfkill_register(rfkill
->rfkill_dev
);
147 platform_set_drvdata(pdev
, rfkill
);
149 dev_info(&pdev
->dev
, "%s device registered.\n", rfkill
->name
);
154 rfkill_destroy(rfkill
->rfkill_dev
);
159 static int rfkill_gpio_remove(struct platform_device
*pdev
)
161 struct rfkill_gpio_data
*rfkill
= platform_get_drvdata(pdev
);
163 rfkill_unregister(rfkill
->rfkill_dev
);
164 rfkill_destroy(rfkill
->rfkill_dev
);
170 static const struct acpi_device_id rfkill_acpi_match
[] = {
171 { "BCM4752", RFKILL_TYPE_GPS
},
172 { "LNV4752", RFKILL_TYPE_GPS
},
175 MODULE_DEVICE_TABLE(acpi
, rfkill_acpi_match
);
178 static const struct of_device_id rfkill_of_match
[] __maybe_unused
= {
179 { .compatible
= "rfkill-gpio", },
182 MODULE_DEVICE_TABLE(of
, rfkill_of_match
);
184 static struct platform_driver rfkill_gpio_driver
= {
185 .probe
= rfkill_gpio_probe
,
186 .remove
= rfkill_gpio_remove
,
188 .name
= "rfkill_gpio",
189 .acpi_match_table
= ACPI_PTR(rfkill_acpi_match
),
190 .of_match_table
= of_match_ptr(rfkill_of_match
),
194 module_platform_driver(rfkill_gpio_driver
);
196 MODULE_DESCRIPTION("gpio rfkill");
197 MODULE_AUTHOR("NVIDIA");
198 MODULE_LICENSE("GPL");