drivers/staging/rtl8723bs/core/rtw_eeprom.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /******************************************************************************
   3  *
   4  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
   5  *
   6  ******************************************************************************/
   7 #define _RTW_EEPROM_C_
   8
   9 #include <drv_conf.h>
  10 #include <osdep_service.h>
  11 #include <drv_types.h>
  12
  13 void up_clk(_adapter *padapter,  u16 *x)
  14 {
  15 _func_enter_;
  16         *x = *x | _EESK;
  17         rtw_write8(padapter, EE_9346CR, (u8)*x);
  18         udelay(CLOCK_RATE);
  19
  20 _func_exit_;
  21
  22 }
  23
  24 void down_clk(_adapter *padapter, u16 *x)
  25 {
  26 _func_enter_;
  27         *x = *x & ~_EESK;
  28         rtw_write8(padapter, EE_9346CR, (u8)*x);
  29         udelay(CLOCK_RATE);
  30 _func_exit_;
  31 }
  32
  33 void shift_out_bits(_adapter *padapter, u16 data, u16 count)
  34 {
  35         u16 x, mask;
  36 _func_enter_;
  37
  38         if (padapter->bSurpriseRemoved == true) {
  39                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
  40                 goto out;
  41         }
  42         mask = 0x01 << (count - 1);
  43         x = rtw_read8(padapter, EE_9346CR);
  44
  45         x &= ~(_EEDO | _EEDI);
  46
  47         do {
  48                 x &= ~_EEDI;
  49                 if (data & mask)
  50                         x |= _EEDI;
  51                 if (padapter->bSurpriseRemoved == true) {
  52                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
  53                 goto out;
  54                 }
  55                 rtw_write8(padapter, EE_9346CR, (u8)x);
  56                 udelay(CLOCK_RATE);
  57                 up_clk(padapter, &x);
  58                 down_clk(padapter, &x);
  59                 mask = mask >> 1;
  60         } while (mask);
  61         if (padapter->bSurpriseRemoved == true) {
  62                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
  63                 goto out;
  64         }
  65         x &= ~_EEDI;
  66         rtw_write8(padapter, EE_9346CR, (u8)x);
  67 out:
  68 _func_exit_;
  69 }
  70
  71 u16 shift_in_bits(_adapter *padapter)
  72 {
  73         u16 x, d = 0, i;
  74 _func_enter_;
  75         if (padapter->bSurpriseRemoved == true) {
  76                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
  77                 goto out;
  78         }
  79         x = rtw_read8(padapter, EE_9346CR);
  80
  81         x &= ~(_EEDO | _EEDI);
  82         d = 0;
  83
  84         for (i = 0; i < 16; i++) {
  85                 d = d << 1;
  86                 up_clk(padapter, &x);
  87         if (padapter->bSurpriseRemoved == true) {
  88                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
  89                 goto out;
  90         }
  91                 x = rtw_read8(padapter, EE_9346CR);
  92
  93                 x &= ~(_EEDI);
  94                 if (x & _EEDO)
  95                 d |= 1;
  96
  97                 down_clk(padapter, &x);
  98         }
  99 out:
 100 _func_exit_;
 101
 102         return d;
 103 }
 104
 105 void standby(_adapter *padapter)
 106 {
 107         u8   x;
 108 _func_enter_;
 109         x = rtw_read8(padapter, EE_9346CR);
 110
 111         x &= ~(_EECS | _EESK);
 112         rtw_write8(padapter, EE_9346CR, x);
 113
 114         udelay(CLOCK_RATE);
 115         x |= _EECS;
 116         rtw_write8(padapter, EE_9346CR, x);
 117         udelay(CLOCK_RATE);
 118 _func_exit_;
 119 }
 120
 121 void eeprom_clean(_adapter *padapter)
 122 {
 123         u16 x;
 124 _func_enter_;
 125         if (padapter->bSurpriseRemoved == true) {
 126                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
 127                 goto out;
 128         }
 129         x = rtw_read8(padapter, EE_9346CR);
 130         if (padapter->bSurpriseRemoved == true) {
 131                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
 132                 goto out;
 133         }
 134         x &= ~(_EECS | _EEDI);
 135         rtw_write8(padapter, EE_9346CR, (u8)x);
 136         if (padapter->bSurpriseRemoved == true) {
 137                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
 138                 goto out;
 139         }
 140         up_clk(padapter, &x);
 141                 if (padapter->bSurpriseRemoved == true) {
 142                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
 143                 goto out;
 144         }
 145         down_clk(padapter, &x);
 146 out:
 147 _func_exit_;
 148 }
 149
 150 u16 eeprom_read16(_adapter *padapter, u16 reg) /*ReadEEprom*/
 151 {
 152
 153         u16 x;
 154         u16 data = 0;
 155
 156 _func_enter_;
 157
 158         if (padapter->bSurpriseRemoved == true) {
 159                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
 160                 goto out;
 161         }
 162         /* select EEPROM, reset bits, set _EECS*/
 163         x = rtw_read8(padapter, EE_9346CR);
 164
 165         if (padapter->bSurpriseRemoved == true) {
 166                 RT_TRACE(_module_rtl871x_eeprom_c_, _drv_err_, ("padapter->bSurpriseRemoved==true"));
 167                 goto out;
 168         }
 169
 170         x &= ~(_EEDI | _EEDO | _EESK | _EEM0);
 171         x |= _EEM1 | _EECS;
 172         rtw_write8(padapter, EE_9346CR, (unsigned char)x);
 173
 174         /* write the read opcode and register number in that order*/
 175         /* The opcode is 3bits in length, reg is 6 bits long*/
 176         shift_out_bits(padapter, EEPROM_READ_OPCODE, 3);
 177         shift_out_bits(padapter, reg, padapter->EepromAddressSize);
 178
 179         /* Now read the data (16 bits) in from the selected EEPROM word*/
 180         data = shift_in_bits(padapter);
 181
 182         eeprom_clean(padapter);
 183 out:
 184 _func_exit_;
 185         return data;
 186
 187
 188 }
 189
 190 /*addr_off : address offset of the entry in eeprom (not the tuple number of eeprom (reg); that is addr_off !=reg)*/
 191 u8 eeprom_read(_adapter *padapter, u32 addr_off, u8 sz, u8 *rbuf)
 192 {
 193         u8 quotient, remainder, addr_2align_odd;
 194         u16 reg, stmp, i = 0, idx = 0;
 195 _func_enter_;
 196         reg = (u16)(addr_off >> 1);
 197         addr_2align_odd = (u8)(addr_off & 0x1);
 198
 199         /*read that start at high part: e.g  1,3,5,7,9,...*/
 200         if (addr_2align_odd) {
 201                 stmp = eeprom_read16(padapter, reg);
 202                 rbuf[idx++] = (u8) ((stmp>>8)&0xff); /*return hogh-part of the short*/
 203                 reg++; sz--;
 204         }
 205
 206         quotient = sz >> 1;
 207         remainder = sz & 0x1;
 208
 209         for (i = 0; i < quotient; i++) {
 210                 stmp = eeprom_read16(padapter, reg+i);
 211                 rbuf[idx++] = (u8) (stmp&0xff);
 212                 rbuf[idx++] = (u8) ((stmp>>8)&0xff);
 213         }
 214
 215         reg = reg+i;
 216         if (remainder) { /*end of read at lower part of short : 0,2,4,6,...*/
 217                 stmp = eeprom_read16(padapter, reg);
 218                 rbuf[idx] = (u8)(stmp & 0xff);
 219         }
 220 _func_exit_;
 221         return true;
 222 }