1 files changed, 145 insertions, 0 deletions
diff --git a/drivers/net/wireless/rtlwifi/rtl8192ee/led.c b/drivers/net/wireless/rtlwifi/rtl8192ee/led.c
new file mode 100644
index 000000000000..8388e371c8e2
--- /dev/null
+++ b/drivers/net/wireless/rtlwifi/rtl8192ee/led.c
@@ -0,0 +1,145 @@
+/******************************************************************************
+ *
+ * Copyright(c) 2009-2014  Realtek Corporation.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of version 2 of the GNU General Public License as
+ * published by the Free Software Foundation.
+ *
+ * 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.
+ *
+ * The full GNU General Public License is included in this distribution in the
+ * file called LICENSE.
+ *
+ * Contact Information:
+ * wlanfae <wlanfae@realtek.com>
+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
+ * Hsinchu 300, Taiwan.
+ *
+ * Larry Finger <Larry.Finger@lwfinger.net>
+ *
+ *****************************************************************************/
+#include "../wifi.h"
+#include "../pci.h"
+#include "reg.h"
+#include "led.h"
+static void _rtl92ee_init_led(struct ieee80211_hw *hw,
+                              struct rtl_led *pled, enum rtl_led_pin ledpin)
+{
+        pled->hw = hw;
+        pled->ledpin = ledpin;
+        pled->ledon = false;
+}
+void rtl92ee_sw_led_on(struct ieee80211_hw *hw, struct rtl_led *pled)
+{
+        u32 ledcfg;
+        struct rtl_priv *rtlpriv = rtl_priv(hw);
+        RT_TRACE(rtlpriv, COMP_LED, DBG_LOUD,
+                 "LedAddr:%X ledpin=%d\n", REG_LEDCFG2, pled->ledpin);
+        switch (pled->ledpin) {
+        case LED_PIN_GPIO0:
+                break;
+        case LED_PIN_LED0:
+                ledcfg = rtl_read_dword(rtlpriv , REG_GPIO_PIN_CTRL);
+                ledcfg &= ~BIT(13);
+                ledcfg |= BIT(21);
+                ledcfg &= ~BIT(29);
+                rtl_write_dword(rtlpriv, REG_GPIO_PIN_CTRL, ledcfg);
+                break;
+        case LED_PIN_LED1:
+                break;
+        default:
+                RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD,
+                         "switch case not process\n");
+                break;
+        }
+        pled->ledon = true;
+}
+void rtl92ee_sw_led_off(struct ieee80211_hw *hw, struct rtl_led *pled)
+{
+        struct rtl_priv *rtlpriv = rtl_priv(hw);
+        u32 ledcfg;
+        RT_TRACE(rtlpriv, COMP_LED, DBG_LOUD,
+                 "LedAddr:%X ledpin=%d\n", REG_LEDCFG2, pled->ledpin);
+        switch (pled->ledpin) {
+        case LED_PIN_GPIO0:
+                break;
+        case LED_PIN_LED0:
+                ledcfg = rtl_read_dword(rtlpriv , REG_GPIO_PIN_CTRL);
+                ledcfg |= ~BIT(21);
+                ledcfg &= ~BIT(29);
+                rtl_write_dword(rtlpriv, REG_GPIO_PIN_CTRL, ledcfg);
+                break;
+        case LED_PIN_LED1:
+                break;
+        default:
+                RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD,
+                         "switch case not process\n");
+                break;
+        }
+        pled->ledon = false;
+}
+void rtl92ee_init_sw_leds(struct ieee80211_hw *hw)
+{
+        struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
+        _rtl92ee_init_led(hw, &pcipriv->ledctl.sw_led0, LED_PIN_LED0);
+        _rtl92ee_init_led(hw, &pcipriv->ledctl.sw_led1, LED_PIN_LED1);
+}
+static void _rtl92ee_sw_led_control(struct ieee80211_hw *hw,
+                                    enum led_ctl_mode ledaction)
+{
+        struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
+        struct rtl_led *pLed0 = &pcipriv->ledctl.sw_led0;
+        switch (ledaction) {
+        case LED_CTL_POWER_ON:
+        case LED_CTL_LINK:
+        case LED_CTL_NO_LINK:
+                rtl92ee_sw_led_on(hw, pLed0);
+                break;
+        case LED_CTL_POWER_OFF:
+                rtl92ee_sw_led_off(hw, pLed0);
+                break;
+        default:
+                break;
+        }
+}
+void rtl92ee_led_control(struct ieee80211_hw *hw, enum led_ctl_mode ledaction)
+{
+        struct rtl_priv *rtlpriv = rtl_priv(hw);
+        struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
+        if ((ppsc->rfoff_reason > RF_CHANGE_BY_PS) &&
+            (ledaction == LED_CTL_TX ||
+             ledaction == LED_CTL_RX ||
+             ledaction == LED_CTL_SITE_SURVEY ||
+             ledaction == LED_CTL_LINK ||
+             ledaction == LED_CTL_NO_LINK ||
+             ledaction == LED_CTL_START_TO_LINK ||
+             ledaction == LED_CTL_POWER_ON)) {
+                return;
+        }
+        RT_TRACE(rtlpriv, COMP_LED, DBG_TRACE, "ledaction %d,\n", ledaction);
+        _rtl92ee_sw_led_control(hw, ledaction);
+}

