1f1d2b4d3SLarry Finger /****************************************************************************** 2f1d2b4d3SLarry Finger * 3f1d2b4d3SLarry Finger * Copyright(c) 2009-2012 Realtek Corporation. All rights reserved. 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 * The full GNU General Public License is included in this distribution in the 15f1d2b4d3SLarry Finger * file called LICENSE. 16f1d2b4d3SLarry Finger * 17f1d2b4d3SLarry Finger * Contact Information: 18f1d2b4d3SLarry Finger * wlanfae <wlanfae@realtek.com> 19f1d2b4d3SLarry Finger * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, 20f1d2b4d3SLarry Finger * Hsinchu 300, Taiwan. 21f1d2b4d3SLarry Finger * 22f1d2b4d3SLarry Finger *****************************************************************************/ 23f1d2b4d3SLarry Finger 24f1d2b4d3SLarry Finger #include "../wifi.h" 25f1d2b4d3SLarry Finger #include "../usb.h" 26f1d2b4d3SLarry Finger #include "reg.h" 27f1d2b4d3SLarry Finger #include "led.h" 28f1d2b4d3SLarry Finger 29f1d2b4d3SLarry Finger static void _rtl92cu_init_led(struct ieee80211_hw *hw, 30f1d2b4d3SLarry Finger struct rtl_led *pled, enum rtl_led_pin ledpin) 31f1d2b4d3SLarry Finger { 32f1d2b4d3SLarry Finger pled->hw = hw; 33f1d2b4d3SLarry Finger pled->ledpin = ledpin; 34f1d2b4d3SLarry Finger pled->ledon = false; 35f1d2b4d3SLarry Finger } 36f1d2b4d3SLarry Finger 37f1d2b4d3SLarry Finger static void _rtl92cu_deInit_led(struct rtl_led *pled) 38f1d2b4d3SLarry Finger { 39f1d2b4d3SLarry Finger } 40f1d2b4d3SLarry Finger 41f1d2b4d3SLarry Finger void rtl92cu_sw_led_on(struct ieee80211_hw *hw, struct rtl_led *pled) 42f1d2b4d3SLarry Finger { 43f1d2b4d3SLarry Finger u8 ledcfg; 44f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw); 45f1d2b4d3SLarry Finger 46f1d2b4d3SLarry Finger RT_TRACE(rtlpriv, COMP_LED, DBG_LOUD, "LedAddr:%X ledpin=%d\n", 47f1d2b4d3SLarry Finger REG_LEDCFG2, pled->ledpin); 48f1d2b4d3SLarry Finger ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG2); 49f1d2b4d3SLarry Finger switch (pled->ledpin) { 50f1d2b4d3SLarry Finger case LED_PIN_GPIO0: 51f1d2b4d3SLarry Finger break; 52f1d2b4d3SLarry Finger case LED_PIN_LED0: 53f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, 54f1d2b4d3SLarry Finger REG_LEDCFG2, (ledcfg & 0xf0) | BIT(5) | BIT(6)); 55f1d2b4d3SLarry Finger break; 56f1d2b4d3SLarry Finger case LED_PIN_LED1: 57f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, REG_LEDCFG2, (ledcfg & 0x0f) | BIT(5)); 58f1d2b4d3SLarry Finger break; 59f1d2b4d3SLarry Finger default: 60c38af3f0SLarry Finger pr_err("switch case %#x not processed\n", 61c38af3f0SLarry Finger pled->ledpin); 62f1d2b4d3SLarry Finger break; 63f1d2b4d3SLarry Finger } 64f1d2b4d3SLarry Finger pled->ledon = true; 65f1d2b4d3SLarry Finger } 66f1d2b4d3SLarry Finger 67f1d2b4d3SLarry Finger void rtl92cu_sw_led_off(struct ieee80211_hw *hw, struct rtl_led *pled) 68f1d2b4d3SLarry Finger { 69f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw); 70f1d2b4d3SLarry Finger u8 ledcfg; 71f1d2b4d3SLarry Finger 72f1d2b4d3SLarry Finger RT_TRACE(rtlpriv, COMP_LED, DBG_LOUD, "LedAddr:%X ledpin=%d\n", 73f1d2b4d3SLarry Finger REG_LEDCFG2, pled->ledpin); 74f1d2b4d3SLarry Finger ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG2); 75f1d2b4d3SLarry Finger switch (pled->ledpin) { 76f1d2b4d3SLarry Finger case LED_PIN_GPIO0: 77f1d2b4d3SLarry Finger break; 78f1d2b4d3SLarry Finger case LED_PIN_LED0: 79f1d2b4d3SLarry Finger ledcfg &= 0xf0; 80*d5efe153SLarry Finger if (rtlpriv->ledctl.led_opendrain) 81f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, REG_LEDCFG2, 82f1d2b4d3SLarry Finger (ledcfg | BIT(1) | BIT(5) | BIT(6))); 83f1d2b4d3SLarry Finger else 84f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, REG_LEDCFG2, 85f1d2b4d3SLarry Finger (ledcfg | BIT(3) | BIT(5) | BIT(6))); 86f1d2b4d3SLarry Finger break; 87f1d2b4d3SLarry Finger case LED_PIN_LED1: 88f1d2b4d3SLarry Finger ledcfg &= 0x0f; 89f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, REG_LEDCFG2, (ledcfg | BIT(3))); 90f1d2b4d3SLarry Finger break; 91f1d2b4d3SLarry Finger default: 92c38af3f0SLarry Finger pr_err("switch case %#x not processed\n", 93c38af3f0SLarry Finger pled->ledpin); 94f1d2b4d3SLarry Finger break; 95f1d2b4d3SLarry Finger } 96f1d2b4d3SLarry Finger pled->ledon = false; 97f1d2b4d3SLarry Finger } 98f1d2b4d3SLarry Finger 99f1d2b4d3SLarry Finger void rtl92cu_init_sw_leds(struct ieee80211_hw *hw) 100f1d2b4d3SLarry Finger { 101*d5efe153SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw); 102*d5efe153SLarry Finger 103*d5efe153SLarry Finger _rtl92cu_init_led(hw, &rtlpriv->ledctl.sw_led0, LED_PIN_LED0); 104*d5efe153SLarry Finger _rtl92cu_init_led(hw, &rtlpriv->ledctl.sw_led1, LED_PIN_LED1); 105f1d2b4d3SLarry Finger } 106f1d2b4d3SLarry Finger 107f1d2b4d3SLarry Finger void rtl92cu_deinit_sw_leds(struct ieee80211_hw *hw) 108f1d2b4d3SLarry Finger { 109*d5efe153SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw); 110*d5efe153SLarry Finger 111*d5efe153SLarry Finger _rtl92cu_deInit_led(&rtlpriv->ledctl.sw_led0); 112*d5efe153SLarry Finger _rtl92cu_deInit_led(&rtlpriv->ledctl.sw_led1); 113f1d2b4d3SLarry Finger } 114f1d2b4d3SLarry Finger 115f1d2b4d3SLarry Finger static void _rtl92cu_sw_led_control(struct ieee80211_hw *hw, 116f1d2b4d3SLarry Finger enum led_ctl_mode ledaction) 117f1d2b4d3SLarry Finger { 118f1d2b4d3SLarry Finger } 119f1d2b4d3SLarry Finger 120f1d2b4d3SLarry Finger void rtl92cu_led_control(struct ieee80211_hw *hw, 121f1d2b4d3SLarry Finger enum led_ctl_mode ledaction) 122f1d2b4d3SLarry Finger { 123f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw); 124f1d2b4d3SLarry Finger struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 125f1d2b4d3SLarry Finger 126f1d2b4d3SLarry Finger if ((ppsc->rfoff_reason > RF_CHANGE_BY_PS) && 127f1d2b4d3SLarry Finger (ledaction == LED_CTL_TX || 128f1d2b4d3SLarry Finger ledaction == LED_CTL_RX || 129f1d2b4d3SLarry Finger ledaction == LED_CTL_SITE_SURVEY || 130f1d2b4d3SLarry Finger ledaction == LED_CTL_LINK || 131f1d2b4d3SLarry Finger ledaction == LED_CTL_NO_LINK || 132f1d2b4d3SLarry Finger ledaction == LED_CTL_START_TO_LINK || 133f1d2b4d3SLarry Finger ledaction == LED_CTL_POWER_ON)) { 134f1d2b4d3SLarry Finger return; 135f1d2b4d3SLarry Finger } 136f1d2b4d3SLarry Finger RT_TRACE(rtlpriv, COMP_LED, DBG_LOUD, "ledaction %d\n", ledaction); 137f1d2b4d3SLarry Finger _rtl92cu_sw_led_control(hw, ledaction); 138f1d2b4d3SLarry Finger } 139