1*c942fddfSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
22d2ead45SSteve Longerbeam /*
32d2ead45SSteve Longerbeam * Copyright (C) 2012-2016 Mentor Graphics Inc.
42d2ead45SSteve Longerbeam * Copyright (C) 2005-2009 Freescale Semiconductor, Inc.
52d2ead45SSteve Longerbeam */
62d2ead45SSteve Longerbeam #include <linux/io.h>
72d2ead45SSteve Longerbeam #include "ipu-prv.h"
82d2ead45SSteve Longerbeam
92d2ead45SSteve Longerbeam struct ipu_vdi {
102d2ead45SSteve Longerbeam void __iomem *base;
112d2ead45SSteve Longerbeam u32 module;
122d2ead45SSteve Longerbeam spinlock_t lock;
132d2ead45SSteve Longerbeam int use_count;
142d2ead45SSteve Longerbeam struct ipu_soc *ipu;
152d2ead45SSteve Longerbeam };
162d2ead45SSteve Longerbeam
172d2ead45SSteve Longerbeam
182d2ead45SSteve Longerbeam /* VDI Register Offsets */
192d2ead45SSteve Longerbeam #define VDI_FSIZE 0x0000
202d2ead45SSteve Longerbeam #define VDI_C 0x0004
212d2ead45SSteve Longerbeam
222d2ead45SSteve Longerbeam /* VDI Register Fields */
232d2ead45SSteve Longerbeam #define VDI_C_CH_420 (0 << 1)
242d2ead45SSteve Longerbeam #define VDI_C_CH_422 (1 << 1)
252d2ead45SSteve Longerbeam #define VDI_C_MOT_SEL_MASK (0x3 << 2)
262d2ead45SSteve Longerbeam #define VDI_C_MOT_SEL_FULL (2 << 2)
272d2ead45SSteve Longerbeam #define VDI_C_MOT_SEL_LOW (1 << 2)
282d2ead45SSteve Longerbeam #define VDI_C_MOT_SEL_MED (0 << 2)
292d2ead45SSteve Longerbeam #define VDI_C_BURST_SIZE1_4 (3 << 4)
302d2ead45SSteve Longerbeam #define VDI_C_BURST_SIZE2_4 (3 << 8)
312d2ead45SSteve Longerbeam #define VDI_C_BURST_SIZE3_4 (3 << 12)
322d2ead45SSteve Longerbeam #define VDI_C_BURST_SIZE_MASK 0xF
332d2ead45SSteve Longerbeam #define VDI_C_BURST_SIZE1_OFFSET 4
342d2ead45SSteve Longerbeam #define VDI_C_BURST_SIZE2_OFFSET 8
352d2ead45SSteve Longerbeam #define VDI_C_BURST_SIZE3_OFFSET 12
362d2ead45SSteve Longerbeam #define VDI_C_VWM1_SET_1 (0 << 16)
372d2ead45SSteve Longerbeam #define VDI_C_VWM1_SET_2 (1 << 16)
382d2ead45SSteve Longerbeam #define VDI_C_VWM1_CLR_2 (1 << 19)
392d2ead45SSteve Longerbeam #define VDI_C_VWM3_SET_1 (0 << 22)
402d2ead45SSteve Longerbeam #define VDI_C_VWM3_SET_2 (1 << 22)
412d2ead45SSteve Longerbeam #define VDI_C_VWM3_CLR_2 (1 << 25)
422d2ead45SSteve Longerbeam #define VDI_C_TOP_FIELD_MAN_1 (1 << 30)
432d2ead45SSteve Longerbeam #define VDI_C_TOP_FIELD_AUTO_1 (1 << 31)
442d2ead45SSteve Longerbeam
ipu_vdi_read(struct ipu_vdi * vdi,unsigned int offset)452d2ead45SSteve Longerbeam static inline u32 ipu_vdi_read(struct ipu_vdi *vdi, unsigned int offset)
462d2ead45SSteve Longerbeam {
472d2ead45SSteve Longerbeam return readl(vdi->base + offset);
482d2ead45SSteve Longerbeam }
492d2ead45SSteve Longerbeam
ipu_vdi_write(struct ipu_vdi * vdi,u32 value,unsigned int offset)502d2ead45SSteve Longerbeam static inline void ipu_vdi_write(struct ipu_vdi *vdi, u32 value,
512d2ead45SSteve Longerbeam unsigned int offset)
522d2ead45SSteve Longerbeam {
532d2ead45SSteve Longerbeam writel(value, vdi->base + offset);
542d2ead45SSteve Longerbeam }
552d2ead45SSteve Longerbeam
ipu_vdi_set_field_order(struct ipu_vdi * vdi,v4l2_std_id std,u32 field)562d2ead45SSteve Longerbeam void ipu_vdi_set_field_order(struct ipu_vdi *vdi, v4l2_std_id std, u32 field)
572d2ead45SSteve Longerbeam {
582d2ead45SSteve Longerbeam bool top_field_0 = false;
592d2ead45SSteve Longerbeam unsigned long flags;
602d2ead45SSteve Longerbeam u32 reg;
612d2ead45SSteve Longerbeam
622d2ead45SSteve Longerbeam switch (field) {
632d2ead45SSteve Longerbeam case V4L2_FIELD_INTERLACED_TB:
642d2ead45SSteve Longerbeam case V4L2_FIELD_SEQ_TB:
652d2ead45SSteve Longerbeam case V4L2_FIELD_TOP:
662d2ead45SSteve Longerbeam top_field_0 = true;
672d2ead45SSteve Longerbeam break;
682d2ead45SSteve Longerbeam case V4L2_FIELD_INTERLACED_BT:
692d2ead45SSteve Longerbeam case V4L2_FIELD_SEQ_BT:
702d2ead45SSteve Longerbeam case V4L2_FIELD_BOTTOM:
712d2ead45SSteve Longerbeam top_field_0 = false;
722d2ead45SSteve Longerbeam break;
732d2ead45SSteve Longerbeam default:
742d2ead45SSteve Longerbeam top_field_0 = (std & V4L2_STD_525_60) ? true : false;
752d2ead45SSteve Longerbeam break;
762d2ead45SSteve Longerbeam }
772d2ead45SSteve Longerbeam
782d2ead45SSteve Longerbeam spin_lock_irqsave(&vdi->lock, flags);
792d2ead45SSteve Longerbeam
802d2ead45SSteve Longerbeam reg = ipu_vdi_read(vdi, VDI_C);
812d2ead45SSteve Longerbeam if (top_field_0)
82add13187SSteve Longerbeam reg &= ~(VDI_C_TOP_FIELD_MAN_1 | VDI_C_TOP_FIELD_AUTO_1);
832d2ead45SSteve Longerbeam else
84add13187SSteve Longerbeam reg |= VDI_C_TOP_FIELD_MAN_1 | VDI_C_TOP_FIELD_AUTO_1;
852d2ead45SSteve Longerbeam ipu_vdi_write(vdi, reg, VDI_C);
862d2ead45SSteve Longerbeam
872d2ead45SSteve Longerbeam spin_unlock_irqrestore(&vdi->lock, flags);
882d2ead45SSteve Longerbeam }
892d2ead45SSteve Longerbeam EXPORT_SYMBOL_GPL(ipu_vdi_set_field_order);
902d2ead45SSteve Longerbeam
ipu_vdi_set_motion(struct ipu_vdi * vdi,enum ipu_motion_sel motion_sel)912d2ead45SSteve Longerbeam void ipu_vdi_set_motion(struct ipu_vdi *vdi, enum ipu_motion_sel motion_sel)
922d2ead45SSteve Longerbeam {
932d2ead45SSteve Longerbeam unsigned long flags;
942d2ead45SSteve Longerbeam u32 reg;
952d2ead45SSteve Longerbeam
962d2ead45SSteve Longerbeam spin_lock_irqsave(&vdi->lock, flags);
972d2ead45SSteve Longerbeam
982d2ead45SSteve Longerbeam reg = ipu_vdi_read(vdi, VDI_C);
992d2ead45SSteve Longerbeam
1002d2ead45SSteve Longerbeam reg &= ~VDI_C_MOT_SEL_MASK;
1012d2ead45SSteve Longerbeam
1022d2ead45SSteve Longerbeam switch (motion_sel) {
1032d2ead45SSteve Longerbeam case MED_MOTION:
1042d2ead45SSteve Longerbeam reg |= VDI_C_MOT_SEL_MED;
1052d2ead45SSteve Longerbeam break;
1062d2ead45SSteve Longerbeam case HIGH_MOTION:
1072d2ead45SSteve Longerbeam reg |= VDI_C_MOT_SEL_FULL;
1082d2ead45SSteve Longerbeam break;
1092d2ead45SSteve Longerbeam default:
1102d2ead45SSteve Longerbeam reg |= VDI_C_MOT_SEL_LOW;
1112d2ead45SSteve Longerbeam break;
1122d2ead45SSteve Longerbeam }
1132d2ead45SSteve Longerbeam
1142d2ead45SSteve Longerbeam ipu_vdi_write(vdi, reg, VDI_C);
1152d2ead45SSteve Longerbeam
1162d2ead45SSteve Longerbeam spin_unlock_irqrestore(&vdi->lock, flags);
1172d2ead45SSteve Longerbeam }
1182d2ead45SSteve Longerbeam EXPORT_SYMBOL_GPL(ipu_vdi_set_motion);
1192d2ead45SSteve Longerbeam
ipu_vdi_setup(struct ipu_vdi * vdi,u32 code,int xres,int yres)1202d2ead45SSteve Longerbeam void ipu_vdi_setup(struct ipu_vdi *vdi, u32 code, int xres, int yres)
1212d2ead45SSteve Longerbeam {
1222d2ead45SSteve Longerbeam unsigned long flags;
1232d2ead45SSteve Longerbeam u32 pixel_fmt, reg;
1242d2ead45SSteve Longerbeam
1252d2ead45SSteve Longerbeam spin_lock_irqsave(&vdi->lock, flags);
1262d2ead45SSteve Longerbeam
1272d2ead45SSteve Longerbeam reg = ((yres - 1) << 16) | (xres - 1);
1282d2ead45SSteve Longerbeam ipu_vdi_write(vdi, reg, VDI_FSIZE);
1292d2ead45SSteve Longerbeam
1302d2ead45SSteve Longerbeam /*
1312d2ead45SSteve Longerbeam * Full motion, only vertical filter is used.
1322d2ead45SSteve Longerbeam * Burst size is 4 accesses
1332d2ead45SSteve Longerbeam */
1342d2ead45SSteve Longerbeam if (code == MEDIA_BUS_FMT_UYVY8_2X8 ||
1352d2ead45SSteve Longerbeam code == MEDIA_BUS_FMT_UYVY8_1X16 ||
1362d2ead45SSteve Longerbeam code == MEDIA_BUS_FMT_YUYV8_2X8 ||
1372d2ead45SSteve Longerbeam code == MEDIA_BUS_FMT_YUYV8_1X16)
1382d2ead45SSteve Longerbeam pixel_fmt = VDI_C_CH_422;
1392d2ead45SSteve Longerbeam else
1402d2ead45SSteve Longerbeam pixel_fmt = VDI_C_CH_420;
1412d2ead45SSteve Longerbeam
1422d2ead45SSteve Longerbeam reg = ipu_vdi_read(vdi, VDI_C);
1432d2ead45SSteve Longerbeam reg |= pixel_fmt;
1442d2ead45SSteve Longerbeam reg |= VDI_C_BURST_SIZE2_4;
1452d2ead45SSteve Longerbeam reg |= VDI_C_BURST_SIZE1_4 | VDI_C_VWM1_CLR_2;
1462d2ead45SSteve Longerbeam reg |= VDI_C_BURST_SIZE3_4 | VDI_C_VWM3_CLR_2;
1472d2ead45SSteve Longerbeam ipu_vdi_write(vdi, reg, VDI_C);
1482d2ead45SSteve Longerbeam
1492d2ead45SSteve Longerbeam spin_unlock_irqrestore(&vdi->lock, flags);
1502d2ead45SSteve Longerbeam }
1512d2ead45SSteve Longerbeam EXPORT_SYMBOL_GPL(ipu_vdi_setup);
1522d2ead45SSteve Longerbeam
ipu_vdi_unsetup(struct ipu_vdi * vdi)1532d2ead45SSteve Longerbeam void ipu_vdi_unsetup(struct ipu_vdi *vdi)
1542d2ead45SSteve Longerbeam {
1552d2ead45SSteve Longerbeam unsigned long flags;
1562d2ead45SSteve Longerbeam
1572d2ead45SSteve Longerbeam spin_lock_irqsave(&vdi->lock, flags);
1582d2ead45SSteve Longerbeam ipu_vdi_write(vdi, 0, VDI_FSIZE);
1592d2ead45SSteve Longerbeam ipu_vdi_write(vdi, 0, VDI_C);
1602d2ead45SSteve Longerbeam spin_unlock_irqrestore(&vdi->lock, flags);
1612d2ead45SSteve Longerbeam }
1622d2ead45SSteve Longerbeam EXPORT_SYMBOL_GPL(ipu_vdi_unsetup);
1632d2ead45SSteve Longerbeam
ipu_vdi_enable(struct ipu_vdi * vdi)1642d2ead45SSteve Longerbeam int ipu_vdi_enable(struct ipu_vdi *vdi)
1652d2ead45SSteve Longerbeam {
1662d2ead45SSteve Longerbeam unsigned long flags;
1672d2ead45SSteve Longerbeam
1682d2ead45SSteve Longerbeam spin_lock_irqsave(&vdi->lock, flags);
1692d2ead45SSteve Longerbeam
1702d2ead45SSteve Longerbeam if (!vdi->use_count)
1712d2ead45SSteve Longerbeam ipu_module_enable(vdi->ipu, vdi->module);
1722d2ead45SSteve Longerbeam
1732d2ead45SSteve Longerbeam vdi->use_count++;
1742d2ead45SSteve Longerbeam
1752d2ead45SSteve Longerbeam spin_unlock_irqrestore(&vdi->lock, flags);
1762d2ead45SSteve Longerbeam
1772d2ead45SSteve Longerbeam return 0;
1782d2ead45SSteve Longerbeam }
1792d2ead45SSteve Longerbeam EXPORT_SYMBOL_GPL(ipu_vdi_enable);
1802d2ead45SSteve Longerbeam
ipu_vdi_disable(struct ipu_vdi * vdi)1812d2ead45SSteve Longerbeam int ipu_vdi_disable(struct ipu_vdi *vdi)
1822d2ead45SSteve Longerbeam {
1832d2ead45SSteve Longerbeam unsigned long flags;
1842d2ead45SSteve Longerbeam
1852d2ead45SSteve Longerbeam spin_lock_irqsave(&vdi->lock, flags);
1862d2ead45SSteve Longerbeam
1872d2ead45SSteve Longerbeam if (vdi->use_count) {
1882d2ead45SSteve Longerbeam if (!--vdi->use_count)
1892d2ead45SSteve Longerbeam ipu_module_disable(vdi->ipu, vdi->module);
1902d2ead45SSteve Longerbeam }
1912d2ead45SSteve Longerbeam
1922d2ead45SSteve Longerbeam spin_unlock_irqrestore(&vdi->lock, flags);
1932d2ead45SSteve Longerbeam
1942d2ead45SSteve Longerbeam return 0;
1952d2ead45SSteve Longerbeam }
1962d2ead45SSteve Longerbeam EXPORT_SYMBOL_GPL(ipu_vdi_disable);
1972d2ead45SSteve Longerbeam
ipu_vdi_get(struct ipu_soc * ipu)1982d2ead45SSteve Longerbeam struct ipu_vdi *ipu_vdi_get(struct ipu_soc *ipu)
1992d2ead45SSteve Longerbeam {
2002d2ead45SSteve Longerbeam return ipu->vdi_priv;
2012d2ead45SSteve Longerbeam }
2022d2ead45SSteve Longerbeam EXPORT_SYMBOL_GPL(ipu_vdi_get);
2032d2ead45SSteve Longerbeam
ipu_vdi_put(struct ipu_vdi * vdi)2042d2ead45SSteve Longerbeam void ipu_vdi_put(struct ipu_vdi *vdi)
2052d2ead45SSteve Longerbeam {
2062d2ead45SSteve Longerbeam }
2072d2ead45SSteve Longerbeam EXPORT_SYMBOL_GPL(ipu_vdi_put);
2082d2ead45SSteve Longerbeam
ipu_vdi_init(struct ipu_soc * ipu,struct device * dev,unsigned long base,u32 module)2092d2ead45SSteve Longerbeam int ipu_vdi_init(struct ipu_soc *ipu, struct device *dev,
2102d2ead45SSteve Longerbeam unsigned long base, u32 module)
2112d2ead45SSteve Longerbeam {
2122d2ead45SSteve Longerbeam struct ipu_vdi *vdi;
2132d2ead45SSteve Longerbeam
2142d2ead45SSteve Longerbeam vdi = devm_kzalloc(dev, sizeof(*vdi), GFP_KERNEL);
2152d2ead45SSteve Longerbeam if (!vdi)
2162d2ead45SSteve Longerbeam return -ENOMEM;
2172d2ead45SSteve Longerbeam
2182d2ead45SSteve Longerbeam ipu->vdi_priv = vdi;
2192d2ead45SSteve Longerbeam
2202d2ead45SSteve Longerbeam spin_lock_init(&vdi->lock);
2212d2ead45SSteve Longerbeam vdi->module = module;
2222d2ead45SSteve Longerbeam vdi->base = devm_ioremap(dev, base, PAGE_SIZE);
2232d2ead45SSteve Longerbeam if (!vdi->base)
2242d2ead45SSteve Longerbeam return -ENOMEM;
2252d2ead45SSteve Longerbeam
2262d2ead45SSteve Longerbeam dev_dbg(dev, "VDI base: 0x%08lx remapped to %p\n", base, vdi->base);
2272d2ead45SSteve Longerbeam vdi->ipu = ipu;
2282d2ead45SSteve Longerbeam
2292d2ead45SSteve Longerbeam return 0;
2302d2ead45SSteve Longerbeam }
2312d2ead45SSteve Longerbeam
ipu_vdi_exit(struct ipu_soc * ipu)2322d2ead45SSteve Longerbeam void ipu_vdi_exit(struct ipu_soc *ipu)
2332d2ead45SSteve Longerbeam {
2342d2ead45SSteve Longerbeam }
235