1 // SPDX-License-Identifier: GPL-2.0
2 /******************************************************************************
3 *
4 * Copyright(c) 2007 - 2016 Realtek Corporation.
5 *
6 * Contact Information:
7 * wlanfae <wlanfae@realtek.com>
8 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
9 * Hsinchu 300, Taiwan.
10 *
11 * Larry Finger <Larry.Finger@lwfinger.net>
12 *
13 *****************************************************************************/
14
15 /* ************************************************************
16 * include files
17 * *************************************************************/
18 #include "mp_precomp.h"
19 #include "phydm_precomp.h"
20
phydm_update_rf_state(struct phy_dm_struct * dm,struct dyn_pwr_saving * dm_ps_table,int _rssi_up_bound,int _rssi_low_bound,int _is_force_in_normal)21 static inline void phydm_update_rf_state(struct phy_dm_struct *dm,
22 struct dyn_pwr_saving *dm_ps_table,
23 int _rssi_up_bound,
24 int _rssi_low_bound,
25 int _is_force_in_normal)
26 {
27 if (_is_force_in_normal) {
28 dm_ps_table->cur_rf_state = rf_normal;
29 return;
30 }
31
32 if (dm->rssi_min == 0xFF) {
33 dm_ps_table->cur_rf_state = RF_MAX;
34 return;
35 }
36
37 if (dm_ps_table->pre_rf_state == rf_normal) {
38 if (dm->rssi_min >= _rssi_up_bound)
39 dm_ps_table->cur_rf_state = rf_save;
40 else
41 dm_ps_table->cur_rf_state = rf_normal;
42 } else {
43 if (dm->rssi_min <= _rssi_low_bound)
44 dm_ps_table->cur_rf_state = rf_normal;
45 else
46 dm_ps_table->cur_rf_state = rf_save;
47 }
48 }
49
odm_dynamic_bb_power_saving_init(void * dm_void)50 void odm_dynamic_bb_power_saving_init(void *dm_void)
51 {
52 struct phy_dm_struct *dm = (struct phy_dm_struct *)dm_void;
53 struct dyn_pwr_saving *dm_ps_table = &dm->dm_ps_table;
54
55 dm_ps_table->pre_cca_state = CCA_MAX;
56 dm_ps_table->cur_cca_state = CCA_MAX;
57 dm_ps_table->pre_rf_state = RF_MAX;
58 dm_ps_table->cur_rf_state = RF_MAX;
59 dm_ps_table->rssi_val_min = 0;
60 dm_ps_table->initialize = 0;
61 }
62
odm_rf_saving(void * dm_void,u8 is_force_in_normal)63 void odm_rf_saving(void *dm_void, u8 is_force_in_normal)
64 {
65 struct phy_dm_struct *dm = (struct phy_dm_struct *)dm_void;
66 struct dyn_pwr_saving *dm_ps_table = &dm->dm_ps_table;
67 u8 rssi_up_bound = 30;
68 u8 rssi_low_bound = 25;
69
70 if (dm->patch_id == 40) { /* RT_CID_819x_FUNAI_TV */
71 rssi_up_bound = 50;
72 rssi_low_bound = 45;
73 }
74 if (dm_ps_table->initialize == 0) {
75 dm_ps_table->reg874 =
76 (odm_get_bb_reg(dm, 0x874, MASKDWORD) & 0x1CC000) >> 14;
77 dm_ps_table->regc70 =
78 (odm_get_bb_reg(dm, 0xc70, MASKDWORD) & BIT(3)) >> 3;
79 dm_ps_table->reg85c =
80 (odm_get_bb_reg(dm, 0x85c, MASKDWORD) & 0xFF000000) >>
81 24;
82 dm_ps_table->rega74 =
83 (odm_get_bb_reg(dm, 0xa74, MASKDWORD) & 0xF000) >> 12;
84 /* Reg818 = phy_query_bb_reg(adapter, 0x818, MASKDWORD); */
85 dm_ps_table->initialize = 1;
86 }
87
88 phydm_update_rf_state(dm, dm_ps_table, rssi_up_bound, rssi_low_bound,
89 is_force_in_normal);
90
91 if (dm_ps_table->pre_rf_state != dm_ps_table->cur_rf_state) {
92 if (dm_ps_table->cur_rf_state == rf_save) {
93 odm_set_bb_reg(dm, 0x874, 0x1C0000,
94 0x2); /* reg874[20:18]=3'b010 */
95 odm_set_bb_reg(dm, 0xc70, BIT(3),
96 0); /* regc70[3]=1'b0 */
97 odm_set_bb_reg(dm, 0x85c, 0xFF000000,
98 0x63); /* reg85c[31:24]=0x63 */
99 odm_set_bb_reg(dm, 0x874, 0xC000,
100 0x2); /* reg874[15:14]=2'b10 */
101 odm_set_bb_reg(dm, 0xa74, 0xF000,
102 0x3); /* RegA75[7:4]=0x3 */
103 odm_set_bb_reg(dm, 0x818, BIT(28),
104 0x0); /* Reg818[28]=1'b0 */
105 odm_set_bb_reg(dm, 0x818, BIT(28),
106 0x1); /* Reg818[28]=1'b1 */
107 } else {
108 odm_set_bb_reg(dm, 0x874, 0x1CC000,
109 dm_ps_table->reg874);
110 odm_set_bb_reg(dm, 0xc70, BIT(3), dm_ps_table->regc70);
111 odm_set_bb_reg(dm, 0x85c, 0xFF000000,
112 dm_ps_table->reg85c);
113 odm_set_bb_reg(dm, 0xa74, 0xF000, dm_ps_table->rega74);
114 odm_set_bb_reg(dm, 0x818, BIT(28), 0x0);
115 }
116 dm_ps_table->pre_rf_state = dm_ps_table->cur_rf_state;
117 }
118 }
119
