cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

led.c (3390B)

      1// SPDX-License-Identifier: GPL-2.0
      2/* Copyright(c) 2009-2012  Realtek Corporation.*/
      3
      4#include "../wifi.h"
      5#include "../pci.h"
      6#include "reg.h"
      7#include "led.h"
      8
      9static void _rtl92ce_init_led(struct ieee80211_hw *hw,
     10			      struct rtl_led *pled, enum rtl_led_pin ledpin)
     11{
     12	pled->hw = hw;
     13	pled->ledpin = ledpin;
     14	pled->ledon = false;
     15}
     16
     17void rtl92de_sw_led_on(struct ieee80211_hw *hw, struct rtl_led *pled)
     18{
     19	u8 ledcfg;
     20	struct rtl_priv *rtlpriv = rtl_priv(hw);
     21
     22	rtl_dbg(rtlpriv, COMP_LED, DBG_LOUD, "LedAddr:%X ledpin=%d\n",
     23		REG_LEDCFG2, pled->ledpin);
     24
     25	switch (pled->ledpin) {
     26	case LED_PIN_GPIO0:
     27		break;
     28	case LED_PIN_LED0:
     29		ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG2);
     30
     31		if ((rtlpriv->efuse.eeprom_did == 0x8176) ||
     32			(rtlpriv->efuse.eeprom_did == 0x8193))
     33			/* BIT7 of REG_LEDCFG2 should be set to
     34			 * make sure we could emit the led2. */
     35			rtl_write_byte(rtlpriv, REG_LEDCFG2, (ledcfg & 0xf0) |
     36				       BIT(7) | BIT(5) | BIT(6));
     37		else
     38			rtl_write_byte(rtlpriv, REG_LEDCFG2, (ledcfg & 0xf0) |
     39				       BIT(7) | BIT(5));
     40		break;
     41	case LED_PIN_LED1:
     42		ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG1);
     43
     44		rtl_write_byte(rtlpriv, REG_LEDCFG2, (ledcfg & 0x0f) | BIT(5));
     45		break;
     46	default:
     47		pr_err("switch case %#x not processed\n",
     48		       pled->ledpin);
     49		break;
     50	}
     51	pled->ledon = true;
     52}
     53
     54void rtl92de_sw_led_off(struct ieee80211_hw *hw, struct rtl_led *pled)
     55{
     56	struct rtl_priv *rtlpriv = rtl_priv(hw);
     57	u8 ledcfg;
     58
     59	rtl_dbg(rtlpriv, COMP_LED, DBG_LOUD, "LedAddr:%X ledpin=%d\n",
     60		REG_LEDCFG2, pled->ledpin);
     61
     62	ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG2);
     63
     64	switch (pled->ledpin) {
     65	case LED_PIN_GPIO0:
     66		break;
     67	case LED_PIN_LED0:
     68		ledcfg &= 0xf0;
     69		if (rtlpriv->ledctl.led_opendrain)
     70			rtl_write_byte(rtlpriv, REG_LEDCFG2,
     71				       (ledcfg | BIT(1) | BIT(5) | BIT(6)));
     72		else
     73			rtl_write_byte(rtlpriv, REG_LEDCFG2,
     74				       (ledcfg | BIT(3) | BIT(5) | BIT(6)));
     75		break;
     76	case LED_PIN_LED1:
     77		ledcfg &= 0x0f;
     78		rtl_write_byte(rtlpriv, REG_LEDCFG2, (ledcfg | BIT(3)));
     79		break;
     80	default:
     81		pr_err("switch case %#x not processed\n",
     82		       pled->ledpin);
     83		break;
     84	}
     85	pled->ledon = false;
     86}
     87
     88void rtl92de_init_sw_leds(struct ieee80211_hw *hw)
     89{
     90	struct rtl_priv *rtlpriv = rtl_priv(hw);
     91
     92	_rtl92ce_init_led(hw, &rtlpriv->ledctl.sw_led0, LED_PIN_LED0);
     93	_rtl92ce_init_led(hw, &rtlpriv->ledctl.sw_led1, LED_PIN_LED1);
     94}
     95
     96static void _rtl92ce_sw_led_control(struct ieee80211_hw *hw,
     97				    enum led_ctl_mode ledaction)
     98{
     99	struct rtl_priv *rtlpriv = rtl_priv(hw);
    100	struct rtl_led *pled0 = &rtlpriv->ledctl.sw_led0;
    101
    102	switch (ledaction) {
    103	case LED_CTL_POWER_ON:
    104	case LED_CTL_LINK:
    105	case LED_CTL_NO_LINK:
    106		rtl92de_sw_led_on(hw, pled0);
    107		break;
    108	case LED_CTL_POWER_OFF:
    109		rtl92de_sw_led_off(hw, pled0);
    110		break;
    111	default:
    112		break;
    113	}
    114}
    115
    116void rtl92de_led_control(struct ieee80211_hw *hw, enum led_ctl_mode ledaction)
    117{
    118	struct rtl_priv *rtlpriv = rtl_priv(hw);
    119	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
    120
    121	if ((ppsc->rfoff_reason > RF_CHANGE_BY_PS) &&
    122	    (ledaction == LED_CTL_TX ||
    123	     ledaction == LED_CTL_RX ||
    124	     ledaction == LED_CTL_SITE_SURVEY ||
    125	     ledaction == LED_CTL_LINK ||
    126	     ledaction == LED_CTL_NO_LINK ||
    127	     ledaction == LED_CTL_START_TO_LINK ||
    128	     ledaction == LED_CTL_POWER_ON)) {
    129		return;
    130	}
    131	rtl_dbg(rtlpriv, COMP_LED, DBG_LOUD, "ledaction %d,\n", ledaction);
    132
    133	_rtl92ce_sw_led_control(hw, ledaction);
    134}