| /* |
| * NXP LPC18xx/LPC43xx EEPROM memory NVMEM driver |
| * |
| * Copyright (c) 2015 Ariel D'Alessandro <ariel@vanguardiasur.com> |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of the GNU General Public License version 2 as published by |
| * the Free Software Foundation. |
| */ |
| |
| #include <linux/clk.h> |
| #include <linux/device.h> |
| #include <linux/delay.h> |
| #include <linux/err.h> |
| #include <linux/io.h> |
| #include <linux/module.h> |
| #include <linux/nvmem-provider.h> |
| #include <linux/platform_device.h> |
| #include <linux/regmap.h> |
| #include <linux/reset.h> |
| |
| /* Registers */ |
| #define LPC18XX_EEPROM_AUTOPROG 0x00c |
| #define LPC18XX_EEPROM_AUTOPROG_WORD 0x1 |
| |
| #define LPC18XX_EEPROM_CLKDIV 0x014 |
| |
| #define LPC18XX_EEPROM_PWRDWN 0x018 |
| #define LPC18XX_EEPROM_PWRDWN_NO 0x0 |
| #define LPC18XX_EEPROM_PWRDWN_YES 0x1 |
| |
| #define LPC18XX_EEPROM_INTSTAT 0xfe0 |
| #define LPC18XX_EEPROM_INTSTAT_END_OF_PROG BIT(2) |
| |
| #define LPC18XX_EEPROM_INTSTATCLR 0xfe8 |
| #define LPC18XX_EEPROM_INTSTATCLR_PROG_CLR_ST BIT(2) |
| |
| /* Fixed page size (bytes) */ |
| #define LPC18XX_EEPROM_PAGE_SIZE 0x80 |
| |
| /* EEPROM device requires a ~1500 kHz clock (min 800 kHz, max 1600 kHz) */ |
| #define LPC18XX_EEPROM_CLOCK_HZ 1500000 |
| |
| /* EEPROM requires 3 ms of erase/program time between each writing */ |
| #define LPC18XX_EEPROM_PROGRAM_TIME 3 |
| |
| struct lpc18xx_eeprom_dev { |
| struct clk *clk; |
| void __iomem *reg_base; |
| void __iomem *mem_base; |
| struct nvmem_device *nvmem; |
| unsigned reg_bytes; |
| unsigned val_bytes; |
| }; |
| |
| static struct regmap_config lpc18xx_regmap_config = { |
| .reg_bits = 32, |
| .reg_stride = 4, |
| .val_bits = 32, |
| }; |
| |
| static inline void lpc18xx_eeprom_writel(struct lpc18xx_eeprom_dev *eeprom, |
| u32 reg, u32 val) |
| { |
| writel(val, eeprom->reg_base + reg); |
| } |
| |
| static inline u32 lpc18xx_eeprom_readl(struct lpc18xx_eeprom_dev *eeprom, |
| u32 reg) |
| { |
| return readl(eeprom->reg_base + reg); |
| } |
| |
| static int lpc18xx_eeprom_busywait_until_prog(struct lpc18xx_eeprom_dev *eeprom) |
| { |
| unsigned long end; |
| u32 val; |
| |
| /* Wait until EEPROM program operation has finished */ |
| end = jiffies + msecs_to_jiffies(LPC18XX_EEPROM_PROGRAM_TIME * 10); |
| |
| while (time_is_after_jiffies(end)) { |
| val = lpc18xx_eeprom_readl(eeprom, LPC18XX_EEPROM_INTSTAT); |
| |
| if (val & LPC18XX_EEPROM_INTSTAT_END_OF_PROG) { |
| lpc18xx_eeprom_writel(eeprom, LPC18XX_EEPROM_INTSTATCLR, |
| LPC18XX_EEPROM_INTSTATCLR_PROG_CLR_ST); |
| return 0; |
| } |
| |
| usleep_range(LPC18XX_EEPROM_PROGRAM_TIME * USEC_PER_MSEC, |
| (LPC18XX_EEPROM_PROGRAM_TIME + 1) * USEC_PER_MSEC); |
| } |
| |
| return -ETIMEDOUT; |
| } |
| |
| static int lpc18xx_eeprom_gather_write(void *context, const void *reg, |
| size_t reg_size, const void *val, |
| size_t val_size) |
| { |
| struct lpc18xx_eeprom_dev *eeprom = context; |
| unsigned int offset = *(u32 *)reg; |
| int ret; |
| |
| if (offset % lpc18xx_regmap_config.reg_stride) |
| return -EINVAL; |
| |
| lpc18xx_eeprom_writel(eeprom, LPC18XX_EEPROM_PWRDWN, |
| LPC18XX_EEPROM_PWRDWN_NO); |
| |
| /* Wait 100 us while the EEPROM wakes up */ |
| usleep_range(100, 200); |
| |
| while (val_size) { |
| writel(*(u32 *)val, eeprom->mem_base + offset); |
| ret = lpc18xx_eeprom_busywait_until_prog(eeprom); |
| if (ret < 0) |
| return ret; |
| |
| val_size -= eeprom->val_bytes; |
| val += eeprom->val_bytes; |
| offset += eeprom->val_bytes; |
| } |
| |
| lpc18xx_eeprom_writel(eeprom, LPC18XX_EEPROM_PWRDWN, |
| LPC18XX_EEPROM_PWRDWN_YES); |
| |
| return 0; |
| } |
| |
| static int lpc18xx_eeprom_write(void *context, const void *data, size_t count) |
| { |
| struct lpc18xx_eeprom_dev *eeprom = context; |
| unsigned int offset = eeprom->reg_bytes; |
| |
| if (count <= offset) |
| return -EINVAL; |
| |
| return lpc18xx_eeprom_gather_write(context, data, eeprom->reg_bytes, |
| data + offset, count - offset); |
| } |
| |
| static int lpc18xx_eeprom_read(void *context, const void *reg, size_t reg_size, |
| void *val, size_t val_size) |
| { |
| struct lpc18xx_eeprom_dev *eeprom = context; |
| unsigned int offset = *(u32 *)reg; |
| |
| lpc18xx_eeprom_writel(eeprom, LPC18XX_EEPROM_PWRDWN, |
| LPC18XX_EEPROM_PWRDWN_NO); |
| |
| /* Wait 100 us while the EEPROM wakes up */ |
| usleep_range(100, 200); |
| |
| while (val_size) { |
| *(u32 *)val = readl(eeprom->mem_base + offset); |
| val_size -= eeprom->val_bytes; |
| val += eeprom->val_bytes; |
| offset += eeprom->val_bytes; |
| } |
| |
| lpc18xx_eeprom_writel(eeprom, LPC18XX_EEPROM_PWRDWN, |
| LPC18XX_EEPROM_PWRDWN_YES); |
| |
| return 0; |
| } |
| |
| static struct regmap_bus lpc18xx_eeprom_bus = { |
| .write = lpc18xx_eeprom_write, |
| .gather_write = lpc18xx_eeprom_gather_write, |
| .read = lpc18xx_eeprom_read, |
| .reg_format_endian_default = REGMAP_ENDIAN_NATIVE, |
| .val_format_endian_default = REGMAP_ENDIAN_NATIVE, |
| }; |
| |
| static bool lpc18xx_eeprom_writeable_reg(struct device *dev, unsigned int reg) |
| { |
| /* |
| * The last page contains the EEPROM initialization data and is not |
| * writable. |
| */ |
| return reg <= lpc18xx_regmap_config.max_register - |
| LPC18XX_EEPROM_PAGE_SIZE; |
| } |
| |
| static bool lpc18xx_eeprom_readable_reg(struct device *dev, unsigned int reg) |
| { |
| return reg <= lpc18xx_regmap_config.max_register; |
| } |
| |
| static struct nvmem_config lpc18xx_nvmem_config = { |
| .name = "lpc18xx-eeprom", |
| .owner = THIS_MODULE, |
| }; |
| |
| static int lpc18xx_eeprom_probe(struct platform_device *pdev) |
| { |
| struct lpc18xx_eeprom_dev *eeprom; |
| struct device *dev = &pdev->dev; |
| struct reset_control *rst; |
| unsigned long clk_rate; |
| struct regmap *regmap; |
| struct resource *res; |
| int ret; |
| |
| eeprom = devm_kzalloc(dev, sizeof(*eeprom), GFP_KERNEL); |
| if (!eeprom) |
| return -ENOMEM; |
| |
| res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "reg"); |
| eeprom->reg_base = devm_ioremap_resource(dev, res); |
| if (IS_ERR(eeprom->reg_base)) |
| return PTR_ERR(eeprom->reg_base); |
| |
| res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mem"); |
| eeprom->mem_base = devm_ioremap_resource(dev, res); |
| if (IS_ERR(eeprom->mem_base)) |
| return PTR_ERR(eeprom->mem_base); |
| |
| eeprom->clk = devm_clk_get(&pdev->dev, "eeprom"); |
| if (IS_ERR(eeprom->clk)) { |
| dev_err(&pdev->dev, "failed to get eeprom clock\n"); |
| return PTR_ERR(eeprom->clk); |
| } |
| |
| ret = clk_prepare_enable(eeprom->clk); |
| if (ret < 0) { |
| dev_err(dev, "failed to prepare/enable eeprom clk: %d\n", ret); |
| return ret; |
| } |
| |
| rst = devm_reset_control_get(dev, NULL); |
| if (IS_ERR(rst)) { |
| dev_err(dev, "failed to get reset: %ld\n", PTR_ERR(rst)); |
| ret = PTR_ERR(rst); |
| goto err_clk; |
| } |
| |
| ret = reset_control_assert(rst); |
| if (ret < 0) { |
| dev_err(dev, "failed to assert reset: %d\n", ret); |
| goto err_clk; |
| } |
| |
| eeprom->val_bytes = lpc18xx_regmap_config.val_bits / BITS_PER_BYTE; |
| eeprom->reg_bytes = lpc18xx_regmap_config.reg_bits / BITS_PER_BYTE; |
| |
| /* |
| * Clock rate is generated by dividing the system bus clock by the |
| * division factor, contained in the divider register (minus 1 encoded). |
| */ |
| clk_rate = clk_get_rate(eeprom->clk); |
| clk_rate = DIV_ROUND_UP(clk_rate, LPC18XX_EEPROM_CLOCK_HZ) - 1; |
| lpc18xx_eeprom_writel(eeprom, LPC18XX_EEPROM_CLKDIV, clk_rate); |
| |
| /* |
| * Writing a single word to the page will start the erase/program cycle |
| * automatically |
| */ |
| lpc18xx_eeprom_writel(eeprom, LPC18XX_EEPROM_AUTOPROG, |
| LPC18XX_EEPROM_AUTOPROG_WORD); |
| |
| lpc18xx_eeprom_writel(eeprom, LPC18XX_EEPROM_PWRDWN, |
| LPC18XX_EEPROM_PWRDWN_YES); |
| |
| lpc18xx_regmap_config.max_register = resource_size(res) - 1; |
| lpc18xx_regmap_config.writeable_reg = lpc18xx_eeprom_writeable_reg; |
| lpc18xx_regmap_config.readable_reg = lpc18xx_eeprom_readable_reg; |
| |
| regmap = devm_regmap_init(dev, &lpc18xx_eeprom_bus, eeprom, |
| &lpc18xx_regmap_config); |
| if (IS_ERR(regmap)) { |
| dev_err(dev, "regmap init failed: %ld\n", PTR_ERR(regmap)); |
| ret = PTR_ERR(regmap); |
| goto err_clk; |
| } |
| |
| lpc18xx_nvmem_config.dev = dev; |
| |
| eeprom->nvmem = nvmem_register(&lpc18xx_nvmem_config); |
| if (IS_ERR(eeprom->nvmem)) { |
| ret = PTR_ERR(eeprom->nvmem); |
| goto err_clk; |
| } |
| |
| platform_set_drvdata(pdev, eeprom); |
| |
| return 0; |
| |
| err_clk: |
| clk_disable_unprepare(eeprom->clk); |
| |
| return ret; |
| } |
| |
| static int lpc18xx_eeprom_remove(struct platform_device *pdev) |
| { |
| struct lpc18xx_eeprom_dev *eeprom = platform_get_drvdata(pdev); |
| int ret; |
| |
| ret = nvmem_unregister(eeprom->nvmem); |
| if (ret < 0) |
| return ret; |
| |
| clk_disable_unprepare(eeprom->clk); |
| |
| return 0; |
| } |
| |
| static const struct of_device_id lpc18xx_eeprom_of_match[] = { |
| { .compatible = "nxp,lpc1857-eeprom" }, |
| { }, |
| }; |
| MODULE_DEVICE_TABLE(of, lpc18xx_eeprom_of_match); |
| |
| static struct platform_driver lpc18xx_eeprom_driver = { |
| .probe = lpc18xx_eeprom_probe, |
| .remove = lpc18xx_eeprom_remove, |
| .driver = { |
| .name = "lpc18xx-eeprom", |
| .of_match_table = lpc18xx_eeprom_of_match, |
| }, |
| }; |
| |
| module_platform_driver(lpc18xx_eeprom_driver); |
| |
| MODULE_AUTHOR("Ariel D'Alessandro <ariel@vanguardiasur.com.ar>"); |
| MODULE_DESCRIPTION("NXP LPC18xx EEPROM memory Driver"); |
| MODULE_LICENSE("GPL v2"); |