diff --git a/eeprom.c b/eeprom.c index a722f7186..eabfc1c01 100644 --- a/eeprom.c +++ b/eeprom.c @@ -6,6 +6,7 @@ #include #include #include +#include #include #include "mt76.h" @@ -103,6 +104,37 @@ static int mt76_get_of_epprom_from_mtd(struct mt76_dev *dev, void *eep, int offs } #endif +static int mt76_get_of_epprom_from_nvmem(struct mt76_dev *dev, void *eep, int len) +{ + struct device_node *np = dev->dev->of_node; + struct nvmem_cell *cell; + const void *data; + size_t retlen; + int ret = 0; + + cell = of_nvmem_cell_get(np, "precal"); + if (IS_ERR(cell)) + return PTR_ERR(cell); + + data = nvmem_cell_read(cell, &retlen); + nvmem_cell_put(cell); + + if (IS_ERR(data)) + return PTR_ERR(data); + + if (retlen < len) { + ret = -EINVAL; + goto exit; + } + + memcpy(eep, data, len); + +exit: + kfree(data); + + return ret; +} + int mt76_get_of_eeprom(struct mt76_dev *dev, void *eep, int offset, int len) { struct device_node *np = dev->dev->of_node; @@ -121,6 +153,8 @@ int mt76_get_of_eeprom(struct mt76_dev *dev, void *eep, int offset, int len) return 0; #endif + ret = mt76_get_of_epprom_from_nvmem(dev, eep, len); + return ret; } EXPORT_SYMBOL_GPL(mt76_get_of_eeprom);