162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/* Copyright(c) 2009-2012  Realtek Corporation.*/
362306a36Sopenharmony_ci
462306a36Sopenharmony_ci#include "../wifi.h"
562306a36Sopenharmony_ci#include "../usb.h"
662306a36Sopenharmony_ci#include "reg.h"
762306a36Sopenharmony_ci#include "led.h"
862306a36Sopenharmony_ci
962306a36Sopenharmony_civoid rtl92cu_sw_led_on(struct ieee80211_hw *hw, enum rtl_led_pin pin)
1062306a36Sopenharmony_ci{
1162306a36Sopenharmony_ci	u8 ledcfg;
1262306a36Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_ci	rtl_dbg(rtlpriv, COMP_LED, DBG_LOUD, "LedAddr:%X ledpin=%d\n",
1562306a36Sopenharmony_ci		REG_LEDCFG2, pin);
1662306a36Sopenharmony_ci	ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG2);
1762306a36Sopenharmony_ci	switch (pin) {
1862306a36Sopenharmony_ci	case LED_PIN_GPIO0:
1962306a36Sopenharmony_ci		break;
2062306a36Sopenharmony_ci	case LED_PIN_LED0:
2162306a36Sopenharmony_ci		rtl_write_byte(rtlpriv,
2262306a36Sopenharmony_ci			       REG_LEDCFG2, (ledcfg & 0xf0) | BIT(5) | BIT(6));
2362306a36Sopenharmony_ci		break;
2462306a36Sopenharmony_ci	case LED_PIN_LED1:
2562306a36Sopenharmony_ci		rtl_write_byte(rtlpriv, REG_LEDCFG2, (ledcfg & 0x0f) | BIT(5));
2662306a36Sopenharmony_ci		break;
2762306a36Sopenharmony_ci	default:
2862306a36Sopenharmony_ci		pr_err("switch case %#x not processed\n", pin);
2962306a36Sopenharmony_ci		break;
3062306a36Sopenharmony_ci	}
3162306a36Sopenharmony_ci}
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_civoid rtl92cu_sw_led_off(struct ieee80211_hw *hw, enum rtl_led_pin pin)
3462306a36Sopenharmony_ci{
3562306a36Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
3662306a36Sopenharmony_ci	u8 ledcfg;
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ci	rtl_dbg(rtlpriv, COMP_LED, DBG_LOUD, "LedAddr:%X ledpin=%d\n",
3962306a36Sopenharmony_ci		REG_LEDCFG2, pin);
4062306a36Sopenharmony_ci	ledcfg = rtl_read_byte(rtlpriv, REG_LEDCFG2);
4162306a36Sopenharmony_ci	switch (pin) {
4262306a36Sopenharmony_ci	case LED_PIN_GPIO0:
4362306a36Sopenharmony_ci		break;
4462306a36Sopenharmony_ci	case LED_PIN_LED0:
4562306a36Sopenharmony_ci		ledcfg &= 0xf0;
4662306a36Sopenharmony_ci		if (rtlpriv->ledctl.led_opendrain)
4762306a36Sopenharmony_ci			rtl_write_byte(rtlpriv, REG_LEDCFG2,
4862306a36Sopenharmony_ci				       (ledcfg | BIT(1) | BIT(5) | BIT(6)));
4962306a36Sopenharmony_ci		else
5062306a36Sopenharmony_ci			rtl_write_byte(rtlpriv, REG_LEDCFG2,
5162306a36Sopenharmony_ci				       (ledcfg | BIT(3) | BIT(5) | BIT(6)));
5262306a36Sopenharmony_ci		break;
5362306a36Sopenharmony_ci	case LED_PIN_LED1:
5462306a36Sopenharmony_ci		ledcfg &= 0x0f;
5562306a36Sopenharmony_ci		rtl_write_byte(rtlpriv, REG_LEDCFG2, (ledcfg | BIT(3)));
5662306a36Sopenharmony_ci		break;
5762306a36Sopenharmony_ci	default:
5862306a36Sopenharmony_ci		pr_err("switch case %#x not processed\n", pin);
5962306a36Sopenharmony_ci		break;
6062306a36Sopenharmony_ci	}
6162306a36Sopenharmony_ci}
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_civoid rtl92cu_led_control(struct ieee80211_hw *hw,
6462306a36Sopenharmony_ci			 enum led_ctl_mode ledaction)
6562306a36Sopenharmony_ci{
6662306a36Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
6762306a36Sopenharmony_ci	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci	if ((ppsc->rfoff_reason > RF_CHANGE_BY_PS) &&
7062306a36Sopenharmony_ci	    (ledaction == LED_CTL_TX ||
7162306a36Sopenharmony_ci	     ledaction == LED_CTL_RX ||
7262306a36Sopenharmony_ci	     ledaction == LED_CTL_SITE_SURVEY ||
7362306a36Sopenharmony_ci	     ledaction == LED_CTL_LINK ||
7462306a36Sopenharmony_ci	     ledaction == LED_CTL_NO_LINK ||
7562306a36Sopenharmony_ci	     ledaction == LED_CTL_START_TO_LINK ||
7662306a36Sopenharmony_ci	     ledaction == LED_CTL_POWER_ON)) {
7762306a36Sopenharmony_ci		return;
7862306a36Sopenharmony_ci	}
7962306a36Sopenharmony_ci	rtl_dbg(rtlpriv, COMP_LED, DBG_LOUD, "ledaction %d\n", ledaction);
8062306a36Sopenharmony_ci}
81