+++ /dev/null
-From adf0f7b7d7c0083dd936fe46423b89e974f8df12 Mon Sep 17 00:00:00 2001
-From: Vladimir Ermakov <vooon341@gmail.com>
-Date: Wed, 10 Jul 2013 03:06:54 +0400
-Subject: [PATCH] ARM i.MX6 Wandboard add wifi+bt rfkill driver
-
-BRCM WiFi module requires initialization for control gpio;
-Additional provides rfkill funcs.
-
-v2: fix wrong probe func in driver struct
-v3: add imx6qdl compatible
-
-Signed-off-by: Vladimir Ermakov <vooon341@gmail.com>
----
- arch/arm/mach-imx/devices/Kconfig | 6 +
- arch/arm/mach-imx/devices/Makefile | 1 +
- arch/arm/mach-imx/devices/wand-rfkill.c | 290 ++++++++++++++++++++++++++++++++
- 3 files changed, 297 insertions(+)
- create mode 100644 arch/arm/mach-imx/devices/wand-rfkill.c
-
-diff --git a/arch/arm/mach-imx/devices/Kconfig b/arch/arm/mach-imx/devices/Kconfig
-index 68c74fb..a0adf75 100644
---- a/arch/arm/mach-imx/devices/Kconfig
-+++ b/arch/arm/mach-imx/devices/Kconfig
-@@ -85,3 +85,9 @@ config IMX_HAVE_PLATFORM_SDHCI_ESDHC_IMX
-
- config IMX_HAVE_PLATFORM_SPI_IMX
- bool
-+
-+config WAND_RFKILL
-+ tristate "Wandboard RF Kill support"
-+ depends on SOC_IMX6Q
-+ default m
-+ select RFKILL
-diff --git a/arch/arm/mach-imx/devices/Makefile b/arch/arm/mach-imx/devices/Makefile
-index 67416fb..b2aded5 100644
---- a/arch/arm/mach-imx/devices/Makefile
-+++ b/arch/arm/mach-imx/devices/Makefile
-@@ -30,3 +30,4 @@ obj-$(CONFIG_IMX_HAVE_PLATFORM_MXC_W1) += platform-mxc_w1.o
- obj-$(CONFIG_IMX_HAVE_PLATFORM_SDHCI_ESDHC_IMX) += platform-sdhci-esdhc-imx.o
- obj-$(CONFIG_IMX_HAVE_PLATFORM_SPI_IMX) += platform-spi_imx.o
- obj-$(CONFIG_IMX_HAVE_PLATFORM_MX2_EMMA) += platform-mx2-emma.o
-+obj-$(CONFIG_WAND_RFKILL) += wand-rfkill.o
-diff --git a/arch/arm/mach-imx/devices/wand-rfkill.c b/arch/arm/mach-imx/devices/wand-rfkill.c
-new file mode 100644
-index 0000000..da7ef9f
---- /dev/null
-+++ b/arch/arm/mach-imx/devices/wand-rfkill.c
-@@ -0,0 +1,290 @@
-+/*
-+ * arch/arm/mach-imx/devices/wand-rfkill.c
-+ *
-+ * Copyright (C) 2013 Vladimir Ermakov <vooon341@gmail.com>
-+ *
-+ * based on net/rfkill/rfkill-gpio.c
-+ *
-+ * This software is licensed under the terms of the GNU General Public
-+ * License version 2, as published by the Free Software Foundation, and
-+ * may be copied, distributed, and modified under those terms.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ */
-+
-+#include <linux/of.h>
-+#include <linux/of_gpio.h>
-+#include <linux/of_device.h>
-+#include <linux/pinctrl/consumer.h>
-+#include <linux/platform_device.h>
-+#include <linux/rfkill.h>
-+#include <linux/delay.h>
-+#include <linux/kernel.h>
-+#include <linux/module.h>
-+#include <linux/slab.h>
-+
-+
-+struct wand_rfkill_data {
-+ struct rfkill *rfkill_dev;
-+ int shutdown_gpio;
-+ const char *shutdown_name;
-+};
-+
-+static int wand_rfkill_set_block(void *data, bool blocked)
-+{
-+ struct wand_rfkill_data *rfkill = data;
-+
-+ pr_debug("wandboard-rfkill: set block %d\n", blocked);
-+
-+ if (blocked) {
-+ if (gpio_is_valid(rfkill->shutdown_gpio))
-+ gpio_direction_output(rfkill->shutdown_gpio, 0);
-+ } else {
-+ if (gpio_is_valid(rfkill->shutdown_gpio))
-+ gpio_direction_output(rfkill->shutdown_gpio, 1);
-+ }
-+
-+ return 0;
-+}
-+
-+static const struct rfkill_ops wand_rfkill_ops = {
-+ .set_block = wand_rfkill_set_block,
-+};
-+
-+static int wand_rfkill_wifi_probe(struct device *dev,
-+ struct device_node *np,
-+ struct wand_rfkill_data *rfkill)
-+{
-+ int ret;
-+ int wl_ref_on, wl_rst_n, wl_reg_on, wl_wake, wl_host_wake;
-+
-+ wl_ref_on = of_get_named_gpio(np, "wifi-ref-on", 0);
-+ wl_rst_n = of_get_named_gpio(np, "wifi-rst-n", 0);
-+ wl_reg_on = of_get_named_gpio(np, "wifi-reg-on", 0);
-+ wl_wake = of_get_named_gpio(np, "wifi-wake", 0);
-+ wl_host_wake = of_get_named_gpio(np, "wifi-host-wake", 0);
-+
-+ if (!gpio_is_valid(wl_rst_n) || !gpio_is_valid(wl_ref_on) ||
-+ !gpio_is_valid(wl_reg_on) || !gpio_is_valid(wl_wake) ||
-+ !gpio_is_valid(wl_host_wake)) {
-+
-+ dev_err(dev, "incorrect wifi gpios (%d %d %d %d %d)\n",
-+ wl_rst_n, wl_ref_on, wl_reg_on, wl_wake, wl_host_wake);
-+ return -EINVAL;
-+ }
-+
-+ dev_info(dev, "initialize wifi chip\n");
-+
-+ gpio_request(wl_rst_n, "wl_rst_n");
-+ gpio_direction_output(wl_rst_n, 0);
-+ msleep(11);
-+ gpio_set_value(wl_rst_n, 1);
-+
-+ gpio_request(wl_ref_on, "wl_ref_on");
-+ gpio_direction_output(wl_ref_on, 1);
-+
-+ gpio_request(wl_reg_on, "wl_reg_on");
-+ gpio_direction_output(wl_reg_on, 1);
-+
-+ gpio_request(wl_wake, "wl_wake");
-+ gpio_direction_output(wl_wake, 1);
-+
-+ gpio_request(wl_host_wake, "wl_host_wake");
-+ gpio_direction_input(wl_host_wake);
-+
-+ rfkill->shutdown_name = "wifi_shutdown";
-+ rfkill->shutdown_gpio = wl_wake;
-+
-+ rfkill->rfkill_dev = rfkill_alloc("wifi-rfkill", dev, RFKILL_TYPE_WLAN,
-+ &wand_rfkill_ops, rfkill);
-+ if (!rfkill->rfkill_dev) {
-+ ret = -ENOMEM;
-+ goto wifi_fail_free_gpio;
-+ }
-+
-+ ret = rfkill_register(rfkill->rfkill_dev);
-+ if (ret < 0)
-+ goto wifi_fail_unregister;
-+
-+ dev_info(dev, "wifi-rfkill registered.\n");
-+
-+ return 0;
-+
-+wifi_fail_unregister:
-+ rfkill_destroy(rfkill->rfkill_dev);
-+wifi_fail_free_gpio:
-+ if (gpio_is_valid(wl_rst_n)) gpio_free(wl_rst_n);
-+ if (gpio_is_valid(wl_ref_on)) gpio_free(wl_ref_on);
-+ if (gpio_is_valid(wl_reg_on)) gpio_free(wl_reg_on);
-+ if (gpio_is_valid(wl_wake)) gpio_free(wl_wake);
-+ if (gpio_is_valid(wl_host_wake)) gpio_free(wl_host_wake);
-+
-+ return ret;
-+}
-+
-+static int wand_rfkill_bt_probe(struct device *dev,
-+ struct device_node *np,
-+ struct wand_rfkill_data *rfkill)
-+{
-+ int ret;
-+ int bt_on, bt_wake, bt_host_wake;
-+
-+ bt_on = of_get_named_gpio(np, "bluetooth-on", 0);
-+ bt_wake = of_get_named_gpio(np, "bluetooth-wake", 0);
-+ bt_host_wake = of_get_named_gpio(np, "bluetooth-host-wake", 0);
-+
-+ if (!gpio_is_valid(bt_on) || !gpio_is_valid(bt_wake) ||
-+ !gpio_is_valid(bt_host_wake)) {
-+
-+ dev_err(dev, "incorrect bt gpios (%d %d %d)\n",
-+ bt_on, bt_wake, bt_host_wake);
-+ return -EINVAL;
-+ }
-+
-+ dev_info(dev, "initialize bluetooth chip\n");
-+
-+ gpio_request(bt_on, "bt_on");
-+ gpio_direction_output(bt_on, 0);
-+ msleep(11);
-+ gpio_set_value(bt_on, 1);
-+
-+ gpio_request(bt_wake, "bt_wake");
-+ gpio_direction_output(bt_wake, 1);
-+
-+ gpio_request(bt_host_wake, "bt_host_wake");
-+ gpio_direction_input(bt_host_wake);
-+
-+ rfkill->shutdown_name = "bluetooth_shutdown";
-+ rfkill->shutdown_gpio = bt_wake;
-+
-+ rfkill->rfkill_dev = rfkill_alloc("bluetooth-rfkill", dev, RFKILL_TYPE_BLUETOOTH,
-+ &wand_rfkill_ops, rfkill);
-+ if (!rfkill->rfkill_dev) {
-+ ret = -ENOMEM;
-+ goto bt_fail_free_gpio;
-+ }
-+
-+ ret = rfkill_register(rfkill->rfkill_dev);
-+ if (ret < 0)
-+ goto bt_fail_unregister;
-+
-+ dev_info(dev, "bluetooth-rfkill registered.\n");
-+
-+ return 0;
-+
-+bt_fail_unregister:
-+ rfkill_destroy(rfkill->rfkill_dev);
-+bt_fail_free_gpio:
-+ if (gpio_is_valid(bt_on)) gpio_free(bt_on);
-+ if (gpio_is_valid(bt_wake)) gpio_free(bt_wake);
-+ if (gpio_is_valid(bt_host_wake)) gpio_free(bt_host_wake);
-+
-+ return ret;
-+}
-+
-+static int wand_rfkill_probe(struct platform_device *pdev)
-+{
-+ struct wand_rfkill_data *rfkill;
-+ struct pinctrl *pinctrl;
-+ int ret;
-+
-+ dev_info(&pdev->dev, "Wandboard rfkill initialization\n");
-+
-+ if (!pdev->dev.of_node) {
-+ dev_err(&pdev->dev, "no device tree node\n");
-+ return -ENODEV;
-+ }
-+
-+ rfkill = kzalloc(sizeof(*rfkill) * 2, GFP_KERNEL);
-+ if (!rfkill)
-+ return -ENOMEM;
-+
-+ pinctrl = devm_pinctrl_get_select_default(&pdev->dev);
-+ if (IS_ERR(pinctrl)) {
-+ int ret = PTR_ERR(pinctrl);
-+ dev_err(&pdev->dev, "failed to get default pinctrl: %d\n", ret);
-+ return ret;
-+ }
-+
-+ /* setup WiFi */
-+ ret = wand_rfkill_wifi_probe(&pdev->dev, pdev->dev.of_node, &rfkill[0]);
-+ if (ret < 0)
-+ goto fail_free_rfkill;
-+
-+ /* setup bluetooth */
-+ ret = wand_rfkill_bt_probe(&pdev->dev, pdev->dev.of_node, &rfkill[1]);
-+ if (ret < 0)
-+ goto fail_unregister_wifi;
-+
-+ platform_set_drvdata(pdev, rfkill);
-+
-+ return 0;
-+
-+fail_unregister_wifi:
-+ if (rfkill[1].rfkill_dev) {
-+ rfkill_unregister(rfkill[1].rfkill_dev);
-+ rfkill_destroy(rfkill[1].rfkill_dev);
-+ }
-+
-+ /* TODO free gpio */
-+
-+fail_free_rfkill:
-+ kfree(rfkill);
-+
-+ return ret;
-+}
-+
-+static int wand_rfkill_remove(struct platform_device *pdev)
-+{
-+ struct wand_rfkill_data *rfkill = platform_get_drvdata(pdev);
-+
-+ dev_info(&pdev->dev, "Module unloading\n");
-+
-+ if (!rfkill)
-+ return 0;
-+
-+ /* WiFi */
-+ if (gpio_is_valid(rfkill[0].shutdown_gpio))
-+ gpio_free(rfkill[0].shutdown_gpio);
-+
-+ rfkill_unregister(rfkill[0].rfkill_dev);
-+ rfkill_destroy(rfkill[0].rfkill_dev);
-+
-+ /* Bt */
-+ if (gpio_is_valid(rfkill[1].shutdown_gpio))
-+ gpio_free(rfkill[1].shutdown_gpio);
-+
-+ rfkill_unregister(rfkill[1].rfkill_dev);
-+ rfkill_destroy(rfkill[1].rfkill_dev);
-+
-+ kfree(rfkill);
-+
-+ return 0;
-+}
-+
-+static struct of_device_id wand_rfkill_match[] = {
-+ { .compatible = "wand,imx6q-wandboard-rfkill", },
-+ { .compatible = "wand,imx6dl-wandboard-rfkill", },
-+ { .compatible = "wand,imx6qdl-wandboard-rfkill", },
-+ {}
-+};
-+
-+static struct platform_driver wand_rfkill_driver = {
-+ .driver = {
-+ .name = "wandboard-rfkill",
-+ .owner = THIS_MODULE,
-+ .of_match_table = of_match_ptr(wand_rfkill_match),
-+ },
-+ .probe = wand_rfkill_probe,
-+ .remove = wand_rfkill_remove
-+};
-+
-+module_platform_driver(wand_rfkill_driver);
-+
-+MODULE_AUTHOR("Vladimir Ermakov <vooon341@gmail.com>");
-+MODULE_DESCRIPTION("Wandboard rfkill driver");
-+MODULE_LICENSE("GPL v2");
---
-1.8.4.rc3
-