73 lines
1.4 KiB
C
73 lines
1.4 KiB
C
// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
|
|
/* Copyright(c) 2018-2019 Realtek Corporation
|
|
*/
|
|
|
|
#include "main.h"
|
|
#include "util.h"
|
|
#include "reg.h"
|
|
|
|
bool check_hw_ready(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 target)
|
|
{
|
|
u32 cnt;
|
|
|
|
for (cnt = 0; cnt < 1000; cnt++) {
|
|
if (rtw_read32_mask(rtwdev, addr, mask) == target)
|
|
return true;
|
|
|
|
udelay(10);
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
bool ltecoex_read_reg(struct rtw_dev *rtwdev, u16 offset, u32 *val)
|
|
{
|
|
if (!check_hw_ready(rtwdev, LTECOEX_ACCESS_CTRL, LTECOEX_READY, 1))
|
|
return false;
|
|
|
|
rtw_write32(rtwdev, LTECOEX_ACCESS_CTRL, 0x800F0000 | offset);
|
|
*val = rtw_read32(rtwdev, LTECOEX_READ_DATA);
|
|
|
|
return true;
|
|
}
|
|
|
|
bool ltecoex_reg_write(struct rtw_dev *rtwdev, u16 offset, u32 value)
|
|
{
|
|
if (!check_hw_ready(rtwdev, LTECOEX_ACCESS_CTRL, LTECOEX_READY, 1))
|
|
return false;
|
|
|
|
rtw_write32(rtwdev, LTECOEX_WRITE_DATA, value);
|
|
rtw_write32(rtwdev, LTECOEX_ACCESS_CTRL, 0xC00F0000 | offset);
|
|
|
|
return true;
|
|
}
|
|
|
|
void rtw_restore_reg(struct rtw_dev *rtwdev,
|
|
struct rtw_backup_info *bckp, u32 num)
|
|
{
|
|
u8 len;
|
|
u32 reg;
|
|
u32 val;
|
|
int i;
|
|
|
|
for (i = 0; i < num; i++, bckp++) {
|
|
len = bckp->len;
|
|
reg = bckp->reg;
|
|
val = bckp->val;
|
|
|
|
switch (len) {
|
|
case 1:
|
|
rtw_write8(rtwdev, reg, (u8)val);
|
|
break;
|
|
case 2:
|
|
rtw_write16(rtwdev, reg, (u16)val);
|
|
break;
|
|
case 4:
|
|
rtw_write32(rtwdev, reg, (u32)val);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|