diff --git a/drivers/net/wireless/rtlwifi/rtl8192ee/led.c b/drivers/net/wireless/rtlwifi/rtl8192ee/led.c new file mode 100644 index 000000000000..8388e371c8e2 --- /dev/null +++ b/drivers/net/wireless/rtlwifi/rtl8192ee/led.c
@@ -0,0 +1,145 @@
	1	/******************************************************************************
	2	*
	3	* Copyright(c) 2009-2014 Realtek Corporation.
	4	*
	5	* This program is free software; you can redistribute it and/or modify it
	6	* under the terms of version 2 of the GNU General Public License as
	7	* published by the Free Software Foundation.
	8	*
	9	* This program is distributed in the hope that it will be useful, but WITHOUT
	10	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	11	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	12	* more details.
	13	*
	14	* The full GNU General Public License is included in this distribution in the
	15	* file called LICENSE.
	16	*
	17	* Contact Information:
	18	* wlanfae <wlanfae@realtek.com>
	19	* Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
	20	* Hsinchu 300, Taiwan.
	21	*
	22	* Larry Finger <Larry.Finger@lwfinger.net>
	23	*
	24	*****************************************************************************/
	25
	26	#include "../wifi.h"
	27	#include "../pci.h"
	28	#include "reg.h"
	29	#include "led.h"
	30
	31	static void _rtl92ee_init_led(struct ieee80211_hw *hw,
	32	struct rtl_led *pled, enum rtl_led_pin ledpin)
	33	{
	34	pled->hw = hw;
	35	pled->ledpin = ledpin;
	36	pled->ledon = false;
	37	}
	38
	39	void rtl92ee_sw_led_on(struct ieee80211_hw hw, struct rtl_led pled)
	40	{
	41	u32 ledcfg;
	42	struct rtl_priv *rtlpriv = rtl_priv(hw);
	43
	44	RT_TRACE(rtlpriv, COMP_LED, DBG_LOUD,
	45	"LedAddr:%X ledpin=%d\n", REG_LEDCFG2, pled->ledpin);
	46
	47	switch (pled->ledpin) {
	48	case LED_PIN_GPIO0:
	49	break;
	50	case LED_PIN_LED0:
	51	ledcfg = rtl_read_dword(rtlpriv , REG_GPIO_PIN_CTRL);
	52	ledcfg &= ~BIT(13);
	53	ledcfg \|= BIT(21);
	54	ledcfg &= ~BIT(29);
	55
	56	rtl_write_dword(rtlpriv, REG_GPIO_PIN_CTRL, ledcfg);
	57
	58	break;
	59	case LED_PIN_LED1:
	60
	61	break;
	62	default:
	63	RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD,
	64	"switch case not process\n");
	65	break;
	66	}
	67	pled->ledon = true;
	68	}
	69
	70	void rtl92ee_sw_led_off(struct ieee80211_hw hw, struct rtl_led pled)
	71	{
	72	struct rtl_priv *rtlpriv = rtl_priv(hw);
	73	u32 ledcfg;
	74
	75	RT_TRACE(rtlpriv, COMP_LED, DBG_LOUD,
	76	"LedAddr:%X ledpin=%d\n", REG_LEDCFG2, pled->ledpin);
	77
	78	switch (pled->ledpin) {
	79	case LED_PIN_GPIO0:
	80	break;
	81	case LED_PIN_LED0:
	82
	83	ledcfg = rtl_read_dword(rtlpriv , REG_GPIO_PIN_CTRL);
	84	ledcfg \|= ~BIT(21);
	85	ledcfg &= ~BIT(29);
	86	rtl_write_dword(rtlpriv, REG_GPIO_PIN_CTRL, ledcfg);
	87
	88	break;
	89	case LED_PIN_LED1:
	90
	91	break;
	92	default:
	93	RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD,
	94	"switch case not process\n");
	95	break;
	96	}
	97	pled->ledon = false;
	98	}
	99
	100	void rtl92ee_init_sw_leds(struct ieee80211_hw *hw)
	101	{
	102	struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
	103
	104	_rtl92ee_init_led(hw, &pcipriv->ledctl.sw_led0, LED_PIN_LED0);
	105	_rtl92ee_init_led(hw, &pcipriv->ledctl.sw_led1, LED_PIN_LED1);
	106	}
	107
	108	static void _rtl92ee_sw_led_control(struct ieee80211_hw *hw,
	109	enum led_ctl_mode ledaction)
	110	{
	111	struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
	112	struct rtl_led *pLed0 = &pcipriv->ledctl.sw_led0;
	113
	114	switch (ledaction) {
	115	case LED_CTL_POWER_ON:
	116	case LED_CTL_LINK:
	117	case LED_CTL_NO_LINK:
	118	rtl92ee_sw_led_on(hw, pLed0);
	119	break;
	120	case LED_CTL_POWER_OFF:
	121	rtl92ee_sw_led_off(hw, pLed0);
	122	break;
	123	default:
	124	break;
	125	}
	126	}
	127
	128	void rtl92ee_led_control(struct ieee80211_hw *hw, enum led_ctl_mode ledaction)
	129	{
	130	struct rtl_priv *rtlpriv = rtl_priv(hw);
	131	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	132
	133	if ((ppsc->rfoff_reason > RF_CHANGE_BY_PS) &&
	134	(ledaction == LED_CTL_TX \|\|
	135	ledaction == LED_CTL_RX \|\|
	136	ledaction == LED_CTL_SITE_SURVEY \|\|
	137	ledaction == LED_CTL_LINK \|\|
	138	ledaction == LED_CTL_NO_LINK \|\|
	139	ledaction == LED_CTL_START_TO_LINK \|\|
	140	ledaction == LED_CTL_POWER_ON)) {
	141	return;
	142	}
	143	RT_TRACE(rtlpriv, COMP_LED, DBG_TRACE, "ledaction %d,\n", ledaction);
	144	_rtl92ee_sw_led_control(hw, ledaction);
	145	}