1f1d2b4d3SLarry Finger /****************************************************************************** 2f1d2b4d3SLarry Finger * 3f1d2b4d3SLarry Finger * Copyright(c) 2009-2012 Realtek Corporation. 4f1d2b4d3SLarry Finger * 5f1d2b4d3SLarry Finger * This program is free software; you can redistribute it and/or modify it 6f1d2b4d3SLarry Finger * under the terms of version 2 of the GNU General Public License as 7f1d2b4d3SLarry Finger * published by the Free Software Foundation. 8f1d2b4d3SLarry Finger * 9f1d2b4d3SLarry Finger * This program is distributed in the hope that it will be useful, but WITHOUT 10f1d2b4d3SLarry Finger * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 11f1d2b4d3SLarry Finger * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 12f1d2b4d3SLarry Finger * more details. 13f1d2b4d3SLarry Finger * 14f1d2b4d3SLarry Finger * You should have received a copy of the GNU General Public License along with 15f1d2b4d3SLarry Finger * this program; if not, write to the Free Software Foundation, Inc., 16f1d2b4d3SLarry Finger * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA 17f1d2b4d3SLarry Finger * 18f1d2b4d3SLarry Finger * The full GNU General Public License is included in this distribution in the 19f1d2b4d3SLarry Finger * file called LICENSE. 20f1d2b4d3SLarry Finger * 21f1d2b4d3SLarry Finger * Contact Information: 22f1d2b4d3SLarry Finger * wlanfae <wlanfae@realtek.com> 23f1d2b4d3SLarry Finger * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, 24f1d2b4d3SLarry Finger * Hsinchu 300, Taiwan. 25f1d2b4d3SLarry Finger * 26f1d2b4d3SLarry Finger * Larry Finger <Larry.Finger@lwfinger.net> 27f1d2b4d3SLarry Finger * 28f1d2b4d3SLarry Finger *****************************************************************************/ 29f1d2b4d3SLarry Finger 30f1d2b4d3SLarry Finger #include "../wifi.h" 31f1d2b4d3SLarry Finger #include "../pci.h" 32f1d2b4d3SLarry Finger #include "reg.h" 33f1d2b4d3SLarry Finger #include "led.h" 34f1d2b4d3SLarry Finger 35f1d2b4d3SLarry Finger static void _rtl8723e_init_led(struct ieee80211_hw *hw, 36f1d2b4d3SLarry Finger struct rtl_led *pled, enum rtl_led_pin ledpin) 37f1d2b4d3SLarry Finger { 38f1d2b4d3SLarry Finger pled->hw = hw; 39f1d2b4d3SLarry Finger pled->ledpin = ledpin; 40f1d2b4d3SLarry Finger pled->ledon = false; 41f1d2b4d3SLarry Finger } 42f1d2b4d3SLarry Finger 43f1d2b4d3SLarry Finger void rtl8723e_sw_led_on(struct ieee80211_hw *hw, struct rtl_led *pled) 44f1d2b4d3SLarry Finger { 45f1d2b4d3SLarry Finger u8 ledcfg; 46f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw); 47f1d2b4d3SLarry Finger 48f1d2b4d3SLarry Finger RT_TRACE(rtlpriv, COMP_LED, DBG_LOUD, 49f1d2b4d3SLarry Finger "LedAddr:%X ledpin=%d\n", REG_LEDCFG2, pled->ledpin); 50f1d2b4d3SLarry Finger 51f1d2b4d3SLarry Finger switch (pled->ledpin) { 52f1d2b4d3SLarry Finger case LED_PIN_GPIO0: 53f1d2b4d3SLarry Finger break; 54f1d2b4d3SLarry Finger case LED_PIN_LED0: 55f1d2b4d3SLarry Finger ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG2); 56f1d2b4d3SLarry Finger ledcfg &= ~BIT(6); 57f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, 58f1d2b4d3SLarry Finger REG_LEDCFG2, (ledcfg & 0xf0) | BIT(5)); 59f1d2b4d3SLarry Finger break; 60f1d2b4d3SLarry Finger case LED_PIN_LED1: 61f1d2b4d3SLarry Finger ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG1); 62f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, REG_LEDCFG1, ledcfg & 0x10); 63f1d2b4d3SLarry Finger break; 64f1d2b4d3SLarry Finger default: 65f1d2b4d3SLarry Finger RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 66f1d2b4d3SLarry Finger "switch case not process\n"); 67f1d2b4d3SLarry Finger break; 68f1d2b4d3SLarry Finger } 69f1d2b4d3SLarry Finger pled->ledon = true; 70f1d2b4d3SLarry Finger } 71f1d2b4d3SLarry Finger 72f1d2b4d3SLarry Finger void rtl8723e_sw_led_off(struct ieee80211_hw *hw, struct rtl_led *pled) 73f1d2b4d3SLarry Finger { 74f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw); 75f1d2b4d3SLarry Finger struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw); 76f1d2b4d3SLarry Finger u8 ledcfg; 77f1d2b4d3SLarry Finger 78f1d2b4d3SLarry Finger RT_TRACE(rtlpriv, COMP_LED, DBG_LOUD, 79f1d2b4d3SLarry Finger "LedAddr:%X ledpin=%d\n", REG_LEDCFG2, pled->ledpin); 80f1d2b4d3SLarry Finger 81f1d2b4d3SLarry Finger ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG2); 82f1d2b4d3SLarry Finger 83f1d2b4d3SLarry Finger switch (pled->ledpin) { 84f1d2b4d3SLarry Finger case LED_PIN_GPIO0: 85f1d2b4d3SLarry Finger break; 86f1d2b4d3SLarry Finger case LED_PIN_LED0: 87f1d2b4d3SLarry Finger ledcfg &= 0xf0; 88f1d2b4d3SLarry Finger if (pcipriv->ledctl.led_opendrain) { 89f1d2b4d3SLarry Finger ledcfg &= 0x90; /* Set to software control. */ 90f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, REG_LEDCFG2, (ledcfg|BIT(3))); 91f1d2b4d3SLarry Finger ledcfg = rtl_read_byte(rtlpriv, REG_MAC_PINMUX_CFG); 92f1d2b4d3SLarry Finger ledcfg &= 0xFE; 93f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, REG_MAC_PINMUX_CFG, ledcfg); 94f1d2b4d3SLarry Finger } else { 95f1d2b4d3SLarry Finger ledcfg &= ~BIT(6); 96f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, REG_LEDCFG2, 97f1d2b4d3SLarry Finger (ledcfg | BIT(3) | BIT(5))); 98f1d2b4d3SLarry Finger } 99f1d2b4d3SLarry Finger break; 100f1d2b4d3SLarry Finger case LED_PIN_LED1: 101f1d2b4d3SLarry Finger ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG1); 102f1d2b4d3SLarry Finger ledcfg &= 0x10; /* Set to software control. */ 103f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, REG_LEDCFG1, ledcfg|BIT(3)); 104f1d2b4d3SLarry Finger 105f1d2b4d3SLarry Finger break; 106f1d2b4d3SLarry Finger default: 107f1d2b4d3SLarry Finger RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 108f1d2b4d3SLarry Finger "switch case not process\n"); 109f1d2b4d3SLarry Finger break; 110f1d2b4d3SLarry Finger } 111f1d2b4d3SLarry Finger pled->ledon = false; 112f1d2b4d3SLarry Finger } 113f1d2b4d3SLarry Finger 114f1d2b4d3SLarry Finger void rtl8723e_init_sw_leds(struct ieee80211_hw *hw) 115f1d2b4d3SLarry Finger { 116f1d2b4d3SLarry Finger struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw); 117f1d2b4d3SLarry Finger _rtl8723e_init_led(hw, &pcipriv->ledctl.sw_led0, LED_PIN_LED0); 118f1d2b4d3SLarry Finger _rtl8723e_init_led(hw, &pcipriv->ledctl.sw_led1, LED_PIN_LED1); 119f1d2b4d3SLarry Finger } 120f1d2b4d3SLarry Finger 121f1d2b4d3SLarry Finger static void _rtl8723e_sw_led_control(struct ieee80211_hw *hw, 122f1d2b4d3SLarry Finger enum led_ctl_mode ledaction) 123f1d2b4d3SLarry Finger { 124f1d2b4d3SLarry Finger struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw); 125f1d2b4d3SLarry Finger struct rtl_led *pLed0 = &(pcipriv->ledctl.sw_led0); 126f1d2b4d3SLarry Finger switch (ledaction) { 127f1d2b4d3SLarry Finger case LED_CTL_POWER_ON: 128f1d2b4d3SLarry Finger case LED_CTL_LINK: 129f1d2b4d3SLarry Finger case LED_CTL_NO_LINK: 130f1d2b4d3SLarry Finger rtl8723e_sw_led_on(hw, pLed0); 131f1d2b4d3SLarry Finger break; 132f1d2b4d3SLarry Finger case LED_CTL_POWER_OFF: 133f1d2b4d3SLarry Finger rtl8723e_sw_led_off(hw, pLed0); 134f1d2b4d3SLarry Finger break; 135f1d2b4d3SLarry Finger default: 136f1d2b4d3SLarry Finger break; 137f1d2b4d3SLarry Finger } 138f1d2b4d3SLarry Finger } 139f1d2b4d3SLarry Finger 140f1d2b4d3SLarry Finger void rtl8723e_led_control(struct ieee80211_hw *hw, 141f1d2b4d3SLarry Finger enum led_ctl_mode ledaction) 142f1d2b4d3SLarry Finger { 143f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw); 144f1d2b4d3SLarry Finger struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 145f1d2b4d3SLarry Finger 146f1d2b4d3SLarry Finger if ((ppsc->rfoff_reason > RF_CHANGE_BY_PS) && 147f1d2b4d3SLarry Finger (ledaction == LED_CTL_TX || 148f1d2b4d3SLarry Finger ledaction == LED_CTL_RX || 149f1d2b4d3SLarry Finger ledaction == LED_CTL_SITE_SURVEY || 150f1d2b4d3SLarry Finger ledaction == LED_CTL_LINK || 151f1d2b4d3SLarry Finger ledaction == LED_CTL_NO_LINK || 152f1d2b4d3SLarry Finger ledaction == LED_CTL_START_TO_LINK || 153f1d2b4d3SLarry Finger ledaction == LED_CTL_POWER_ON)) { 154f1d2b4d3SLarry Finger return; 155f1d2b4d3SLarry Finger } 156f1d2b4d3SLarry Finger RT_TRACE(rtlpriv, COMP_LED, DBG_LOUD, "ledaction %d,\n", 157f1d2b4d3SLarry Finger ledaction); 158f1d2b4d3SLarry Finger _rtl8723e_sw_led_control(hw, ledaction); 159f1d2b4d3SLarry Finger } 160