Loading...
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * Copyright (C) 2012-2016 Mentor Graphics Inc.
4 * Copyright (C) 2005-2009 Freescale Semiconductor, Inc.
5 */
6#include <linux/io.h>
7#include "ipu-prv.h"
8
9struct ipu_vdi {
10 void __iomem *base;
11 u32 module;
12 spinlock_t lock;
13 int use_count;
14 struct ipu_soc *ipu;
15};
16
17
18/* VDI Register Offsets */
19#define VDI_FSIZE 0x0000
20#define VDI_C 0x0004
21
22/* VDI Register Fields */
23#define VDI_C_CH_420 (0 << 1)
24#define VDI_C_CH_422 (1 << 1)
25#define VDI_C_MOT_SEL_MASK (0x3 << 2)
26#define VDI_C_MOT_SEL_FULL (2 << 2)
27#define VDI_C_MOT_SEL_LOW (1 << 2)
28#define VDI_C_MOT_SEL_MED (0 << 2)
29#define VDI_C_BURST_SIZE1_4 (3 << 4)
30#define VDI_C_BURST_SIZE2_4 (3 << 8)
31#define VDI_C_BURST_SIZE3_4 (3 << 12)
32#define VDI_C_BURST_SIZE_MASK 0xF
33#define VDI_C_BURST_SIZE1_OFFSET 4
34#define VDI_C_BURST_SIZE2_OFFSET 8
35#define VDI_C_BURST_SIZE3_OFFSET 12
36#define VDI_C_VWM1_SET_1 (0 << 16)
37#define VDI_C_VWM1_SET_2 (1 << 16)
38#define VDI_C_VWM1_CLR_2 (1 << 19)
39#define VDI_C_VWM3_SET_1 (0 << 22)
40#define VDI_C_VWM3_SET_2 (1 << 22)
41#define VDI_C_VWM3_CLR_2 (1 << 25)
42#define VDI_C_TOP_FIELD_MAN_1 (1 << 30)
43#define VDI_C_TOP_FIELD_AUTO_1 (1 << 31)
44
45static inline u32 ipu_vdi_read(struct ipu_vdi *vdi, unsigned int offset)
46{
47 return readl(vdi->base + offset);
48}
49
50static inline void ipu_vdi_write(struct ipu_vdi *vdi, u32 value,
51 unsigned int offset)
52{
53 writel(value, vdi->base + offset);
54}
55
56void ipu_vdi_set_field_order(struct ipu_vdi *vdi, v4l2_std_id std, u32 field)
57{
58 bool top_field_0 = false;
59 unsigned long flags;
60 u32 reg;
61
62 switch (field) {
63 case V4L2_FIELD_INTERLACED_TB:
64 case V4L2_FIELD_SEQ_TB:
65 case V4L2_FIELD_TOP:
66 top_field_0 = true;
67 break;
68 case V4L2_FIELD_INTERLACED_BT:
69 case V4L2_FIELD_SEQ_BT:
70 case V4L2_FIELD_BOTTOM:
71 top_field_0 = false;
72 break;
73 default:
74 top_field_0 = (std & V4L2_STD_525_60) ? true : false;
75 break;
76 }
77
78 spin_lock_irqsave(&vdi->lock, flags);
79
80 reg = ipu_vdi_read(vdi, VDI_C);
81 if (top_field_0)
82 reg &= ~(VDI_C_TOP_FIELD_MAN_1 | VDI_C_TOP_FIELD_AUTO_1);
83 else
84 reg |= VDI_C_TOP_FIELD_MAN_1 | VDI_C_TOP_FIELD_AUTO_1;
85 ipu_vdi_write(vdi, reg, VDI_C);
86
87 spin_unlock_irqrestore(&vdi->lock, flags);
88}
89EXPORT_SYMBOL_GPL(ipu_vdi_set_field_order);
90
91void ipu_vdi_set_motion(struct ipu_vdi *vdi, enum ipu_motion_sel motion_sel)
92{
93 unsigned long flags;
94 u32 reg;
95
96 spin_lock_irqsave(&vdi->lock, flags);
97
98 reg = ipu_vdi_read(vdi, VDI_C);
99
100 reg &= ~VDI_C_MOT_SEL_MASK;
101
102 switch (motion_sel) {
103 case MED_MOTION:
104 reg |= VDI_C_MOT_SEL_MED;
105 break;
106 case HIGH_MOTION:
107 reg |= VDI_C_MOT_SEL_FULL;
108 break;
109 default:
110 reg |= VDI_C_MOT_SEL_LOW;
111 break;
112 }
113
114 ipu_vdi_write(vdi, reg, VDI_C);
115
116 spin_unlock_irqrestore(&vdi->lock, flags);
117}
118EXPORT_SYMBOL_GPL(ipu_vdi_set_motion);
119
120void ipu_vdi_setup(struct ipu_vdi *vdi, u32 code, int xres, int yres)
121{
122 unsigned long flags;
123 u32 pixel_fmt, reg;
124
125 spin_lock_irqsave(&vdi->lock, flags);
126
127 reg = ((yres - 1) << 16) | (xres - 1);
128 ipu_vdi_write(vdi, reg, VDI_FSIZE);
129
130 /*
131 * Full motion, only vertical filter is used.
132 * Burst size is 4 accesses
133 */
134 if (code == MEDIA_BUS_FMT_UYVY8_2X8 ||
135 code == MEDIA_BUS_FMT_UYVY8_1X16 ||
136 code == MEDIA_BUS_FMT_YUYV8_2X8 ||
137 code == MEDIA_BUS_FMT_YUYV8_1X16)
138 pixel_fmt = VDI_C_CH_422;
139 else
140 pixel_fmt = VDI_C_CH_420;
141
142 reg = ipu_vdi_read(vdi, VDI_C);
143 reg |= pixel_fmt;
144 reg |= VDI_C_BURST_SIZE2_4;
145 reg |= VDI_C_BURST_SIZE1_4 | VDI_C_VWM1_CLR_2;
146 reg |= VDI_C_BURST_SIZE3_4 | VDI_C_VWM3_CLR_2;
147 ipu_vdi_write(vdi, reg, VDI_C);
148
149 spin_unlock_irqrestore(&vdi->lock, flags);
150}
151EXPORT_SYMBOL_GPL(ipu_vdi_setup);
152
153void ipu_vdi_unsetup(struct ipu_vdi *vdi)
154{
155 unsigned long flags;
156
157 spin_lock_irqsave(&vdi->lock, flags);
158 ipu_vdi_write(vdi, 0, VDI_FSIZE);
159 ipu_vdi_write(vdi, 0, VDI_C);
160 spin_unlock_irqrestore(&vdi->lock, flags);
161}
162EXPORT_SYMBOL_GPL(ipu_vdi_unsetup);
163
164int ipu_vdi_enable(struct ipu_vdi *vdi)
165{
166 unsigned long flags;
167
168 spin_lock_irqsave(&vdi->lock, flags);
169
170 if (!vdi->use_count)
171 ipu_module_enable(vdi->ipu, vdi->module);
172
173 vdi->use_count++;
174
175 spin_unlock_irqrestore(&vdi->lock, flags);
176
177 return 0;
178}
179EXPORT_SYMBOL_GPL(ipu_vdi_enable);
180
181int ipu_vdi_disable(struct ipu_vdi *vdi)
182{
183 unsigned long flags;
184
185 spin_lock_irqsave(&vdi->lock, flags);
186
187 if (vdi->use_count) {
188 if (!--vdi->use_count)
189 ipu_module_disable(vdi->ipu, vdi->module);
190 }
191
192 spin_unlock_irqrestore(&vdi->lock, flags);
193
194 return 0;
195}
196EXPORT_SYMBOL_GPL(ipu_vdi_disable);
197
198struct ipu_vdi *ipu_vdi_get(struct ipu_soc *ipu)
199{
200 return ipu->vdi_priv;
201}
202EXPORT_SYMBOL_GPL(ipu_vdi_get);
203
204void ipu_vdi_put(struct ipu_vdi *vdi)
205{
206}
207EXPORT_SYMBOL_GPL(ipu_vdi_put);
208
209int ipu_vdi_init(struct ipu_soc *ipu, struct device *dev,
210 unsigned long base, u32 module)
211{
212 struct ipu_vdi *vdi;
213
214 vdi = devm_kzalloc(dev, sizeof(*vdi), GFP_KERNEL);
215 if (!vdi)
216 return -ENOMEM;
217
218 ipu->vdi_priv = vdi;
219
220 spin_lock_init(&vdi->lock);
221 vdi->module = module;
222 vdi->base = devm_ioremap(dev, base, PAGE_SIZE);
223 if (!vdi->base)
224 return -ENOMEM;
225
226 dev_dbg(dev, "VDI base: 0x%08lx remapped to %p\n", base, vdi->base);
227 vdi->ipu = ipu;
228
229 return 0;
230}
231
232void ipu_vdi_exit(struct ipu_soc *ipu)
233{
234}
1/*
2 * Copyright (C) 2012-2016 Mentor Graphics Inc.
3 * Copyright (C) 2005-2009 Freescale Semiconductor, Inc.
4 *
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.
9 *
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
13 * for more details.
14 */
15#include <linux/io.h>
16#include "ipu-prv.h"
17
18struct ipu_vdi {
19 void __iomem *base;
20 u32 module;
21 spinlock_t lock;
22 int use_count;
23 struct ipu_soc *ipu;
24};
25
26
27/* VDI Register Offsets */
28#define VDI_FSIZE 0x0000
29#define VDI_C 0x0004
30
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)
53
54static inline u32 ipu_vdi_read(struct ipu_vdi *vdi, unsigned int offset)
55{
56 return readl(vdi->base + offset);
57}
58
59static inline void ipu_vdi_write(struct ipu_vdi *vdi, u32 value,
60 unsigned int offset)
61{
62 writel(value, vdi->base + offset);
63}
64
65void ipu_vdi_set_field_order(struct ipu_vdi *vdi, v4l2_std_id std, u32 field)
66{
67 bool top_field_0 = false;
68 unsigned long flags;
69 u32 reg;
70
71 switch (field) {
72 case V4L2_FIELD_INTERLACED_TB:
73 case V4L2_FIELD_SEQ_TB:
74 case V4L2_FIELD_TOP:
75 top_field_0 = true;
76 break;
77 case V4L2_FIELD_INTERLACED_BT:
78 case V4L2_FIELD_SEQ_BT:
79 case V4L2_FIELD_BOTTOM:
80 top_field_0 = false;
81 break;
82 default:
83 top_field_0 = (std & V4L2_STD_525_60) ? true : false;
84 break;
85 }
86
87 spin_lock_irqsave(&vdi->lock, flags);
88
89 reg = ipu_vdi_read(vdi, VDI_C);
90 if (top_field_0)
91 reg &= ~VDI_C_TOP_FIELD_MAN_1;
92 else
93 reg |= VDI_C_TOP_FIELD_MAN_1;
94 ipu_vdi_write(vdi, reg, VDI_C);
95
96 spin_unlock_irqrestore(&vdi->lock, flags);
97}
98EXPORT_SYMBOL_GPL(ipu_vdi_set_field_order);
99
100void ipu_vdi_set_motion(struct ipu_vdi *vdi, enum ipu_motion_sel motion_sel)
101{
102 unsigned long flags;
103 u32 reg;
104
105 spin_lock_irqsave(&vdi->lock, flags);
106
107 reg = ipu_vdi_read(vdi, VDI_C);
108
109 reg &= ~VDI_C_MOT_SEL_MASK;
110
111 switch (motion_sel) {
112 case MED_MOTION:
113 reg |= VDI_C_MOT_SEL_MED;
114 break;
115 case HIGH_MOTION:
116 reg |= VDI_C_MOT_SEL_FULL;
117 break;
118 default:
119 reg |= VDI_C_MOT_SEL_LOW;
120 break;
121 }
122
123 ipu_vdi_write(vdi, reg, VDI_C);
124
125 spin_unlock_irqrestore(&vdi->lock, flags);
126}
127EXPORT_SYMBOL_GPL(ipu_vdi_set_motion);
128
129void ipu_vdi_setup(struct ipu_vdi *vdi, u32 code, int xres, int yres)
130{
131 unsigned long flags;
132 u32 pixel_fmt, reg;
133
134 spin_lock_irqsave(&vdi->lock, flags);
135
136 reg = ((yres - 1) << 16) | (xres - 1);
137 ipu_vdi_write(vdi, reg, VDI_FSIZE);
138
139 /*
140 * Full motion, only vertical filter is used.
141 * Burst size is 4 accesses
142 */
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;
148 else
149 pixel_fmt = VDI_C_CH_420;
150
151 reg = ipu_vdi_read(vdi, VDI_C);
152 reg |= pixel_fmt;
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);
157
158 spin_unlock_irqrestore(&vdi->lock, flags);
159}
160EXPORT_SYMBOL_GPL(ipu_vdi_setup);
161
162void ipu_vdi_unsetup(struct ipu_vdi *vdi)
163{
164 unsigned long flags;
165
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);
170}
171EXPORT_SYMBOL_GPL(ipu_vdi_unsetup);
172
173int ipu_vdi_enable(struct ipu_vdi *vdi)
174{
175 unsigned long flags;
176
177 spin_lock_irqsave(&vdi->lock, flags);
178
179 if (!vdi->use_count)
180 ipu_module_enable(vdi->ipu, vdi->module);
181
182 vdi->use_count++;
183
184 spin_unlock_irqrestore(&vdi->lock, flags);
185
186 return 0;
187}
188EXPORT_SYMBOL_GPL(ipu_vdi_enable);
189
190int ipu_vdi_disable(struct ipu_vdi *vdi)
191{
192 unsigned long flags;
193
194 spin_lock_irqsave(&vdi->lock, flags);
195
196 if (vdi->use_count) {
197 if (!--vdi->use_count)
198 ipu_module_disable(vdi->ipu, vdi->module);
199 }
200
201 spin_unlock_irqrestore(&vdi->lock, flags);
202
203 return 0;
204}
205EXPORT_SYMBOL_GPL(ipu_vdi_disable);
206
207struct ipu_vdi *ipu_vdi_get(struct ipu_soc *ipu)
208{
209 return ipu->vdi_priv;
210}
211EXPORT_SYMBOL_GPL(ipu_vdi_get);
212
213void ipu_vdi_put(struct ipu_vdi *vdi)
214{
215}
216EXPORT_SYMBOL_GPL(ipu_vdi_put);
217
218int ipu_vdi_init(struct ipu_soc *ipu, struct device *dev,
219 unsigned long base, u32 module)
220{
221 struct ipu_vdi *vdi;
222
223 vdi = devm_kzalloc(dev, sizeof(*vdi), GFP_KERNEL);
224 if (!vdi)
225 return -ENOMEM;
226
227 ipu->vdi_priv = vdi;
228
229 spin_lock_init(&vdi->lock);
230 vdi->module = module;
231 vdi->base = devm_ioremap(dev, base, PAGE_SIZE);
232 if (!vdi->base)
233 return -ENOMEM;
234
235 dev_dbg(dev, "VDI base: 0x%08lx remapped to %p\n", base, vdi->base);
236 vdi->ipu = ipu;
237
238 return 0;
239}
240
241void ipu_vdi_exit(struct ipu_soc *ipu)
242{
243}