9ab858cdb2
Will revert this commit when someday someone implement the real WiFi MAC address for NAND.
161 lines
4.3 KiB
C
161 lines
4.3 KiB
C
/* arch/arm/mach-msm/htc_wifi_nvs.c
|
|
*
|
|
* Code to extract WiFi calibration information from ATAG set up
|
|
* by the bootloader.
|
|
*
|
|
* Copyright (C) 2008 Google, Inc.
|
|
* Author: Dmitry Shmidt <dimitrysh@google.com>
|
|
* Changed for nand read for Leo by Markinus
|
|
*
|
|
* This software is licensed under the terms of the GNU General Public
|
|
* License version 2, as published by the Free Software Foundation, and
|
|
* may be copied, distributed, and modified under those terms.
|
|
*
|
|
* 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.
|
|
*
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/proc_fs.h>
|
|
#include <linux/mtd/mtd.h>
|
|
#include <linux/mtd/blktrans.h>
|
|
#include <mach/msm_iomap.h>
|
|
#include <linux/io.h>
|
|
|
|
#include "board-htcleo.h"
|
|
|
|
#define NVS_MAX_SIZE 0x800U
|
|
#define NVS_MACADDR_SIZE 0x1AU
|
|
#define WLAN_SKB_BUF_NUM 16
|
|
|
|
static struct proc_dir_entry *wifi_calibration;
|
|
static unsigned char nvs_mac_addr[NVS_MACADDR_SIZE];
|
|
static unsigned char *hardcoded_nvs =
|
|
"sromrev=3\n"\
|
|
"vendid=0x14e4\n"\
|
|
"devid=0x432f\n"\
|
|
"boardtype=0x4b9\n"\
|
|
"boardrev=0x32\n"\
|
|
"boardflags=0x200\n"\
|
|
"xtalfreq=37400\n"\
|
|
"aa2g=1\n"\
|
|
"aa5g=0\n"\
|
|
"ag0=255\n"\
|
|
"pa0b0=6003\n"\
|
|
"pa0b1=64086\n"\
|
|
"pa0b2=65195\n"\
|
|
"pa0itssit=62\n"\
|
|
"pa0maxpwr=68\n"\
|
|
"opo=0\n"\
|
|
"mcs2gpo0=0x6666\n"\
|
|
"mcs2gpo1=0x6666\n"\
|
|
"rssismf2g=0xa\n"\
|
|
"rssismc2g=0xb\n"\
|
|
"rssisav2g=0x3\n"\
|
|
"bxa2g=0\n"\
|
|
"ccode=ALL\n"\
|
|
"cctl=0x0\n"\
|
|
"cckdigfilttype=0\n"\
|
|
"ofdmdigfilttype=1\n"\
|
|
"rxpo2g=2\n"\
|
|
"boardnum=1\n"\
|
|
"nocrc=1\n"\
|
|
"otpimagesize=182\n"\
|
|
"hwhdr=0x05ffff031030031003100000\n"\
|
|
"RAW1=80 32 fe 21 02 0c 00 22 2a 01 01 00 00 c5 0 e6 00 00 00 00 00 40 00 00 ff ff 80 00 00 00 00 00 00 00 00 00 00 c8 00 00 00 00 00 00 00 00 00 00 00 00 00 ff 20 04 D0 2 29 43 21 02 0c 00 22 04 00 20 00 5A\n"\
|
|
"sd_gpout=0\n"\
|
|
"sd_oobonly=1\n";
|
|
|
|
#include <asm/setup.h>
|
|
|
|
static struct proc_dir_entry *wifi_calibration;
|
|
|
|
unsigned char *get_wifi_nvs_ram( void )
|
|
{
|
|
return hardcoded_nvs;
|
|
}
|
|
EXPORT_SYMBOL(get_wifi_nvs_ram);
|
|
|
|
static int parse_tag_msm_wifi(void)
|
|
{
|
|
uint32_t id1, id2, sid1, sid2, sid3;
|
|
uint32_t id_base = 0xef260;
|
|
/* read Serial Number SN (IMEI = TAC.SN) */
|
|
id1 = readl(MSM_SHARED_RAM_BASE + id_base + 0x8);
|
|
id2 = readl(MSM_SHARED_RAM_BASE + id_base + 0xc);
|
|
/* Xor SN with TAC (yes only two differents TAC for the HD2 */
|
|
id1 ^= readl(MSM_SHARED_RAM_BASE + id_base + 0x0);
|
|
id2 ^= readl(MSM_SHARED_RAM_BASE + id_base + 0x4);
|
|
/* Xor with CID of operator too further mix the Serial */
|
|
id1 ^= readl(MSM_SHARED_RAM_BASE + id_base + 0x10);
|
|
id2 ^= readl(MSM_SHARED_RAM_BASE + id_base + 0x14);
|
|
|
|
/* repack the SN part from IMEI (id) into three bytes using low nibbles */
|
|
sid1 = ((id1 << 4) & 0xf0) | ((id1 >> 8) & 0xf);
|
|
sid2 = ((id1 >> 12) & 0xf0) | ((id1 >> 24) & 0xf);
|
|
sid3 = ((id2 << 4) & 0xf0) | ((id2 >> 8) & 0xf);
|
|
|
|
sprintf(nvs_mac_addr, "macaddr=00:23:76:%02x:%02x:%02x\n", sid1, sid2, sid3);
|
|
pr_info("Device WiFi MAC Address: %s\n", nvs_mac_addr);
|
|
return 0;
|
|
}
|
|
|
|
static unsigned wifi_get_nvs_size( void )
|
|
{
|
|
unsigned len;
|
|
|
|
len = strlen(hardcoded_nvs)+NVS_MACADDR_SIZE;
|
|
return len;
|
|
}
|
|
|
|
int wifi_calibration_size_set(void)
|
|
{
|
|
if (wifi_calibration != NULL)
|
|
wifi_calibration->size = wifi_get_nvs_size();
|
|
return 0;
|
|
}
|
|
|
|
static int wifi_calibration_read_proc(char *page, char **start, off_t off,
|
|
int count, int *eof, void *data)
|
|
{
|
|
unsigned char *ptr;
|
|
unsigned len;
|
|
#ifdef NVS_MSM_WIFI_DEBUG
|
|
unsigned i;
|
|
#endif
|
|
|
|
memcpy(page, nvs_mac_addr, NVS_MACADDR_SIZE);
|
|
ptr = get_wifi_nvs_ram();
|
|
len = min(wifi_get_nvs_size(), (unsigned)count);
|
|
memcpy(page+NVS_MACADDR_SIZE, ptr, strlen(hardcoded_nvs));
|
|
#ifdef NVS_MSM_WIFI_DEBUG
|
|
printk("WiFi Data len = %d \n", len);
|
|
for(i=0;( i < len );i++) {
|
|
printk("%c", *page++);
|
|
}
|
|
#endif
|
|
return len;
|
|
}
|
|
|
|
static int __init wifi_nvs_init(void)
|
|
{
|
|
pr_info("%s\n", __func__);
|
|
if (htcleo_is_nand_boot()) {
|
|
parse_tag_msm_wifi();
|
|
}
|
|
wifi_calibration = create_proc_entry("calibration", 0444, NULL);
|
|
if (wifi_calibration != NULL) {
|
|
wifi_calibration->size = wifi_get_nvs_size();
|
|
wifi_calibration->read_proc = wifi_calibration_read_proc;
|
|
wifi_calibration->write_proc = NULL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
late_initcall(wifi_nvs_init);
|