root/drivers/net/wireless/realtek/rtw88/util.c

DEFINITIONS

1. check_hw_ready
2. ltecoex_read_reg
3. ltecoex_reg_write
4. rtw_restore_reg

   1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
   2 /* Copyright(c) 2018-2019  Realtek Corporation
   3  */
   4 
   5 #include "main.h"
   6 #include "util.h"
   7 #include "reg.h"
   8 
   9 bool check_hw_ready(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 target)
  10 {
  11         u32 cnt;
  12 
  13         for (cnt = 0; cnt < 1000; cnt++) {
  14                 if (rtw_read32_mask(rtwdev, addr, mask) == target)
  15                         return true;
  16 
  17                 udelay(10);
  18         }
  19 
  20         return false;
  21 }
  22 
  23 bool ltecoex_read_reg(struct rtw_dev *rtwdev, u16 offset, u32 *val)
  24 {
  25         if (!check_hw_ready(rtwdev, LTECOEX_ACCESS_CTRL, LTECOEX_READY, 1))
  26                 return false;
  27 
  28         rtw_write32(rtwdev, LTECOEX_ACCESS_CTRL, 0x800F0000 | offset);
  29         *val = rtw_read32(rtwdev, LTECOEX_READ_DATA);
  30 
  31         return true;
  32 }
  33 
  34 bool ltecoex_reg_write(struct rtw_dev *rtwdev, u16 offset, u32 value)
  35 {
  36         if (!check_hw_ready(rtwdev, LTECOEX_ACCESS_CTRL, LTECOEX_READY, 1))
  37                 return false;
  38 
  39         rtw_write32(rtwdev, LTECOEX_WRITE_DATA, value);
  40         rtw_write32(rtwdev, LTECOEX_ACCESS_CTRL, 0xC00F0000 | offset);
  41 
  42         return true;
  43 }
  44 
  45 void rtw_restore_reg(struct rtw_dev *rtwdev,
  46                      struct rtw_backup_info *bckp, u32 num)
  47 {
  48         u8 len;
  49         u32 reg;
  50         u32 val;
  51         int i;
  52 
  53         for (i = 0; i < num; i++, bckp++) {
  54                 len = bckp->len;
  55                 reg = bckp->reg;
  56                 val = bckp->val;
  57 
  58                 switch (len) {
  59                 case 1:
  60                         rtw_write8(rtwdev, reg, (u8)val);
  61                         break;
  62                 case 2:
  63                         rtw_write16(rtwdev, reg, (u16)val);
  64                         break;
  65                 case 4:
  66                         rtw_write32(rtwdev, reg, (u32)val);
  67                         break;
  68                 default:
  69                         break;
  70                 }
  71         }
  72 }