2 * Copyright (C) 2012-2016 Mentor Graphics Inc.
3 * Copyright (C) 2005-2009 Freescale Semiconductor, Inc.
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License as published by the
7 * Free Software Foundation; either version 2 of the License, or (at your
8 * option) any later version.
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
12 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
27 /* VDI Register Offsets */
28 #define VDI_FSIZE 0x0000
31 /* VDI Register Fields */
32 #define VDI_C_CH_420 (0 << 1)
33 #define VDI_C_CH_422 (1 << 1)
34 #define VDI_C_MOT_SEL_MASK (0x3 << 2)
35 #define VDI_C_MOT_SEL_FULL (2 << 2)
36 #define VDI_C_MOT_SEL_LOW (1 << 2)
37 #define VDI_C_MOT_SEL_MED (0 << 2)
38 #define VDI_C_BURST_SIZE1_4 (3 << 4)
39 #define VDI_C_BURST_SIZE2_4 (3 << 8)
40 #define VDI_C_BURST_SIZE3_4 (3 << 12)
41 #define VDI_C_BURST_SIZE_MASK 0xF
42 #define VDI_C_BURST_SIZE1_OFFSET 4
43 #define VDI_C_BURST_SIZE2_OFFSET 8
44 #define VDI_C_BURST_SIZE3_OFFSET 12
45 #define VDI_C_VWM1_SET_1 (0 << 16)
46 #define VDI_C_VWM1_SET_2 (1 << 16)
47 #define VDI_C_VWM1_CLR_2 (1 << 19)
48 #define VDI_C_VWM3_SET_1 (0 << 22)
49 #define VDI_C_VWM3_SET_2 (1 << 22)
50 #define VDI_C_VWM3_CLR_2 (1 << 25)
51 #define VDI_C_TOP_FIELD_MAN_1 (1 << 30)
52 #define VDI_C_TOP_FIELD_AUTO_1 (1 << 31)
54 static inline u32 ipu_vdi_read(struct ipu_vdi *vdi, unsigned int offset)
56 return readl(vdi->base + offset);
59 static inline void ipu_vdi_write(struct ipu_vdi *vdi, u32 value,
62 writel(value, vdi->base + offset);
65 void ipu_vdi_set_field_order(struct ipu_vdi *vdi, v4l2_std_id std, u32 field)
67 bool top_field_0 = false;
72 case V4L2_FIELD_INTERLACED_TB:
73 case V4L2_FIELD_SEQ_TB:
77 case V4L2_FIELD_INTERLACED_BT:
78 case V4L2_FIELD_SEQ_BT:
79 case V4L2_FIELD_BOTTOM:
83 top_field_0 = (std & V4L2_STD_525_60) ? true : false;
87 spin_lock_irqsave(&vdi->lock, flags);
89 reg = ipu_vdi_read(vdi, VDI_C);
91 reg &= ~VDI_C_TOP_FIELD_MAN_1;
93 reg |= VDI_C_TOP_FIELD_MAN_1;
94 ipu_vdi_write(vdi, reg, VDI_C);
96 spin_unlock_irqrestore(&vdi->lock, flags);
98 EXPORT_SYMBOL_GPL(ipu_vdi_set_field_order);
100 void ipu_vdi_set_motion(struct ipu_vdi *vdi, enum ipu_motion_sel motion_sel)
105 spin_lock_irqsave(&vdi->lock, flags);
107 reg = ipu_vdi_read(vdi, VDI_C);
109 reg &= ~VDI_C_MOT_SEL_MASK;
111 switch (motion_sel) {
113 reg |= VDI_C_MOT_SEL_MED;
116 reg |= VDI_C_MOT_SEL_FULL;
119 reg |= VDI_C_MOT_SEL_LOW;
123 ipu_vdi_write(vdi, reg, VDI_C);
125 spin_unlock_irqrestore(&vdi->lock, flags);
127 EXPORT_SYMBOL_GPL(ipu_vdi_set_motion);
129 void ipu_vdi_setup(struct ipu_vdi *vdi, u32 code, int xres, int yres)
134 spin_lock_irqsave(&vdi->lock, flags);
136 reg = ((yres - 1) << 16) | (xres - 1);
137 ipu_vdi_write(vdi, reg, VDI_FSIZE);
140 * Full motion, only vertical filter is used.
141 * Burst size is 4 accesses
143 if (code == MEDIA_BUS_FMT_UYVY8_2X8 ||
144 code == MEDIA_BUS_FMT_UYVY8_1X16 ||
145 code == MEDIA_BUS_FMT_YUYV8_2X8 ||
146 code == MEDIA_BUS_FMT_YUYV8_1X16)
147 pixel_fmt = VDI_C_CH_422;
149 pixel_fmt = VDI_C_CH_420;
151 reg = ipu_vdi_read(vdi, VDI_C);
153 reg |= VDI_C_BURST_SIZE2_4;
154 reg |= VDI_C_BURST_SIZE1_4 | VDI_C_VWM1_CLR_2;
155 reg |= VDI_C_BURST_SIZE3_4 | VDI_C_VWM3_CLR_2;
156 ipu_vdi_write(vdi, reg, VDI_C);
158 spin_unlock_irqrestore(&vdi->lock, flags);
160 EXPORT_SYMBOL_GPL(ipu_vdi_setup);
162 void ipu_vdi_unsetup(struct ipu_vdi *vdi)
166 spin_lock_irqsave(&vdi->lock, flags);
167 ipu_vdi_write(vdi, 0, VDI_FSIZE);
168 ipu_vdi_write(vdi, 0, VDI_C);
169 spin_unlock_irqrestore(&vdi->lock, flags);
171 EXPORT_SYMBOL_GPL(ipu_vdi_unsetup);
173 int ipu_vdi_enable(struct ipu_vdi *vdi)
177 spin_lock_irqsave(&vdi->lock, flags);
180 ipu_module_enable(vdi->ipu, vdi->module);
184 spin_unlock_irqrestore(&vdi->lock, flags);
188 EXPORT_SYMBOL_GPL(ipu_vdi_enable);
190 int ipu_vdi_disable(struct ipu_vdi *vdi)
194 spin_lock_irqsave(&vdi->lock, flags);
196 if (vdi->use_count) {
197 if (!--vdi->use_count)
198 ipu_module_disable(vdi->ipu, vdi->module);
201 spin_unlock_irqrestore(&vdi->lock, flags);
205 EXPORT_SYMBOL_GPL(ipu_vdi_disable);
207 struct ipu_vdi *ipu_vdi_get(struct ipu_soc *ipu)
209 return ipu->vdi_priv;
211 EXPORT_SYMBOL_GPL(ipu_vdi_get);
213 void ipu_vdi_put(struct ipu_vdi *vdi)
216 EXPORT_SYMBOL_GPL(ipu_vdi_put);
218 int ipu_vdi_init(struct ipu_soc *ipu, struct device *dev,
219 unsigned long base, u32 module)
223 vdi = devm_kzalloc(dev, sizeof(*vdi), GFP_KERNEL);
229 spin_lock_init(&vdi->lock);
230 vdi->module = module;
231 vdi->base = devm_ioremap(dev, base, PAGE_SIZE);
235 dev_dbg(dev, "VDI base: 0x%08lx remapped to %p\n", base, vdi->base);
241 void ipu_vdi_exit(struct ipu_soc *ipu)