/****************************************************************************** * * Copyright(c) 2007 - 2017 Realtek Corporation. * * This program is free software; you can redistribute it and/or modify it * under the terms of version 2 of the GNU General Public License as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * *****************************************************************************/ #define _RTW_EEPROM_C_ #include #include #include void up_clk(_adapter *padapter, u16 *x) { *x = *x | _EESK; rtw_write8(padapter, EE_9346CR, (u8)*x); rtw_udelay_os(CLOCK_RATE); } void down_clk(_adapter *padapter, u16 *x) { *x = *x & ~_EESK; rtw_write8(padapter, EE_9346CR, (u8)*x); rtw_udelay_os(CLOCK_RATE); } void shift_out_bits(_adapter *padapter, u16 data, u16 count) { u16 x, mask; if (rtw_is_surprise_removed(padapter)) { goto out; } mask = 0x01 << (count - 1); x = rtw_read8(padapter, EE_9346CR); x &= ~(_EEDO | _EEDI); do { x &= ~_EEDI; if (data & mask) x |= _EEDI; if (rtw_is_surprise_removed(padapter)) { goto out; } rtw_write8(padapter, EE_9346CR, (u8)x); rtw_udelay_os(CLOCK_RATE); up_clk(padapter, &x); down_clk(padapter, &x); mask = mask >> 1; } while (mask); if (rtw_is_surprise_removed(padapter)) { goto out; } x &= ~_EEDI; rtw_write8(padapter, EE_9346CR, (u8)x); out: return; } u16 shift_in_bits(_adapter *padapter) { u16 x, d = 0, i; if (rtw_is_surprise_removed(padapter)) { goto out; } x = rtw_read8(padapter, EE_9346CR); x &= ~(_EEDO | _EEDI); d = 0; for (i = 0; i < 16; i++) { d = d << 1; up_clk(padapter, &x); if (rtw_is_surprise_removed(padapter)) { goto out; } x = rtw_read8(padapter, EE_9346CR); x &= ~(_EEDI); if (x & _EEDO) d |= 1; down_clk(padapter, &x); } out: return d; } void standby(_adapter *padapter) { u8 x; x = rtw_read8(padapter, EE_9346CR); x &= ~(_EECS | _EESK); rtw_write8(padapter, EE_9346CR, x); rtw_udelay_os(CLOCK_RATE); x |= _EECS; rtw_write8(padapter, EE_9346CR, x); rtw_udelay_os(CLOCK_RATE); } u16 wait_eeprom_cmd_done(_adapter *padapter) { u8 x; u16 i, res = _FALSE; standby(padapter); for (i = 0; i < 200; i++) { x = rtw_read8(padapter, EE_9346CR); if (x & _EEDO) { res = _TRUE; goto exit; } rtw_udelay_os(CLOCK_RATE); } exit: return res; } void eeprom_clean(_adapter *padapter) { u16 x; if (rtw_is_surprise_removed(padapter)) { goto out; } x = rtw_read8(padapter, EE_9346CR); if (rtw_is_surprise_removed(padapter)) { goto out; } x &= ~(_EECS | _EEDI); rtw_write8(padapter, EE_9346CR, (u8)x); if (rtw_is_surprise_removed(padapter)) { goto out; } up_clk(padapter, &x); if (rtw_is_surprise_removed(padapter)) { goto out; } down_clk(padapter, &x); out: return; } void eeprom_write16(_adapter *padapter, u16 reg, u16 data) { u8 x; #ifdef CONFIG_RTL8712 u8 tmp8_ori, tmp8_new, tmp8_clk_ori, tmp8_clk_new; tmp8_ori = rtw_read8(padapter, 0x102502f1); tmp8_new = tmp8_ori & 0xf7; if (tmp8_ori != tmp8_new) { rtw_write8(padapter, 0x102502f1, tmp8_new); } tmp8_clk_ori = rtw_read8(padapter, 0x10250003); tmp8_clk_new = tmp8_clk_ori | 0x20; if (tmp8_clk_new != tmp8_clk_ori) { rtw_write8(padapter, 0x10250003, tmp8_clk_new); } #endif x = rtw_read8(padapter, EE_9346CR); x &= ~(_EEDI | _EEDO | _EESK | _EEM0); x |= _EEM1 | _EECS; rtw_write8(padapter, EE_9346CR, x); shift_out_bits(padapter, EEPROM_EWEN_OPCODE, 5); if (padapter->EepromAddressSize == 8) /* CF+ and SDIO */ shift_out_bits(padapter, 0, 6); else /* USB */ shift_out_bits(padapter, 0, 4); standby(padapter); /* Commented out by rcnjko, 2004.0 * Erase this particular word. Write the erase opcode and register * number in that order. The opcode is 3bits in length; reg is 6 bits long. */ /* shift_out_bits(Adapter, EEPROM_ERASE_OPCODE, 3); * shift_out_bits(Adapter, reg, Adapter->EepromAddressSize); * * if (wait_eeprom_cmd_done(Adapter ) == FALSE) * { * return; * } */ standby(padapter); /* write the new word to the EEPROM */ /* send the write opcode the EEPORM */ shift_out_bits(padapter, EEPROM_WRITE_OPCODE, 3); /* select which word in the EEPROM that we are writing to. */ shift_out_bits(padapter, reg, padapter->EepromAddressSize); /* write the data to the selected EEPROM word. */ shift_out_bits(padapter, data, 16); if (wait_eeprom_cmd_done(padapter) == _FALSE) goto exit; standby(padapter); shift_out_bits(padapter, EEPROM_EWDS_OPCODE, 5); shift_out_bits(padapter, reg, 4); eeprom_clean(padapter); exit: #ifdef CONFIG_RTL8712 if (tmp8_clk_new != tmp8_clk_ori) rtw_write8(padapter, 0x10250003, tmp8_clk_ori); if (tmp8_new != tmp8_ori) rtw_write8(padapter, 0x102502f1, tmp8_ori); #endif return; } u16 eeprom_read16(_adapter *padapter, u16 reg) /* ReadEEprom */ { u16 x; u16 data = 0; #ifdef CONFIG_RTL8712 u8 tmp8_ori, tmp8_new, tmp8_clk_ori, tmp8_clk_new; tmp8_ori = rtw_read8(padapter, 0x102502f1); tmp8_new = tmp8_ori & 0xf7; if (tmp8_ori != tmp8_new) { rtw_write8(padapter, 0x102502f1, tmp8_new); } tmp8_clk_ori = rtw_read8(padapter, 0x10250003); tmp8_clk_new = tmp8_clk_ori | 0x20; if (tmp8_clk_new != tmp8_clk_ori) { rtw_write8(padapter, 0x10250003, tmp8_clk_new); } #endif if (rtw_is_surprise_removed(padapter)) { goto out; } /* select EEPROM, reset bits, set _EECS */ x = rtw_read8(padapter, EE_9346CR); if (rtw_is_surprise_removed(padapter)) { goto out; } x &= ~(_EEDI | _EEDO | _EESK | _EEM0); x |= _EEM1 | _EECS; rtw_write8(padapter, EE_9346CR, (unsigned char)x); /* write the read opcode and register number in that order */ /* The opcode is 3bits in length, reg is 6 bits long */ shift_out_bits(padapter, EEPROM_READ_OPCODE, 3); shift_out_bits(padapter, reg, padapter->EepromAddressSize); /* Now read the data (16 bits) in from the selected EEPROM word */ data = shift_in_bits(padapter); eeprom_clean(padapter); out: #ifdef CONFIG_RTL8712 if (tmp8_clk_new != tmp8_clk_ori) rtw_write8(padapter, 0x10250003, tmp8_clk_ori); if (tmp8_new != tmp8_ori) rtw_write8(padapter, 0x102502f1, tmp8_ori); #endif return data; } /* From even offset */ void eeprom_read_sz(_adapter *padapter, u16 reg, u8 *data, u32 sz) { u16 x, data16; u32 i; if (rtw_is_surprise_removed(padapter)) { goto out; } /* select EEPROM, reset bits, set _EECS */ x = rtw_read8(padapter, EE_9346CR); if (rtw_is_surprise_removed(padapter)) { goto out; } x &= ~(_EEDI | _EEDO | _EESK | _EEM0); x |= _EEM1 | _EECS; rtw_write8(padapter, EE_9346CR, (unsigned char)x); /* write the read opcode and register number in that order */ /* The opcode is 3bits in length, reg is 6 bits long */ shift_out_bits(padapter, EEPROM_READ_OPCODE, 3); shift_out_bits(padapter, reg, padapter->EepromAddressSize); for (i = 0; i < sz; i += 2) { data16 = shift_in_bits(padapter); data[i] = data16 & 0xff; data[i + 1] = data16 >> 8; } eeprom_clean(padapter); out: return; } /* addr_off : address offset of the entry in eeprom (not the tuple number of eeprom (reg); that is addr_off !=reg) */ u8 eeprom_read(_adapter *padapter, u32 addr_off, u8 sz, u8 *rbuf) { u8 quotient, remainder, addr_2align_odd; u16 reg, stmp , i = 0, idx = 0; reg = (u16)(addr_off >> 1); addr_2align_odd = (u8)(addr_off & 0x1); if (addr_2align_odd) { /* read that start at high part: e.g 1,3,5,7,9,... */ stmp = eeprom_read16(padapter, reg); rbuf[idx++] = (u8)((stmp >> 8) & 0xff); /* return hogh-part of the short */ reg++; sz--; } quotient = sz >> 1; remainder = sz & 0x1; for (i = 0 ; i < quotient; i++) { stmp = eeprom_read16(padapter, reg + i); rbuf[idx++] = (u8)(stmp & 0xff); rbuf[idx++] = (u8)((stmp >> 8) & 0xff); } reg = reg + i; if (remainder) { /* end of read at lower part of short : 0,2,4,6,... */ stmp = eeprom_read16(padapter, reg); rbuf[idx] = (u8)(stmp & 0xff); } return _TRUE; } VOID read_eeprom_content(_adapter *padapter) { }