| /* | |
| * Copyright 2011 Freescale Semiconductor, Inc | |
| * | |
| * Freescale Integrated Flash Controller | |
| * | |
| * Author: Dipen Dudhat <Dipen.Dudhat@freescale.com> | |
| * | |
| * This program is free software; you can redistribute it and/or modify it | |
| * under the terms of the GNU General Public License as published by the | |
| * Free Software Foundation; either version 2 of the License, or (at your | |
| * option) any later version. | |
| * | |
| * 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. | |
| * | |
| * You should have received a copy of the GNU General Public License | |
| * along with this program; if not, write to the Free Software | |
| * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
| */ | |
| #include <linux/module.h> | |
| #include <linux/kernel.h> | |
| #include <linux/compiler.h> | |
| #include <linux/sched.h> | |
| #include <linux/spinlock.h> | |
| #include <linux/types.h> | |
| #include <linux/slab.h> | |
| #include <linux/io.h> | |
| #include <linux/of.h> | |
| #include <linux/of_device.h> | |
| #include <linux/platform_device.h> | |
| #include <linux/fsl_ifc.h> | |
| #include <linux/irqdomain.h> | |
| #include <linux/of_address.h> | |
| #include <linux/of_irq.h> | |
| struct fsl_ifc_ctrl *fsl_ifc_ctrl_dev; | |
| EXPORT_SYMBOL(fsl_ifc_ctrl_dev); | |
| /* | |
| * convert_ifc_address - convert the base address | |
| * @addr_base: base address of the memory bank | |
| */ | |
| unsigned int convert_ifc_address(phys_addr_t addr_base) | |
| { | |
| return addr_base & CSPR_BA; | |
| } | |
| EXPORT_SYMBOL(convert_ifc_address); | |
| /* | |
| * fsl_ifc_find - find IFC bank | |
| * @addr_base: base address of the memory bank | |
| * | |
| * This function walks IFC banks comparing "Base address" field of the CSPR | |
| * registers with the supplied addr_base argument. When bases match this | |
| * function returns bank number (starting with 0), otherwise it returns | |
| * appropriate errno value. | |
| */ | |
| int fsl_ifc_find(phys_addr_t addr_base) | |
| { | |
| int i = 0; | |
| if (!fsl_ifc_ctrl_dev || !fsl_ifc_ctrl_dev->gregs) | |
| return -ENODEV; | |
| for (i = 0; i < fsl_ifc_ctrl_dev->banks; i++) { | |
| u32 cspr = ifc_in32(&fsl_ifc_ctrl_dev->gregs->cspr_cs[i].cspr); | |
| if (cspr & CSPR_V && (cspr & CSPR_BA) == | |
| convert_ifc_address(addr_base)) | |
| return i; | |
| } | |
| return -ENOENT; | |
| } | |
| EXPORT_SYMBOL(fsl_ifc_find); | |
| static int fsl_ifc_ctrl_init(struct fsl_ifc_ctrl *ctrl) | |
| { | |
| struct fsl_ifc_global __iomem *ifc = ctrl->gregs; | |
| /* | |
| * Clear all the common status and event registers | |
| */ | |
| if (ifc_in32(&ifc->cm_evter_stat) & IFC_CM_EVTER_STAT_CSER) | |
| ifc_out32(IFC_CM_EVTER_STAT_CSER, &ifc->cm_evter_stat); | |
| /* enable all error and events */ | |
| ifc_out32(IFC_CM_EVTER_EN_CSEREN, &ifc->cm_evter_en); | |
| /* enable all error and event interrupts */ | |
| ifc_out32(IFC_CM_EVTER_INTR_EN_CSERIREN, &ifc->cm_evter_intr_en); | |
| ifc_out32(0x0, &ifc->cm_erattr0); | |
| ifc_out32(0x0, &ifc->cm_erattr1); | |
| return 0; | |
| } | |
| static int fsl_ifc_ctrl_remove(struct platform_device *dev) | |
| { | |
| struct fsl_ifc_ctrl *ctrl = dev_get_drvdata(&dev->dev); | |
| free_irq(ctrl->nand_irq, ctrl); | |
| free_irq(ctrl->irq, ctrl); | |
| irq_dispose_mapping(ctrl->nand_irq); | |
| irq_dispose_mapping(ctrl->irq); | |
| iounmap(ctrl->gregs); | |
| dev_set_drvdata(&dev->dev, NULL); | |
| kfree(ctrl); | |
| return 0; | |
| } | |
| /* | |
| * NAND events are split between an operational interrupt which only | |
| * receives OPC, and an error interrupt that receives everything else, | |
| * including non-NAND errors. Whichever interrupt gets to it first | |
| * records the status and wakes the wait queue. | |
| */ | |
| static DEFINE_SPINLOCK(nand_irq_lock); | |
| static u32 check_nand_stat(struct fsl_ifc_ctrl *ctrl) | |
| { | |
| struct fsl_ifc_runtime __iomem *ifc = ctrl->rregs; | |
| unsigned long flags; | |
| u32 stat; | |
| spin_lock_irqsave(&nand_irq_lock, flags); | |
| stat = ifc_in32(&ifc->ifc_nand.nand_evter_stat); | |
| if (stat) { | |
| ifc_out32(stat, &ifc->ifc_nand.nand_evter_stat); | |
| ctrl->nand_stat = stat; | |
| wake_up(&ctrl->nand_wait); | |
| } | |
| spin_unlock_irqrestore(&nand_irq_lock, flags); | |
| return stat; | |
| } | |
| static irqreturn_t fsl_ifc_nand_irq(int irqno, void *data) | |
| { | |
| struct fsl_ifc_ctrl *ctrl = data; | |
| if (check_nand_stat(ctrl)) | |
| return IRQ_HANDLED; | |
| return IRQ_NONE; | |
| } | |
| /* | |
| * NOTE: This interrupt is used to report ifc events of various kinds, | |
| * such as transaction errors on the chipselects. | |
| */ | |
| static irqreturn_t fsl_ifc_ctrl_irq(int irqno, void *data) | |
| { | |
| struct fsl_ifc_ctrl *ctrl = data; | |
| struct fsl_ifc_global __iomem *ifc = ctrl->gregs; | |
| u32 err_axiid, err_srcid, status, cs_err, err_addr; | |
| irqreturn_t ret = IRQ_NONE; | |
| /* read for chip select error */ | |
| cs_err = ifc_in32(&ifc->cm_evter_stat); | |
| if (cs_err) { | |
| dev_err(ctrl->dev, "transaction sent to IFC is not mapped to" | |
| "any memory bank 0x%08X\n", cs_err); | |
| /* clear the chip select error */ | |
| ifc_out32(IFC_CM_EVTER_STAT_CSER, &ifc->cm_evter_stat); | |
| /* read error attribute registers print the error information */ | |
| status = ifc_in32(&ifc->cm_erattr0); | |
| err_addr = ifc_in32(&ifc->cm_erattr1); | |
| if (status & IFC_CM_ERATTR0_ERTYP_READ) | |
| dev_err(ctrl->dev, "Read transaction error" | |
| "CM_ERATTR0 0x%08X\n", status); | |
| else | |
| dev_err(ctrl->dev, "Write transaction error" | |
| "CM_ERATTR0 0x%08X\n", status); | |
| err_axiid = (status & IFC_CM_ERATTR0_ERAID) >> | |
| IFC_CM_ERATTR0_ERAID_SHIFT; | |
| dev_err(ctrl->dev, "AXI ID of the error" | |
| "transaction 0x%08X\n", err_axiid); | |
| err_srcid = (status & IFC_CM_ERATTR0_ESRCID) >> | |
| IFC_CM_ERATTR0_ESRCID_SHIFT; | |
| dev_err(ctrl->dev, "SRC ID of the error" | |
| "transaction 0x%08X\n", err_srcid); | |
| dev_err(ctrl->dev, "Transaction Address corresponding to error" | |
| "ERADDR 0x%08X\n", err_addr); | |
| ret = IRQ_HANDLED; | |
| } | |
| if (check_nand_stat(ctrl)) | |
| ret = IRQ_HANDLED; | |
| return ret; | |
| } | |
| /* | |
| * fsl_ifc_ctrl_probe | |
| * | |
| * called by device layer when it finds a device matching | |
| * one our driver can handled. This code allocates all of | |
| * the resources needed for the controller only. The | |
| * resources for the NAND banks themselves are allocated | |
| * in the chip probe function. | |
| */ | |
| static int fsl_ifc_ctrl_probe(struct platform_device *dev) | |
| { | |
| int ret = 0; | |
| int version, banks; | |
| void __iomem *addr; | |
| dev_info(&dev->dev, "Freescale Integrated Flash Controller\n"); | |
| fsl_ifc_ctrl_dev = kzalloc(sizeof(*fsl_ifc_ctrl_dev), GFP_KERNEL); | |
| if (!fsl_ifc_ctrl_dev) | |
| return -ENOMEM; | |
| dev_set_drvdata(&dev->dev, fsl_ifc_ctrl_dev); | |
| /* IOMAP the entire IFC region */ | |
| fsl_ifc_ctrl_dev->gregs = of_iomap(dev->dev.of_node, 0); | |
| if (!fsl_ifc_ctrl_dev->gregs) { | |
| dev_err(&dev->dev, "failed to get memory region\n"); | |
| ret = -ENODEV; | |
| goto err; | |
| } | |
| if (of_property_read_bool(dev->dev.of_node, "little-endian")) { | |
| fsl_ifc_ctrl_dev->little_endian = true; | |
| dev_dbg(&dev->dev, "IFC REGISTERS are LITTLE endian\n"); | |
| } else { | |
| fsl_ifc_ctrl_dev->little_endian = false; | |
| dev_dbg(&dev->dev, "IFC REGISTERS are BIG endian\n"); | |
| } | |
| version = ifc_in32(&fsl_ifc_ctrl_dev->gregs->ifc_rev) & | |
| FSL_IFC_VERSION_MASK; | |
| banks = (version == FSL_IFC_VERSION_1_0_0) ? 4 : 8; | |
| dev_info(&dev->dev, "IFC version %d.%d, %d banks\n", | |
| version >> 24, (version >> 16) & 0xf, banks); | |
| fsl_ifc_ctrl_dev->version = version; | |
| fsl_ifc_ctrl_dev->banks = banks; | |
| addr = fsl_ifc_ctrl_dev->gregs; | |
| if (version >= FSL_IFC_VERSION_2_0_0) | |
| addr += PGOFFSET_64K; | |
| else | |
| addr += PGOFFSET_4K; | |
| fsl_ifc_ctrl_dev->rregs = addr; | |
| /* get the Controller level irq */ | |
| fsl_ifc_ctrl_dev->irq = irq_of_parse_and_map(dev->dev.of_node, 0); | |
| if (fsl_ifc_ctrl_dev->irq == 0) { | |
| dev_err(&dev->dev, "failed to get irq resource " | |
| "for IFC\n"); | |
| ret = -ENODEV; | |
| goto err; | |
| } | |
| /* get the nand machine irq */ | |
| fsl_ifc_ctrl_dev->nand_irq = | |
| irq_of_parse_and_map(dev->dev.of_node, 1); | |
| fsl_ifc_ctrl_dev->dev = &dev->dev; | |
| ret = fsl_ifc_ctrl_init(fsl_ifc_ctrl_dev); | |
| if (ret < 0) | |
| goto err; | |
| init_waitqueue_head(&fsl_ifc_ctrl_dev->nand_wait); | |
| ret = request_irq(fsl_ifc_ctrl_dev->irq, fsl_ifc_ctrl_irq, IRQF_SHARED, | |
| "fsl-ifc", fsl_ifc_ctrl_dev); | |
| if (ret != 0) { | |
| dev_err(&dev->dev, "failed to install irq (%d)\n", | |
| fsl_ifc_ctrl_dev->irq); | |
| goto err_irq; | |
| } | |
| if (fsl_ifc_ctrl_dev->nand_irq) { | |
| ret = request_irq(fsl_ifc_ctrl_dev->nand_irq, fsl_ifc_nand_irq, | |
| 0, "fsl-ifc-nand", fsl_ifc_ctrl_dev); | |
| if (ret != 0) { | |
| dev_err(&dev->dev, "failed to install irq (%d)\n", | |
| fsl_ifc_ctrl_dev->nand_irq); | |
| goto err_nandirq; | |
| } | |
| } | |
| return 0; | |
| err_nandirq: | |
| free_irq(fsl_ifc_ctrl_dev->nand_irq, fsl_ifc_ctrl_dev); | |
| irq_dispose_mapping(fsl_ifc_ctrl_dev->nand_irq); | |
| err_irq: | |
| free_irq(fsl_ifc_ctrl_dev->irq, fsl_ifc_ctrl_dev); | |
| irq_dispose_mapping(fsl_ifc_ctrl_dev->irq); | |
| err: | |
| return ret; | |
| } | |
| static const struct of_device_id fsl_ifc_match[] = { | |
| { | |
| .compatible = "fsl,ifc", | |
| }, | |
| {}, | |
| }; | |
| static struct platform_driver fsl_ifc_ctrl_driver = { | |
| .driver = { | |
| .name = "fsl-ifc", | |
| .of_match_table = fsl_ifc_match, | |
| }, | |
| .probe = fsl_ifc_ctrl_probe, | |
| .remove = fsl_ifc_ctrl_remove, | |
| }; | |
| static int __init fsl_ifc_init(void) | |
| { | |
| return platform_driver_register(&fsl_ifc_ctrl_driver); | |
| } | |
| subsys_initcall(fsl_ifc_init); | |
| MODULE_LICENSE("GPL"); | |
| MODULE_AUTHOR("Freescale Semiconductor"); | |
| MODULE_DESCRIPTION("Freescale Integrated Flash Controller driver"); |