Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit edb45b67 authored by Larry Finger's avatar Larry Finger Committed by Kalle Valo
Browse files

rtlwifi: Create common routine to get hardware info 



All of the rtlwifi family of drivers have a similar routine that acquires
the hardware info from efuse and initializes a number of variables in the
driver's private area. A common routine is created for all drivers to use.

Reported-by: default avatarArnd Bergmann <arnd@arndb.de>
Signed-off-by: default avatarLarry Finger <Larry.Finger@lwfinger.net>
Cc: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: default avatarKalle Valo <kvalo@codeaurora.org>
parent 5781fc29

drivers/net/wireless/realtek/rtlwifi/efuse.c

+78 −0
Original line number Diff line number Diff line
@@ -24,6 +24,7 @@ 
 *****************************************************************************/

#include "wifi.h"

#include "efuse.h"

#include "pci.h"

#include <linux/export.h>



static const u8 MAX_PGPKT_SIZE = 9;
@@ -1243,3 +1244,80 @@ static u8 efuse_calculate_word_cnts(u8 word_en) 
	return word_cnts;

}



int rtl_get_hwinfo(struct ieee80211_hw *hw, struct rtl_priv *rtlpriv,

		   int max_size, u8 *hwinfo, int *params)

{

	struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));

	struct rtl_pci_priv *rtlpcipriv = rtl_pcipriv(hw);

	struct device *dev = &rtlpcipriv->dev.pdev->dev;

	u16 eeprom_id;

	u16 i, usvalue;



	switch (rtlefuse->epromtype) {

	case EEPROM_BOOT_EFUSE:

		rtl_efuse_shadow_map_update(hw);

		break;



	case EEPROM_93C46:

		RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,

			 "RTL8XXX did not boot from eeprom, check it !!\n");

		return 1;



	default:

		dev_warn(dev, "no efuse data\n");

		return 1;

	}



	memcpy(hwinfo, &rtlefuse->efuse_map[EFUSE_INIT_MAP][0], max_size);



	RT_PRINT_DATA(rtlpriv, COMP_INIT, DBG_DMESG, "MAP",

		      hwinfo, max_size);



	eeprom_id = *((u16 *)&hwinfo[0]);

	if (eeprom_id != params[0]) {

		RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,

			 "EEPROM ID(%#x) is invalid!!\n", eeprom_id);

		rtlefuse->autoload_failflag = true;

	} else {

		RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "Autoload OK\n");

		rtlefuse->autoload_failflag = false;

	}



	if (rtlefuse->autoload_failflag)

		return 1;



	rtlefuse->eeprom_vid = *(u16 *)&hwinfo[params[1]];

	rtlefuse->eeprom_did = *(u16 *)&hwinfo[params[2]];

	rtlefuse->eeprom_svid = *(u16 *)&hwinfo[params[3]];

	rtlefuse->eeprom_smid = *(u16 *)&hwinfo[params[4]];

	RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,

		 "EEPROMId = 0x%4x\n", eeprom_id);

	RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,

		 "EEPROM VID = 0x%4x\n", rtlefuse->eeprom_vid);

	RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,

		 "EEPROM DID = 0x%4x\n", rtlefuse->eeprom_did);

	RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,

		 "EEPROM SVID = 0x%4x\n", rtlefuse->eeprom_svid);

	RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,

		 "EEPROM SMID = 0x%4x\n", rtlefuse->eeprom_smid);



	for (i = 0; i < 6; i += 2) {

		usvalue = *(u16 *)&hwinfo[params[5] + i];

		*((u16 *)(&rtlefuse->dev_addr[i])) = usvalue;

	}

	RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG, "%pM\n", rtlefuse->dev_addr);



	rtlefuse->eeprom_channelplan = *&hwinfo[params[6]];

	rtlefuse->eeprom_version = *(u16 *)&hwinfo[params[7]];

	rtlefuse->txpwr_fromeprom = true;

	rtlefuse->eeprom_oemid = *&hwinfo[params[8]];



	RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,

		 "EEPROM Customer ID: 0x%2x\n", rtlefuse->eeprom_oemid);



	/* set channel plan to world wide 13 */

	rtlefuse->channel_plan = params[9];



	return 0;

}

EXPORT_SYMBOL_GPL(rtl_get_hwinfo);

drivers/net/wireless/realtek/rtlwifi/efuse.h

+2 −0
Original line number Diff line number Diff line
@@ -109,5 +109,7 @@ bool efuse_shadow_update_chk(struct ieee80211_hw *hw); 
void rtl_efuse_shadow_map_update(struct ieee80211_hw *hw);

void efuse_force_write_vendor_Id(struct ieee80211_hw *hw);

void efuse_re_pg_section(struct ieee80211_hw *hw, u8 section_idx);

int rtl_get_hwinfo(struct ieee80211_hw *hw, struct rtl_priv *rtlpriv,

		   int max_size, u8 *hwinfo, int *params);



#endif