rtlwifi/rtl8723ae/led.c

0001 // SPDX-License-Identifier: GPL-2.0
0002 /* Copyright(c) 2009-2012  Realtek Corporation.*/
0003
0004 #include "../wifi.h"
0005 #include "../pci.h"
0006 #include "reg.h"
0007 #include "led.h"
0008
0009 static void _rtl8723e_init_led(struct ieee80211_hw *hw,
0010                    struct rtl_led *pled, enum rtl_led_pin ledpin)
0011 {
0012     pled->hw = hw;
0013     pled->ledpin = ledpin;
0014     pled->ledon = false;
0015 }
0016
0017 void rtl8723e_sw_led_on(struct ieee80211_hw *hw, struct rtl_led *pled)
0018 {
0019     u8 ledcfg;
0020     struct rtl_priv *rtlpriv = rtl_priv(hw);
0021
0022     rtl_dbg(rtlpriv, COMP_LED, DBG_LOUD,
0023         "LedAddr:%X ledpin=%d\n", REG_LEDCFG2, pled->ledpin);
0024
0025     switch (pled->ledpin) {
0026     case LED_PIN_GPIO0:
0027         break;
0028     case LED_PIN_LED0:
0029         ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG2);
0030         ledcfg &= ~BIT(6);
0031         rtl_write_byte(rtlpriv,
0032                    REG_LEDCFG2, (ledcfg & 0xf0) | BIT(5));
0033         break;
0034     case LED_PIN_LED1:
0035         ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG1);
0036         rtl_write_byte(rtlpriv, REG_LEDCFG1, ledcfg & 0x10);
0037         break;
0038     default:
0039         pr_err("switch case %#x not processed\n",
0040                pled->ledpin);
0041         break;
0042     }
0043     pled->ledon = true;
0044 }
0045
0046 void rtl8723e_sw_led_off(struct ieee80211_hw *hw, struct rtl_led *pled)
0047 {
0048     struct rtl_priv *rtlpriv = rtl_priv(hw);
0049     u8 ledcfg;
0050
0051     rtl_dbg(rtlpriv, COMP_LED, DBG_LOUD,
0052         "LedAddr:%X ledpin=%d\n", REG_LEDCFG2, pled->ledpin);
0053
0054     ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG2);
0055
0056     switch (pled->ledpin) {
0057     case LED_PIN_GPIO0:
0058         break;
0059     case LED_PIN_LED0:
0060         ledcfg &= 0xf0;
0061         if (rtlpriv->ledctl.led_opendrain) {
0062             ledcfg &= 0x90; /* Set to software control. */
0063             rtl_write_byte(rtlpriv, REG_LEDCFG2, (ledcfg|BIT(3)));
0064             ledcfg = rtl_read_byte(rtlpriv, REG_MAC_PINMUX_CFG);
0065             ledcfg &= 0xFE;
0066             rtl_write_byte(rtlpriv, REG_MAC_PINMUX_CFG, ledcfg);
0067         } else {
0068             ledcfg &= ~BIT(6);
0069             rtl_write_byte(rtlpriv, REG_LEDCFG2,
0070                     (ledcfg | BIT(3) | BIT(5)));
0071         }
0072         break;
0073     case LED_PIN_LED1:
0074         ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG1);
0075         ledcfg &= 0x10; /* Set to software control. */
0076         rtl_write_byte(rtlpriv, REG_LEDCFG1, ledcfg|BIT(3));
0077
0078         break;
0079     default:
0080         pr_err("switch case %#x not processed\n",
0081                pled->ledpin);
0082         break;
0083     }
0084     pled->ledon = false;
0085 }
0086
0087 void rtl8723e_init_sw_leds(struct ieee80211_hw *hw)
0088 {
0089     struct rtl_priv *rtlpriv = rtl_priv(hw);
0090
0091     _rtl8723e_init_led(hw, &rtlpriv->ledctl.sw_led0, LED_PIN_LED0);
0092     _rtl8723e_init_led(hw, &rtlpriv->ledctl.sw_led1, LED_PIN_LED1);
0093 }
0094
0095 static void _rtl8723e_sw_led_control(struct ieee80211_hw *hw,
0096                      enum led_ctl_mode ledaction)
0097 {
0098     struct rtl_priv *rtlpriv = rtl_priv(hw);
0099     struct rtl_led *pled0 = &rtlpriv->ledctl.sw_led0;
0100
0101     switch (ledaction) {
0102     case LED_CTL_POWER_ON:
0103     case LED_CTL_LINK:
0104     case LED_CTL_NO_LINK:
0105         rtl8723e_sw_led_on(hw, pled0);
0106         break;
0107     case LED_CTL_POWER_OFF:
0108         rtl8723e_sw_led_off(hw, pled0);
0109         break;
0110     default:
0111         break;
0112     }
0113 }
0114
0115 void rtl8723e_led_control(struct ieee80211_hw *hw,
0116               enum led_ctl_mode ledaction)
0117 {
0118     struct rtl_priv *rtlpriv = rtl_priv(hw);
0119     struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
0120
0121     if ((ppsc->rfoff_reason > RF_CHANGE_BY_PS) &&
0122         (ledaction == LED_CTL_TX ||
0123          ledaction == LED_CTL_RX ||
0124          ledaction == LED_CTL_SITE_SURVEY ||
0125          ledaction == LED_CTL_LINK ||
0126          ledaction == LED_CTL_NO_LINK ||
0127          ledaction == LED_CTL_START_TO_LINK ||
0128          ledaction == LED_CTL_POWER_ON)) {
0129         return;
0130     }
0131     rtl_dbg(rtlpriv, COMP_LED, DBG_LOUD, "ledaction %d,\n",
0132         ledaction);
0133     _rtl8723e_sw_led_control(hw, ledaction);
0134 }