xref: /OK3568_Linux_fs/external/rkwifibt/drivers/rtl8852bs/phl/phl_acs.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /******************************************************************************
2*4882a593Smuzhiyun  *
3*4882a593Smuzhiyun  * Copyright(c) 2019 Realtek Corporation.
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * This program is free software; you can redistribute it and/or modify it
6*4882a593Smuzhiyun  * under the terms of version 2 of the GNU General Public License as
7*4882a593Smuzhiyun  * published by the Free Software Foundation.
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * This program is distributed in the hope that it will be useful, but WITHOUT
10*4882a593Smuzhiyun  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11*4882a593Smuzhiyun  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12*4882a593Smuzhiyun  * more details.
13*4882a593Smuzhiyun  *
14*4882a593Smuzhiyun  *****************************************************************************/
15*4882a593Smuzhiyun #define _PHL_ACS_C_
16*4882a593Smuzhiyun #include "phl_headers.h"
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun #ifdef CONFIG_RTW_ACS
phl_acs_mntr_trigger(struct phl_info_t * phl_info,u8 idx,u16 channel,u16 monitor_time)19*4882a593Smuzhiyun void phl_acs_mntr_trigger(struct phl_info_t *phl_info, u8 idx, u16 channel, u16 monitor_time)
20*4882a593Smuzhiyun {
21*4882a593Smuzhiyun 	struct auto_chan_sel *acs = &phl_info->acs;
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun 	if ((idx < 0) || (idx >= MAX_CHANNEL_NUM)) {
24*4882a593Smuzhiyun 		PHL_ERR("[ACS][%s] idx(%d) invalid\n", __func__, idx);
25*4882a593Smuzhiyun 		return;
26*4882a593Smuzhiyun 	} else if (idx == 0) {
27*4882a593Smuzhiyun 		_os_mem_set(phl_to_drvpriv(phl_info), acs, 0, sizeof(struct auto_chan_sel));
28*4882a593Smuzhiyun 	}
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun 	acs->curr_idx = idx;
31*4882a593Smuzhiyun 	acs->chset[idx] = channel;
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun 	rtw_hal_acs_mntr_trigger(phl_info->hal, monitor_time);
34*4882a593Smuzhiyun }
35*4882a593Smuzhiyun 
phl_acs_mntr_result(struct phl_info_t * phl_info)36*4882a593Smuzhiyun void phl_acs_mntr_result(struct phl_info_t *phl_info)
37*4882a593Smuzhiyun {
38*4882a593Smuzhiyun 	struct auto_chan_sel *acs = &phl_info->acs;
39*4882a593Smuzhiyun 	u8 idx = acs->curr_idx;
40*4882a593Smuzhiyun 	enum rtw_hal_status status;
41*4882a593Smuzhiyun 	struct auto_chan_sel_report rpt = {0};
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun 	status = rtw_hal_acs_mntr_result(phl_info->hal, &rpt);
44*4882a593Smuzhiyun 
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun 	if (idx >= MAX_CHANNEL_NUM) {
47*4882a593Smuzhiyun 		PHL_ERR("[ACS][%s] idx(%d) invalid\n", __func__, idx);
48*4882a593Smuzhiyun 		return;
49*4882a593Smuzhiyun 	}
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun 	if (status == RTW_HAL_STATUS_SUCCESS) {
52*4882a593Smuzhiyun 		acs->clm_ratio[idx] = rpt.clm_ratio;
53*4882a593Smuzhiyun 		acs->nhm_pwr[idx] = rpt.nhm_pwr;
54*4882a593Smuzhiyun 	}
55*4882a593Smuzhiyun }
56*4882a593Smuzhiyun 
rtw_phl_acs_get_channel_by_idx(void * phl,u8 idx)57*4882a593Smuzhiyun u16 rtw_phl_acs_get_channel_by_idx(void *phl, u8 idx)
58*4882a593Smuzhiyun {
59*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
60*4882a593Smuzhiyun 	struct auto_chan_sel *acs = &phl_info->acs;
61*4882a593Smuzhiyun 
62*4882a593Smuzhiyun 	if (idx >= MAX_CHANNEL_NUM) {
63*4882a593Smuzhiyun 		PHL_ERR("[ACS][%s] idx(%d) invalid\n", __func__, idx);
64*4882a593Smuzhiyun 		return 0;
65*4882a593Smuzhiyun 	}
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun 	return acs->chset[idx];
68*4882a593Smuzhiyun }
69*4882a593Smuzhiyun 
rtw_phl_acs_get_clm_ratio_by_idx(void * phl,u8 idx)70*4882a593Smuzhiyun u8 rtw_phl_acs_get_clm_ratio_by_idx(void *phl, u8 idx)
71*4882a593Smuzhiyun {
72*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
73*4882a593Smuzhiyun 	struct auto_chan_sel *acs = &phl_info->acs;
74*4882a593Smuzhiyun 
75*4882a593Smuzhiyun 	if (idx >= MAX_CHANNEL_NUM) {
76*4882a593Smuzhiyun 		PHL_ERR("%s [ACS] idx(%d) is invalid\n", __func__, idx);
77*4882a593Smuzhiyun 		return 0;
78*4882a593Smuzhiyun 	}
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun 	return acs->clm_ratio[idx];
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun 
rtw_phl_noise_query_by_idx(void * phl,u8 idx)83*4882a593Smuzhiyun s8 rtw_phl_noise_query_by_idx(void *phl, u8 idx)
84*4882a593Smuzhiyun {
85*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
86*4882a593Smuzhiyun 	struct auto_chan_sel *acs = &phl_info->acs;
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun 	if (idx >= MAX_CHANNEL_NUM) {
89*4882a593Smuzhiyun 		PHL_ERR("%s [ACS] idx(%d) is invalid\n", __func__, idx);
90*4882a593Smuzhiyun 		return 0;
91*4882a593Smuzhiyun 	}
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun 	/* dBm = RPL - 110 */
94*4882a593Smuzhiyun 	return acs->nhm_pwr[idx] - 110;
95*4882a593Smuzhiyun }
96*4882a593Smuzhiyun #endif /* CONFIG_RTW_ACS */
97*4882a593Smuzhiyun 
rtw_phl_get_env_rpt(void * phl,struct rtw_env_report * env_rpt,struct rtw_wifi_role_t * wrole)98*4882a593Smuzhiyun void rtw_phl_get_env_rpt(void *phl, struct rtw_env_report *env_rpt, struct rtw_wifi_role_t *wrole)
99*4882a593Smuzhiyun {
100*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
101*4882a593Smuzhiyun 	struct rtw_hal_com_t *hal_com = rtw_hal_get_halcom(phl_info->hal);
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun 	rtw_hal_env_rpt(hal_com, env_rpt, wrole);
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun }
106