brintos

brintos / linux-shallow public Read only

0
0
Text · 3.7 KiB · 39ee2b4 Raw
153 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * Copyright 2016 Broadcom Limited4 */5 6#include <linux/device.h>7#include <linux/io.h>8#include <linux/ioport.h>9#include <linux/module.h>10#include <linux/of.h>11#include <linux/of_address.h>12#include <linux/platform_device.h>13#include <linux/slab.h>14 15#include "spi-bcm-qspi.h"16 17#define INTR_BASE_BIT_SHIFT			0x0218#define INTR_COUNT				0x0719 20struct bcm_iproc_intc {21	struct bcm_qspi_soc_intc soc_intc;22	struct platform_device *pdev;23	void __iomem *int_reg;24	void __iomem *int_status_reg;25	spinlock_t soclock;26	bool big_endian;27};28 29static u32 bcm_iproc_qspi_get_l2_int_status(struct bcm_qspi_soc_intc *soc_intc)30{31	struct bcm_iproc_intc *priv =32			container_of(soc_intc, struct bcm_iproc_intc, soc_intc);33	void __iomem *mmio = priv->int_status_reg;34	int i;35	u32 val = 0, sts = 0;36 37	for (i = 0; i < INTR_COUNT; i++) {38		if (bcm_qspi_readl(priv->big_endian, mmio + (i * 4)))39			val |= 1UL << i;40	}41 42	if (val & INTR_MSPI_DONE_MASK)43		sts |= MSPI_DONE;44 45	if (val & BSPI_LR_INTERRUPTS_ALL)46		sts |= BSPI_DONE;47 48	if (val & BSPI_LR_INTERRUPTS_ERROR)49		sts |= BSPI_ERR;50 51	return sts;52}53 54static void bcm_iproc_qspi_int_ack(struct bcm_qspi_soc_intc *soc_intc, int type)55{56	struct bcm_iproc_intc *priv =57			container_of(soc_intc, struct bcm_iproc_intc, soc_intc);58	void __iomem *mmio = priv->int_status_reg;59	u32 mask = get_qspi_mask(type);60	int i;61 62	for (i = 0; i < INTR_COUNT; i++) {63		if (mask & (1UL << i))64			bcm_qspi_writel(priv->big_endian, 1, mmio + (i * 4));65	}66}67 68static void bcm_iproc_qspi_int_set(struct bcm_qspi_soc_intc *soc_intc, int type,69				   bool en)70{71	struct bcm_iproc_intc *priv =72			container_of(soc_intc, struct bcm_iproc_intc, soc_intc);73	void __iomem *mmio = priv->int_reg;74	u32 mask = get_qspi_mask(type);75	u32 val;76	unsigned long flags;77 78	spin_lock_irqsave(&priv->soclock, flags);79 80	val = bcm_qspi_readl(priv->big_endian, mmio);81 82	if (en)83		val = val | (mask << INTR_BASE_BIT_SHIFT);84	else85		val = val & ~(mask << INTR_BASE_BIT_SHIFT);86 87	bcm_qspi_writel(priv->big_endian, val, mmio);88 89	spin_unlock_irqrestore(&priv->soclock, flags);90}91 92static int bcm_iproc_probe(struct platform_device *pdev)93{94	struct device *dev = &pdev->dev;95	struct bcm_iproc_intc *priv;96	struct bcm_qspi_soc_intc *soc_intc;97 98	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);99	if (!priv)100		return -ENOMEM;101	soc_intc = &priv->soc_intc;102	priv->pdev = pdev;103 104	spin_lock_init(&priv->soclock);105 106	priv->int_reg = devm_platform_ioremap_resource_byname(pdev, "intr_regs");107	if (IS_ERR(priv->int_reg))108		return PTR_ERR(priv->int_reg);109 110	priv->int_status_reg = devm_platform_ioremap_resource_byname(pdev,111								     "intr_status_reg");112	if (IS_ERR(priv->int_status_reg))113		return PTR_ERR(priv->int_status_reg);114 115	priv->big_endian = of_device_is_big_endian(dev->of_node);116 117	bcm_iproc_qspi_int_ack(soc_intc, MSPI_BSPI_DONE);118	bcm_iproc_qspi_int_set(soc_intc, MSPI_BSPI_DONE, false);119 120	soc_intc->bcm_qspi_int_ack = bcm_iproc_qspi_int_ack;121	soc_intc->bcm_qspi_int_set = bcm_iproc_qspi_int_set;122	soc_intc->bcm_qspi_get_int_status = bcm_iproc_qspi_get_l2_int_status;123 124	return bcm_qspi_probe(pdev, soc_intc);125}126 127static void bcm_iproc_remove(struct platform_device *pdev)128{129	bcm_qspi_remove(pdev);130}131 132static const struct of_device_id bcm_iproc_of_match[] = {133	{ .compatible = "brcm,spi-nsp-qspi" },134	{ .compatible = "brcm,spi-ns2-qspi" },135	{},136};137MODULE_DEVICE_TABLE(of, bcm_iproc_of_match);138 139static struct platform_driver bcm_iproc_driver = {140	.probe			= bcm_iproc_probe,141	.remove_new		= bcm_iproc_remove,142	.driver = {143		.name		= "bcm_iproc",144		.pm		= &bcm_qspi_pm_ops,145		.of_match_table = bcm_iproc_of_match,146	}147};148module_platform_driver(bcm_iproc_driver);149 150MODULE_LICENSE("GPL v2");151MODULE_AUTHOR("Kamal Dasu");152MODULE_DESCRIPTION("SPI flash driver for Broadcom iProc SoCs");153