Orange Pi5 kernel

/******************************************************************************
 *
 * Copyright(c) 2007 - 2017 Realtek Corporation.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
 * more details.
 *
 *****************************************************************************/

/* ************************************************************
 * include files
 * ************************************************************ */

#include "mp_precomp.h"

#include "../phydm_precomp.h"

#if (RTL8821A_SUPPORT == 1)
s8 phydm_cck_rssi_8821a(struct dm_struct *dm, u16 lna_idx, u8 vga_idx)
{
	s8 rx_pwr_all = 0;

	switch (lna_idx) {
	case 7:
		if (vga_idx <= 27)
			rx_pwr_all = -94 + 2 * (27 - vga_idx);
		else
			rx_pwr_all = -94;
		break;
	case 6:
		rx_pwr_all = -42 + 2 * (2 - vga_idx);
		break;
	case 5:
		rx_pwr_all = -36 + 2 * (7 - vga_idx);
		break;
	case 4:
		rx_pwr_all = -30 + 2 * (7 - vga_idx);
		break;
	case 3:
		rx_pwr_all = -18 + 2 * (7 - vga_idx);
		break;
	case 2:
		rx_pwr_all = 2 * (5 - vga_idx);
		break;
	case 1:
		rx_pwr_all = 14 - 2 * vga_idx;
		break;
	case 0:
		rx_pwr_all = 20 - 2 * vga_idx;
		break;
	default:
		break;
	}

	return rx_pwr_all;
}

void
phydm_set_ext_band_switch_8821A(
	void		*dm_void,
	u32		band
)
{
	struct dm_struct		*dm = (struct dm_struct *)dm_void;

	/*Output Pin Settings*/
	odm_set_mac_reg(dm, 0x4C, BIT(23), 0); /*select DPDT_P and DPDT_N as output pin*/
	odm_set_mac_reg(dm, 0x4C, BIT(24), 1); /*by WLAN control*/

	odm_set_bb_reg(dm, 0xCB4, 0xF, 7); /*DPDT_P = 1b'0*/
	odm_set_bb_reg(dm, 0xCB4, 0xF0, 7); /*DPDT_N = 1b'0*/

	if (band == ODM_BAND_2_4G) {
		odm_set_bb_reg(dm, 0xCB4, (BIT(29) | BIT(28)), 1);
		PHYDM_DBG(dm, DBG_ANT_DIV, "***8821A set band switch = 2b'01\n");
	} else {
		odm_set_bb_reg(dm, 0xCB4, BIT(29) | BIT(28), 2);
		PHYDM_DBG(dm, DBG_ANT_DIV, "***8821A set band switch = 2b'10\n");
	}
}


void
odm_dynamic_try_state_agg_8821a(
	struct dm_struct		*dm
)
{
	if ((dm->support_ic_type & ODM_RTL8821) && (dm->support_interface == ODM_ITRF_USB)) {
		if (dm->rssi_min > 25)
			odm_write_1byte(dm, 0x4CF, 0x02);
		else if (dm->rssi_min < 20)
			odm_write_1byte(dm, 0x4CF, 0x00);
	}
}

void
odm_dynamic_packet_detection_th_8821a(
	struct dm_struct		*dm
)
{
	if (dm->support_ic_type & ODM_RTL8821) {
		if (dm->rssi_min <= 25) {
			/*odm_set_bb_reg(dm, REG_PWED_TH_JAGUAR, MASKDWORD, 0x2aaaf1a8);*/
			odm_set_bb_reg(dm, REG_PWED_TH_JAGUAR, 0x1ff0, 0x11a);
			odm_set_bb_reg(dm, REG_BW_INDICATION_JAGUAR, BIT(26), 1);
		} else if (dm->rssi_min >= 30) {
			/*odm_set_bb_reg(dm, REG_PWED_TH_JAGUAR, MASKDWORD, 0x2aaaeec8);*/
			odm_set_bb_reg(dm, REG_PWED_TH_JAGUAR, 0x1ff0, 0xec);
			odm_set_bb_reg(dm, REG_BW_INDICATION_JAGUAR, BIT(26), 0);
		}
	}
}

void
odm_hw_setting_8821a(
	struct dm_struct		*dm
)
{
	odm_dynamic_try_state_agg_8821a(dm);
	odm_dynamic_packet_detection_th_8821a(dm);
}

#endif /* #if (RTL8821A_SUPPORT == 1) */