117c50b70SJoachim Eastwood /* 217c50b70SJoachim Eastwood * Memory controller driver for ARM PrimeCell PL172 317c50b70SJoachim Eastwood * PrimeCell MultiPort Memory Controller (PL172) 417c50b70SJoachim Eastwood * 517c50b70SJoachim Eastwood * Copyright (C) 2015 Joachim Eastwood <manabian@gmail.com> 617c50b70SJoachim Eastwood * 717c50b70SJoachim Eastwood * Based on: 817c50b70SJoachim Eastwood * TI AEMIF driver, Copyright (C) 2010 - 2013 Texas Instruments Inc. 917c50b70SJoachim Eastwood * 1017c50b70SJoachim Eastwood * This file is licensed under the terms of the GNU General Public 1117c50b70SJoachim Eastwood * License version 2. This program is licensed "as is" without any 1217c50b70SJoachim Eastwood * warranty of any kind, whether express or implied. 1317c50b70SJoachim Eastwood */ 1417c50b70SJoachim Eastwood 1517c50b70SJoachim Eastwood #include <linux/amba/bus.h> 1617c50b70SJoachim Eastwood #include <linux/clk.h> 1717c50b70SJoachim Eastwood #include <linux/device.h> 1817c50b70SJoachim Eastwood #include <linux/err.h> 1917c50b70SJoachim Eastwood #include <linux/init.h> 2017c50b70SJoachim Eastwood #include <linux/io.h> 2117c50b70SJoachim Eastwood #include <linux/kernel.h> 2217c50b70SJoachim Eastwood #include <linux/module.h> 2317c50b70SJoachim Eastwood #include <linux/of.h> 2417c50b70SJoachim Eastwood #include <linux/of_platform.h> 2517c50b70SJoachim Eastwood #include <linux/time.h> 2617c50b70SJoachim Eastwood 2717c50b70SJoachim Eastwood #define MPMC_STATIC_CFG(n) (0x200 + 0x20 * n) 2817c50b70SJoachim Eastwood #define MPMC_STATIC_CFG_MW_8BIT 0x0 2917c50b70SJoachim Eastwood #define MPMC_STATIC_CFG_MW_16BIT 0x1 3017c50b70SJoachim Eastwood #define MPMC_STATIC_CFG_MW_32BIT 0x2 3117c50b70SJoachim Eastwood #define MPMC_STATIC_CFG_PM BIT(3) 3217c50b70SJoachim Eastwood #define MPMC_STATIC_CFG_PC BIT(6) 3317c50b70SJoachim Eastwood #define MPMC_STATIC_CFG_PB BIT(7) 3417c50b70SJoachim Eastwood #define MPMC_STATIC_CFG_EW BIT(8) 3517c50b70SJoachim Eastwood #define MPMC_STATIC_CFG_B BIT(19) 3617c50b70SJoachim Eastwood #define MPMC_STATIC_CFG_P BIT(20) 3717c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_WEN(n) (0x204 + 0x20 * n) 3817c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_WEN_MAX 0x0f 3917c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_OEN(n) (0x208 + 0x20 * n) 4017c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_OEN_MAX 0x0f 4117c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_RD(n) (0x20c + 0x20 * n) 4217c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_RD_MAX 0x1f 4317c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_PAGE(n) (0x210 + 0x20 * n) 4417c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_PAGE_MAX 0x1f 4517c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_WR(n) (0x214 + 0x20 * n) 4617c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_WR_MAX 0x1f 4717c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_TURN(n) (0x218 + 0x20 * n) 4817c50b70SJoachim Eastwood #define MPMC_STATIC_WAIT_TURN_MAX 0x0f 4917c50b70SJoachim Eastwood 5017c50b70SJoachim Eastwood /* Maximum number of static chip selects */ 5117c50b70SJoachim Eastwood #define PL172_MAX_CS 4 5217c50b70SJoachim Eastwood 5317c50b70SJoachim Eastwood struct pl172_data { 5417c50b70SJoachim Eastwood void __iomem *base; 5517c50b70SJoachim Eastwood unsigned long rate; 5617c50b70SJoachim Eastwood struct clk *clk; 5717c50b70SJoachim Eastwood }; 5817c50b70SJoachim Eastwood 5917c50b70SJoachim Eastwood static int pl172_timing_prop(struct amba_device *adev, 6017c50b70SJoachim Eastwood const struct device_node *np, const char *name, 6117c50b70SJoachim Eastwood u32 reg_offset, u32 max, int start) 6217c50b70SJoachim Eastwood { 6317c50b70SJoachim Eastwood struct pl172_data *pl172 = amba_get_drvdata(adev); 6417c50b70SJoachim Eastwood int cycles; 6517c50b70SJoachim Eastwood u32 val; 6617c50b70SJoachim Eastwood 6717c50b70SJoachim Eastwood if (!of_property_read_u32(np, name, &val)) { 6817c50b70SJoachim Eastwood cycles = DIV_ROUND_UP(val * pl172->rate, NSEC_PER_MSEC) - start; 6917c50b70SJoachim Eastwood if (cycles < 0) { 7017c50b70SJoachim Eastwood cycles = 0; 7117c50b70SJoachim Eastwood } else if (cycles > max) { 7217c50b70SJoachim Eastwood dev_err(&adev->dev, "%s timing too tight\n", name); 7317c50b70SJoachim Eastwood return -EINVAL; 7417c50b70SJoachim Eastwood } 7517c50b70SJoachim Eastwood 7617c50b70SJoachim Eastwood writel(cycles, pl172->base + reg_offset); 7717c50b70SJoachim Eastwood } 7817c50b70SJoachim Eastwood 7917c50b70SJoachim Eastwood dev_dbg(&adev->dev, "%s: %u cycle(s)\n", name, start + 8017c50b70SJoachim Eastwood readl(pl172->base + reg_offset)); 8117c50b70SJoachim Eastwood 8217c50b70SJoachim Eastwood return 0; 8317c50b70SJoachim Eastwood } 8417c50b70SJoachim Eastwood 8517c50b70SJoachim Eastwood static int pl172_setup_static(struct amba_device *adev, 8617c50b70SJoachim Eastwood struct device_node *np, u32 cs) 8717c50b70SJoachim Eastwood { 8817c50b70SJoachim Eastwood struct pl172_data *pl172 = amba_get_drvdata(adev); 8917c50b70SJoachim Eastwood u32 cfg; 9017c50b70SJoachim Eastwood int ret; 9117c50b70SJoachim Eastwood 9217c50b70SJoachim Eastwood /* MPMC static memory configuration */ 9317c50b70SJoachim Eastwood if (!of_property_read_u32(np, "mpmc,memory-width", &cfg)) { 9417c50b70SJoachim Eastwood if (cfg == 8) { 9517c50b70SJoachim Eastwood cfg = MPMC_STATIC_CFG_MW_8BIT; 9617c50b70SJoachim Eastwood } else if (cfg == 16) { 9717c50b70SJoachim Eastwood cfg = MPMC_STATIC_CFG_MW_16BIT; 9817c50b70SJoachim Eastwood } else if (cfg == 32) { 9917c50b70SJoachim Eastwood cfg = MPMC_STATIC_CFG_MW_32BIT; 10017c50b70SJoachim Eastwood } else { 10117c50b70SJoachim Eastwood dev_err(&adev->dev, "invalid memory width cs%u\n", cs); 10217c50b70SJoachim Eastwood return -EINVAL; 10317c50b70SJoachim Eastwood } 10417c50b70SJoachim Eastwood } else { 10517c50b70SJoachim Eastwood dev_err(&adev->dev, "memory-width property required\n"); 10617c50b70SJoachim Eastwood return -EINVAL; 10717c50b70SJoachim Eastwood } 10817c50b70SJoachim Eastwood 10917c50b70SJoachim Eastwood if (of_property_read_bool(np, "mpmc,async-page-mode")) 11017c50b70SJoachim Eastwood cfg |= MPMC_STATIC_CFG_PM; 11117c50b70SJoachim Eastwood 11217c50b70SJoachim Eastwood if (of_property_read_bool(np, "mpmc,cs-active-high")) 11317c50b70SJoachim Eastwood cfg |= MPMC_STATIC_CFG_PC; 11417c50b70SJoachim Eastwood 11517c50b70SJoachim Eastwood if (of_property_read_bool(np, "mpmc,byte-lane-low")) 11617c50b70SJoachim Eastwood cfg |= MPMC_STATIC_CFG_PB; 11717c50b70SJoachim Eastwood 11817c50b70SJoachim Eastwood if (of_property_read_bool(np, "mpmc,extended-wait")) 11917c50b70SJoachim Eastwood cfg |= MPMC_STATIC_CFG_EW; 12017c50b70SJoachim Eastwood 12117c50b70SJoachim Eastwood if (of_property_read_bool(np, "mpmc,buffer-enable")) 12217c50b70SJoachim Eastwood cfg |= MPMC_STATIC_CFG_B; 12317c50b70SJoachim Eastwood 12417c50b70SJoachim Eastwood if (of_property_read_bool(np, "mpmc,write-protect")) 12517c50b70SJoachim Eastwood cfg |= MPMC_STATIC_CFG_P; 12617c50b70SJoachim Eastwood 12717c50b70SJoachim Eastwood writel(cfg, pl172->base + MPMC_STATIC_CFG(cs)); 12817c50b70SJoachim Eastwood dev_dbg(&adev->dev, "mpmc static config cs%u: 0x%08x\n", cs, cfg); 12917c50b70SJoachim Eastwood 13017c50b70SJoachim Eastwood /* MPMC static memory timing */ 13117c50b70SJoachim Eastwood ret = pl172_timing_prop(adev, np, "mpmc,write-enable-delay", 13217c50b70SJoachim Eastwood MPMC_STATIC_WAIT_WEN(cs), 13317c50b70SJoachim Eastwood MPMC_STATIC_WAIT_WEN_MAX, 1); 13417c50b70SJoachim Eastwood if (ret) 13517c50b70SJoachim Eastwood goto fail; 13617c50b70SJoachim Eastwood 13717c50b70SJoachim Eastwood ret = pl172_timing_prop(adev, np, "mpmc,output-enable-delay", 13817c50b70SJoachim Eastwood MPMC_STATIC_WAIT_OEN(cs), 13917c50b70SJoachim Eastwood MPMC_STATIC_WAIT_OEN_MAX, 0); 14017c50b70SJoachim Eastwood if (ret) 14117c50b70SJoachim Eastwood goto fail; 14217c50b70SJoachim Eastwood 14317c50b70SJoachim Eastwood ret = pl172_timing_prop(adev, np, "mpmc,read-access-delay", 14417c50b70SJoachim Eastwood MPMC_STATIC_WAIT_RD(cs), 14517c50b70SJoachim Eastwood MPMC_STATIC_WAIT_RD_MAX, 1); 14617c50b70SJoachim Eastwood if (ret) 14717c50b70SJoachim Eastwood goto fail; 14817c50b70SJoachim Eastwood 14917c50b70SJoachim Eastwood ret = pl172_timing_prop(adev, np, "mpmc,page-mode-read-delay", 15017c50b70SJoachim Eastwood MPMC_STATIC_WAIT_PAGE(cs), 15117c50b70SJoachim Eastwood MPMC_STATIC_WAIT_PAGE_MAX, 1); 15217c50b70SJoachim Eastwood if (ret) 15317c50b70SJoachim Eastwood goto fail; 15417c50b70SJoachim Eastwood 15517c50b70SJoachim Eastwood ret = pl172_timing_prop(adev, np, "mpmc,write-access-delay", 15617c50b70SJoachim Eastwood MPMC_STATIC_WAIT_WR(cs), 15717c50b70SJoachim Eastwood MPMC_STATIC_WAIT_WR_MAX, 2); 15817c50b70SJoachim Eastwood if (ret) 15917c50b70SJoachim Eastwood goto fail; 16017c50b70SJoachim Eastwood 16117c50b70SJoachim Eastwood ret = pl172_timing_prop(adev, np, "mpmc,turn-round-delay", 16217c50b70SJoachim Eastwood MPMC_STATIC_WAIT_TURN(cs), 16317c50b70SJoachim Eastwood MPMC_STATIC_WAIT_TURN_MAX, 1); 16417c50b70SJoachim Eastwood if (ret) 16517c50b70SJoachim Eastwood goto fail; 16617c50b70SJoachim Eastwood 16717c50b70SJoachim Eastwood return 0; 16817c50b70SJoachim Eastwood fail: 16917c50b70SJoachim Eastwood dev_err(&adev->dev, "failed to configure cs%u\n", cs); 17017c50b70SJoachim Eastwood return ret; 17117c50b70SJoachim Eastwood } 17217c50b70SJoachim Eastwood 17317c50b70SJoachim Eastwood static int pl172_parse_cs_config(struct amba_device *adev, 17417c50b70SJoachim Eastwood struct device_node *np) 17517c50b70SJoachim Eastwood { 17617c50b70SJoachim Eastwood u32 cs; 17717c50b70SJoachim Eastwood 17817c50b70SJoachim Eastwood if (!of_property_read_u32(np, "mpmc,cs", &cs)) { 17917c50b70SJoachim Eastwood if (cs >= PL172_MAX_CS) { 18017c50b70SJoachim Eastwood dev_err(&adev->dev, "cs%u invalid\n", cs); 18117c50b70SJoachim Eastwood return -EINVAL; 18217c50b70SJoachim Eastwood } 18317c50b70SJoachim Eastwood 18417c50b70SJoachim Eastwood return pl172_setup_static(adev, np, cs); 18517c50b70SJoachim Eastwood } 18617c50b70SJoachim Eastwood 18717c50b70SJoachim Eastwood dev_err(&adev->dev, "cs property required\n"); 18817c50b70SJoachim Eastwood 18917c50b70SJoachim Eastwood return -EINVAL; 19017c50b70SJoachim Eastwood } 19117c50b70SJoachim Eastwood 19217c50b70SJoachim Eastwood static const char * const pl172_revisions[] = {"r1", "r2", "r2p3", "r2p4"}; 19317c50b70SJoachim Eastwood 19417c50b70SJoachim Eastwood static int pl172_probe(struct amba_device *adev, const struct amba_id *id) 19517c50b70SJoachim Eastwood { 19617c50b70SJoachim Eastwood struct device_node *child_np, *np = adev->dev.of_node; 19717c50b70SJoachim Eastwood struct device *dev = &adev->dev; 19817c50b70SJoachim Eastwood static const char *rev = "?"; 19917c50b70SJoachim Eastwood struct pl172_data *pl172; 20017c50b70SJoachim Eastwood int ret; 20117c50b70SJoachim Eastwood 20217c50b70SJoachim Eastwood if (amba_part(adev) == 0x172) { 20317c50b70SJoachim Eastwood if (amba_rev(adev) < ARRAY_SIZE(pl172_revisions)) 20417c50b70SJoachim Eastwood rev = pl172_revisions[amba_rev(adev)]; 20517c50b70SJoachim Eastwood } 20617c50b70SJoachim Eastwood 20717c50b70SJoachim Eastwood dev_info(dev, "ARM PL%x revision %s\n", amba_part(adev), rev); 20817c50b70SJoachim Eastwood 20917c50b70SJoachim Eastwood pl172 = devm_kzalloc(dev, sizeof(*pl172), GFP_KERNEL); 21017c50b70SJoachim Eastwood if (!pl172) 21117c50b70SJoachim Eastwood return -ENOMEM; 21217c50b70SJoachim Eastwood 21317c50b70SJoachim Eastwood pl172->clk = devm_clk_get(dev, "mpmcclk"); 21417c50b70SJoachim Eastwood if (IS_ERR(pl172->clk)) { 21517c50b70SJoachim Eastwood dev_err(dev, "no mpmcclk provided clock\n"); 21617c50b70SJoachim Eastwood return PTR_ERR(pl172->clk); 21717c50b70SJoachim Eastwood } 21817c50b70SJoachim Eastwood 21917c50b70SJoachim Eastwood ret = clk_prepare_enable(pl172->clk); 22017c50b70SJoachim Eastwood if (ret) { 22117c50b70SJoachim Eastwood dev_err(dev, "unable to mpmcclk enable clock\n"); 22217c50b70SJoachim Eastwood return ret; 22317c50b70SJoachim Eastwood } 22417c50b70SJoachim Eastwood 22517c50b70SJoachim Eastwood pl172->rate = clk_get_rate(pl172->clk) / MSEC_PER_SEC; 22617c50b70SJoachim Eastwood if (!pl172->rate) { 22717c50b70SJoachim Eastwood dev_err(dev, "unable to get mpmcclk clock rate\n"); 22817c50b70SJoachim Eastwood ret = -EINVAL; 22917c50b70SJoachim Eastwood goto err_clk_enable; 23017c50b70SJoachim Eastwood } 23117c50b70SJoachim Eastwood 23217c50b70SJoachim Eastwood ret = amba_request_regions(adev, NULL); 23317c50b70SJoachim Eastwood if (ret) { 23417c50b70SJoachim Eastwood dev_err(dev, "unable to request AMBA regions\n"); 23517c50b70SJoachim Eastwood goto err_clk_enable; 23617c50b70SJoachim Eastwood } 23717c50b70SJoachim Eastwood 23817c50b70SJoachim Eastwood pl172->base = devm_ioremap(dev, adev->res.start, 23917c50b70SJoachim Eastwood resource_size(&adev->res)); 24017c50b70SJoachim Eastwood if (!pl172->base) { 24117c50b70SJoachim Eastwood dev_err(dev, "ioremap failed\n"); 24217c50b70SJoachim Eastwood ret = -ENOMEM; 24317c50b70SJoachim Eastwood goto err_no_ioremap; 24417c50b70SJoachim Eastwood } 24517c50b70SJoachim Eastwood 24617c50b70SJoachim Eastwood amba_set_drvdata(adev, pl172); 24717c50b70SJoachim Eastwood 24817c50b70SJoachim Eastwood /* 24917c50b70SJoachim Eastwood * Loop through each child node, which represent a chip select, and 25017c50b70SJoachim Eastwood * configure parameters and timing. If successful; populate devices 25117c50b70SJoachim Eastwood * under that node. 25217c50b70SJoachim Eastwood */ 25317c50b70SJoachim Eastwood for_each_available_child_of_node(np, child_np) { 25417c50b70SJoachim Eastwood ret = pl172_parse_cs_config(adev, child_np); 25517c50b70SJoachim Eastwood if (ret) 25617c50b70SJoachim Eastwood continue; 25717c50b70SJoachim Eastwood 2580ff818efSJoachim Eastwood of_platform_populate(child_np, NULL, NULL, dev); 25917c50b70SJoachim Eastwood } 26017c50b70SJoachim Eastwood 26117c50b70SJoachim Eastwood return 0; 26217c50b70SJoachim Eastwood 26317c50b70SJoachim Eastwood err_no_ioremap: 26417c50b70SJoachim Eastwood amba_release_regions(adev); 26517c50b70SJoachim Eastwood err_clk_enable: 26617c50b70SJoachim Eastwood clk_disable_unprepare(pl172->clk); 26717c50b70SJoachim Eastwood return ret; 26817c50b70SJoachim Eastwood } 26917c50b70SJoachim Eastwood 27017c50b70SJoachim Eastwood static int pl172_remove(struct amba_device *adev) 27117c50b70SJoachim Eastwood { 27217c50b70SJoachim Eastwood struct pl172_data *pl172 = amba_get_drvdata(adev); 27317c50b70SJoachim Eastwood 27417c50b70SJoachim Eastwood clk_disable_unprepare(pl172->clk); 27517c50b70SJoachim Eastwood amba_release_regions(adev); 27617c50b70SJoachim Eastwood 27717c50b70SJoachim Eastwood return 0; 27817c50b70SJoachim Eastwood } 27917c50b70SJoachim Eastwood 28017c50b70SJoachim Eastwood static const struct amba_id pl172_ids[] = { 28117c50b70SJoachim Eastwood { 28217c50b70SJoachim Eastwood .id = 0x07341172, 28317c50b70SJoachim Eastwood .mask = 0xffffffff, 28417c50b70SJoachim Eastwood }, 28517c50b70SJoachim Eastwood { 0, 0 }, 28617c50b70SJoachim Eastwood }; 28717c50b70SJoachim Eastwood MODULE_DEVICE_TABLE(amba, pl172_ids); 28817c50b70SJoachim Eastwood 28917c50b70SJoachim Eastwood static struct amba_driver pl172_driver = { 29017c50b70SJoachim Eastwood .drv = { 29117c50b70SJoachim Eastwood .name = "memory-pl172", 29217c50b70SJoachim Eastwood }, 29317c50b70SJoachim Eastwood .probe = pl172_probe, 29417c50b70SJoachim Eastwood .remove = pl172_remove, 29517c50b70SJoachim Eastwood .id_table = pl172_ids, 29617c50b70SJoachim Eastwood }; 29717c50b70SJoachim Eastwood module_amba_driver(pl172_driver); 29817c50b70SJoachim Eastwood 29917c50b70SJoachim Eastwood MODULE_AUTHOR("Joachim Eastwood <manabian@gmail.com>"); 30017c50b70SJoachim Eastwood MODULE_DESCRIPTION("PL172 Memory Controller Driver"); 30117c50b70SJoachim Eastwood MODULE_LICENSE("GPL v2"); 302