arm: tegra: kai: read mac address from board eeprom

Bug 927456

Change-Id: I98e1d8960888a4e6dd429e73c9ac0d1fce7d90be
Signed-off-by: Om Prakash Singh <omp@nvidia.com>
Reviewed-on: http://git-master/r/86958
Reviewed-by: Rakesh Goyal <rgoyal@nvidia.com>
Reviewed-by: Laxman Dewangan <ldewangan@nvidia.com>

1 files changed, 65 insertions, 0 deletions

diff --git a/arch/arm/mach-tegra/eeprom-wifi-mac.c b/arch/arm/mach-tegra/eeprom-wifi-mac.c
new file mode 100644
index 000000000000..fb35c090906f
--- /dev/null
+++ b/arch/arm/mach-tegra/eeprom-wifi-mac.c
@@ -0,0 +1,65 @@
+#include <linux/i2c/at24.h>
+#include <linux/sysfs.h>
+#include <linux/device.h>
+#include <linux/slab.h>
+
+#define EEPROM_LEN 32
+
+static char wifi_mac[] = "ff:ff:ff:ff:ff:ff";
+
+static ssize_t show_addr_sysfs(struct device *dev,
+			struct device_attribute *attr, char *buf)
+{
+	return sprintf(buf, "%s\n", wifi_mac);
+}
+
+DEVICE_ATTR(addr, 0444, show_addr_sysfs, NULL);
+
+static struct attribute *wifi_mac_addr_attributes[] = {
+	&dev_attr_addr.attr,
+	NULL
+};
+
+static const struct attribute_group wifi_mac_addr_group = {
+	.attrs = wifi_mac_addr_attributes,
+};
+
+int create_sys_fs(void)
+{
+	int ret = -1;
+	static struct kobject *reg_kobj;
+	reg_kobj = kobject_create_and_add("wifi_mac_addr", kernel_kobj);
+	if (!reg_kobj)
+		return -ENOMEM;
+
+	ret = sysfs_create_group(reg_kobj, &wifi_mac_addr_group);
+	if (ret < 0) {
+		kobject_put(reg_kobj);
+		return ret;
+	}
+	return ret;
+}
+
+void get_mac_addr(struct memory_accessor *mem_acc, void *context)
+{
+	char *mac_addr;
+	int ret = 0;
+	off_t offset = (off_t)context;
+	mac_addr = kzalloc(sizeof(char)*EEPROM_LEN, GFP_ATOMIC);
+	if (!mac_addr) {
+		pr_err("no memory to allocate");
+		return;
+	}
+
+	/* Read MAC addr from EEPROM */
+	ret = mem_acc->read(mem_acc, mac_addr, offset, EEPROM_LEN);
+	if (ret == EEPROM_LEN) {
+		pr_err("Read MAC addr from EEPROM: %pM\n", (mac_addr+19));
+		sprintf(wifi_mac, "%02x:%02x:%02x:%02x:%02x:%02x",
+		*(mac_addr+19), *(mac_addr+20), *(mac_addr+21),
+		*(mac_addr+22), *(mac_addr+23), *(mac_addr+24));
+	} else
+		pr_err("Error reading MAC addr from EEPROM\n");
+
+	create_sys_fs();
+}