|
@@ -0,0 +1,185 @@
|
|
|
+// SPDX-License-Identifier: GPL-2.0+
|
|
|
+/*
|
|
|
+ * Copyright (C) 2018 BayLibre, SAS
|
|
|
+ * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
|
|
|
+ * Copyright (C) 2014 Endless Mobile
|
|
|
+ */
|
|
|
+
|
|
|
+#include <linux/kernel.h>
|
|
|
+#include <linux/mfd/syscon.h>
|
|
|
+#include <linux/module.h>
|
|
|
+#include <linux/regmap.h>
|
|
|
+#include <linux/soc/amlogic/meson-canvas.h>
|
|
|
+#include <linux/of_address.h>
|
|
|
+#include <linux/of_platform.h>
|
|
|
+#include <linux/io.h>
|
|
|
+
|
|
|
+#define NUM_CANVAS 256
|
|
|
+
|
|
|
+/* DMC Registers */
|
|
|
+#define DMC_CAV_LUT_DATAL 0x00
|
|
|
+ #define CANVAS_WIDTH_LBIT 29
|
|
|
+ #define CANVAS_WIDTH_LWID 3
|
|
|
+#define DMC_CAV_LUT_DATAH 0x04
|
|
|
+ #define CANVAS_WIDTH_HBIT 0
|
|
|
+ #define CANVAS_HEIGHT_BIT 9
|
|
|
+ #define CANVAS_WRAP_BIT 22
|
|
|
+ #define CANVAS_BLKMODE_BIT 24
|
|
|
+ #define CANVAS_ENDIAN_BIT 26
|
|
|
+#define DMC_CAV_LUT_ADDR 0x08
|
|
|
+ #define CANVAS_LUT_WR_EN BIT(9)
|
|
|
+ #define CANVAS_LUT_RD_EN BIT(8)
|
|
|
+
|
|
|
+struct meson_canvas {
|
|
|
+ struct device *dev;
|
|
|
+ void __iomem *reg_base;
|
|
|
+ spinlock_t lock; /* canvas device lock */
|
|
|
+ u8 used[NUM_CANVAS];
|
|
|
+};
|
|
|
+
|
|
|
+static void canvas_write(struct meson_canvas *canvas, u32 reg, u32 val)
|
|
|
+{
|
|
|
+ writel_relaxed(val, canvas->reg_base + reg);
|
|
|
+}
|
|
|
+
|
|
|
+static u32 canvas_read(struct meson_canvas *canvas, u32 reg)
|
|
|
+{
|
|
|
+ return readl_relaxed(canvas->reg_base + reg);
|
|
|
+}
|
|
|
+
|
|
|
+struct meson_canvas *meson_canvas_get(struct device *dev)
|
|
|
+{
|
|
|
+ struct device_node *canvas_node;
|
|
|
+ struct platform_device *canvas_pdev;
|
|
|
+
|
|
|
+ canvas_node = of_parse_phandle(dev->of_node, "amlogic,canvas", 0);
|
|
|
+ if (!canvas_node)
|
|
|
+ return ERR_PTR(-ENODEV);
|
|
|
+
|
|
|
+ canvas_pdev = of_find_device_by_node(canvas_node);
|
|
|
+ if (!canvas_pdev)
|
|
|
+ return ERR_PTR(-EPROBE_DEFER);
|
|
|
+
|
|
|
+ return dev_get_drvdata(&canvas_pdev->dev);
|
|
|
+}
|
|
|
+EXPORT_SYMBOL_GPL(meson_canvas_get);
|
|
|
+
|
|
|
+int meson_canvas_config(struct meson_canvas *canvas, u8 canvas_index,
|
|
|
+ u32 addr, u32 stride, u32 height,
|
|
|
+ unsigned int wrap,
|
|
|
+ unsigned int blkmode,
|
|
|
+ unsigned int endian)
|
|
|
+{
|
|
|
+ unsigned long flags;
|
|
|
+
|
|
|
+ spin_lock_irqsave(&canvas->lock, flags);
|
|
|
+ if (!canvas->used[canvas_index]) {
|
|
|
+ dev_err(canvas->dev,
|
|
|
+ "Trying to setup non allocated canvas %u\n",
|
|
|
+ canvas_index);
|
|
|
+ spin_unlock_irqrestore(&canvas->lock, flags);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ canvas_write(canvas, DMC_CAV_LUT_DATAL,
|
|
|
+ ((addr + 7) >> 3) |
|
|
|
+ (((stride + 7) >> 3) << CANVAS_WIDTH_LBIT));
|
|
|
+
|
|
|
+ canvas_write(canvas, DMC_CAV_LUT_DATAH,
|
|
|
+ ((((stride + 7) >> 3) >> CANVAS_WIDTH_LWID) <<
|
|
|
+ CANVAS_WIDTH_HBIT) |
|
|
|
+ (height << CANVAS_HEIGHT_BIT) |
|
|
|
+ (wrap << CANVAS_WRAP_BIT) |
|
|
|
+ (blkmode << CANVAS_BLKMODE_BIT) |
|
|
|
+ (endian << CANVAS_ENDIAN_BIT));
|
|
|
+
|
|
|
+ canvas_write(canvas, DMC_CAV_LUT_ADDR,
|
|
|
+ CANVAS_LUT_WR_EN | canvas_index);
|
|
|
+
|
|
|
+ /* Force a read-back to make sure everything is flushed. */
|
|
|
+ canvas_read(canvas, DMC_CAV_LUT_DATAH);
|
|
|
+ spin_unlock_irqrestore(&canvas->lock, flags);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL_GPL(meson_canvas_config);
|
|
|
+
|
|
|
+int meson_canvas_alloc(struct meson_canvas *canvas, u8 *canvas_index)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ unsigned long flags;
|
|
|
+
|
|
|
+ spin_lock_irqsave(&canvas->lock, flags);
|
|
|
+ for (i = 0; i < NUM_CANVAS; ++i) {
|
|
|
+ if (!canvas->used[i]) {
|
|
|
+ canvas->used[i] = 1;
|
|
|
+ spin_unlock_irqrestore(&canvas->lock, flags);
|
|
|
+ *canvas_index = i;
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ spin_unlock_irqrestore(&canvas->lock, flags);
|
|
|
+
|
|
|
+ dev_err(canvas->dev, "No more canvas available\n");
|
|
|
+ return -ENODEV;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL_GPL(meson_canvas_alloc);
|
|
|
+
|
|
|
+int meson_canvas_free(struct meson_canvas *canvas, u8 canvas_index)
|
|
|
+{
|
|
|
+ unsigned long flags;
|
|
|
+
|
|
|
+ spin_lock_irqsave(&canvas->lock, flags);
|
|
|
+ if (!canvas->used[canvas_index]) {
|
|
|
+ dev_err(canvas->dev,
|
|
|
+ "Trying to free unused canvas %u\n", canvas_index);
|
|
|
+ spin_unlock_irqrestore(&canvas->lock, flags);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+ canvas->used[canvas_index] = 0;
|
|
|
+ spin_unlock_irqrestore(&canvas->lock, flags);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL_GPL(meson_canvas_free);
|
|
|
+
|
|
|
+static int meson_canvas_probe(struct platform_device *pdev)
|
|
|
+{
|
|
|
+ struct resource *res;
|
|
|
+ struct meson_canvas *canvas;
|
|
|
+ struct device *dev = &pdev->dev;
|
|
|
+
|
|
|
+ canvas = devm_kzalloc(dev, sizeof(*canvas), GFP_KERNEL);
|
|
|
+ if (!canvas)
|
|
|
+ return -ENOMEM;
|
|
|
+
|
|
|
+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
+ canvas->reg_base = devm_ioremap_resource(dev, res);
|
|
|
+ if (IS_ERR(canvas->reg_base))
|
|
|
+ return PTR_ERR(canvas->reg_base);
|
|
|
+
|
|
|
+ canvas->dev = dev;
|
|
|
+ spin_lock_init(&canvas->lock);
|
|
|
+ dev_set_drvdata(dev, canvas);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static const struct of_device_id canvas_dt_match[] = {
|
|
|
+ { .compatible = "amlogic,canvas" },
|
|
|
+ {}
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(of, canvas_dt_match);
|
|
|
+
|
|
|
+static struct platform_driver meson_canvas_driver = {
|
|
|
+ .probe = meson_canvas_probe,
|
|
|
+ .driver = {
|
|
|
+ .name = "amlogic-canvas",
|
|
|
+ .of_match_table = canvas_dt_match,
|
|
|
+ },
|
|
|
+};
|
|
|
+module_platform_driver(meson_canvas_driver);
|
|
|
+
|
|
|
+MODULE_DESCRIPTION("Amlogic Canvas driver");
|
|
|
+MODULE_AUTHOR("Maxime Jourdan <mjourdan@baylibre.com>");
|
|
|
+MODULE_LICENSE("GPL");
|