1 | // SPDX-License-Identifier: GPL-2.0+ |
2 | /* |
3 | * vsp1_uif.c -- R-Car VSP1 User Logic Interface |
4 | * |
5 | * Copyright (C) 2017-2018 Laurent Pinchart |
6 | * |
7 | * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com) |
8 | */ |
9 | |
10 | #include <linux/device.h> |
11 | #include <linux/gfp.h> |
12 | #include <linux/sys_soc.h> |
13 | |
14 | #include <media/media-entity.h> |
15 | #include <media/v4l2-subdev.h> |
16 | |
17 | #include "vsp1.h" |
18 | #include "vsp1_dl.h" |
19 | #include "vsp1_entity.h" |
20 | #include "vsp1_uif.h" |
21 | |
22 | #define UIF_MIN_SIZE 4U |
23 | #define UIF_MAX_SIZE 8190U |
24 | |
25 | /* ----------------------------------------------------------------------------- |
26 | * Device Access |
27 | */ |
28 | |
29 | static inline u32 vsp1_uif_read(struct vsp1_uif *uif, u32 reg) |
30 | { |
31 | return vsp1_read(vsp1: uif->entity.vsp1, |
32 | reg: uif->entity.index * VI6_UIF_OFFSET + reg); |
33 | } |
34 | |
35 | static inline void vsp1_uif_write(struct vsp1_uif *uif, |
36 | struct vsp1_dl_body *dlb, u32 reg, u32 data) |
37 | { |
38 | vsp1_dl_body_write(dlb, reg: reg + uif->entity.index * VI6_UIF_OFFSET, data); |
39 | } |
40 | |
41 | u32 vsp1_uif_get_crc(struct vsp1_uif *uif) |
42 | { |
43 | return vsp1_uif_read(uif, VI6_UIF_DISCOM_DOCMCCRCR); |
44 | } |
45 | |
46 | /* ----------------------------------------------------------------------------- |
47 | * V4L2 Subdevice Pad Operations |
48 | */ |
49 | |
50 | static const unsigned int uif_codes[] = { |
51 | MEDIA_BUS_FMT_ARGB8888_1X32, |
52 | MEDIA_BUS_FMT_AHSV8888_1X32, |
53 | MEDIA_BUS_FMT_AYUV8_1X32, |
54 | }; |
55 | |
56 | static int uif_enum_mbus_code(struct v4l2_subdev *subdev, |
57 | struct v4l2_subdev_state *sd_state, |
58 | struct v4l2_subdev_mbus_code_enum *code) |
59 | { |
60 | return vsp1_subdev_enum_mbus_code(subdev, sd_state, code, codes: uif_codes, |
61 | ARRAY_SIZE(uif_codes)); |
62 | } |
63 | |
64 | static int uif_enum_frame_size(struct v4l2_subdev *subdev, |
65 | struct v4l2_subdev_state *sd_state, |
66 | struct v4l2_subdev_frame_size_enum *fse) |
67 | { |
68 | return vsp1_subdev_enum_frame_size(subdev, sd_state, fse, |
69 | UIF_MIN_SIZE, |
70 | UIF_MIN_SIZE, UIF_MAX_SIZE, |
71 | UIF_MAX_SIZE); |
72 | } |
73 | |
74 | static int uif_set_format(struct v4l2_subdev *subdev, |
75 | struct v4l2_subdev_state *sd_state, |
76 | struct v4l2_subdev_format *fmt) |
77 | { |
78 | return vsp1_subdev_set_pad_format(subdev, sd_state, fmt, codes: uif_codes, |
79 | ARRAY_SIZE(uif_codes), |
80 | UIF_MIN_SIZE, UIF_MIN_SIZE, |
81 | UIF_MAX_SIZE, UIF_MAX_SIZE); |
82 | } |
83 | |
84 | static int uif_get_selection(struct v4l2_subdev *subdev, |
85 | struct v4l2_subdev_state *sd_state, |
86 | struct v4l2_subdev_selection *sel) |
87 | { |
88 | struct vsp1_uif *uif = to_uif(subdev); |
89 | struct v4l2_subdev_state *state; |
90 | struct v4l2_mbus_framefmt *format; |
91 | int ret = 0; |
92 | |
93 | if (sel->pad != UIF_PAD_SINK) |
94 | return -EINVAL; |
95 | |
96 | mutex_lock(&uif->entity.lock); |
97 | |
98 | state = vsp1_entity_get_state(entity: &uif->entity, sd_state, which: sel->which); |
99 | if (!state) { |
100 | ret = -EINVAL; |
101 | goto done; |
102 | } |
103 | |
104 | switch (sel->target) { |
105 | case V4L2_SEL_TGT_CROP_BOUNDS: |
106 | case V4L2_SEL_TGT_CROP_DEFAULT: |
107 | format = vsp1_entity_get_pad_format(entity: &uif->entity, sd_state: state, |
108 | UIF_PAD_SINK); |
109 | sel->r.left = 0; |
110 | sel->r.top = 0; |
111 | sel->r.width = format->width; |
112 | sel->r.height = format->height; |
113 | break; |
114 | |
115 | case V4L2_SEL_TGT_CROP: |
116 | sel->r = *vsp1_entity_get_pad_selection(entity: &uif->entity, sd_state: state, |
117 | pad: sel->pad, target: sel->target); |
118 | break; |
119 | |
120 | default: |
121 | ret = -EINVAL; |
122 | break; |
123 | } |
124 | |
125 | done: |
126 | mutex_unlock(lock: &uif->entity.lock); |
127 | return ret; |
128 | } |
129 | |
130 | static int uif_set_selection(struct v4l2_subdev *subdev, |
131 | struct v4l2_subdev_state *sd_state, |
132 | struct v4l2_subdev_selection *sel) |
133 | { |
134 | struct vsp1_uif *uif = to_uif(subdev); |
135 | struct v4l2_subdev_state *state; |
136 | struct v4l2_mbus_framefmt *format; |
137 | struct v4l2_rect *selection; |
138 | int ret = 0; |
139 | |
140 | if (sel->pad != UIF_PAD_SINK || |
141 | sel->target != V4L2_SEL_TGT_CROP) |
142 | return -EINVAL; |
143 | |
144 | mutex_lock(&uif->entity.lock); |
145 | |
146 | state = vsp1_entity_get_state(entity: &uif->entity, sd_state, which: sel->which); |
147 | if (!state) { |
148 | ret = -EINVAL; |
149 | goto done; |
150 | } |
151 | |
152 | /* The crop rectangle must be inside the input frame. */ |
153 | format = vsp1_entity_get_pad_format(entity: &uif->entity, sd_state: state, UIF_PAD_SINK); |
154 | |
155 | sel->r.left = clamp_t(unsigned int, sel->r.left, 0, format->width - 1); |
156 | sel->r.top = clamp_t(unsigned int, sel->r.top, 0, format->height - 1); |
157 | sel->r.width = clamp_t(unsigned int, sel->r.width, UIF_MIN_SIZE, |
158 | format->width - sel->r.left); |
159 | sel->r.height = clamp_t(unsigned int, sel->r.height, UIF_MIN_SIZE, |
160 | format->height - sel->r.top); |
161 | |
162 | /* Store the crop rectangle. */ |
163 | selection = vsp1_entity_get_pad_selection(entity: &uif->entity, sd_state: state, |
164 | pad: sel->pad, V4L2_SEL_TGT_CROP); |
165 | *selection = sel->r; |
166 | |
167 | done: |
168 | mutex_unlock(lock: &uif->entity.lock); |
169 | return ret; |
170 | } |
171 | |
172 | /* ----------------------------------------------------------------------------- |
173 | * V4L2 Subdevice Operations |
174 | */ |
175 | |
176 | static const struct v4l2_subdev_pad_ops uif_pad_ops = { |
177 | .enum_mbus_code = uif_enum_mbus_code, |
178 | .enum_frame_size = uif_enum_frame_size, |
179 | .get_fmt = vsp1_subdev_get_pad_format, |
180 | .set_fmt = uif_set_format, |
181 | .get_selection = uif_get_selection, |
182 | .set_selection = uif_set_selection, |
183 | }; |
184 | |
185 | static const struct v4l2_subdev_ops uif_ops = { |
186 | .pad = &uif_pad_ops, |
187 | }; |
188 | |
189 | /* ----------------------------------------------------------------------------- |
190 | * VSP1 Entity Operations |
191 | */ |
192 | |
193 | static void uif_configure_stream(struct vsp1_entity *entity, |
194 | struct vsp1_pipeline *pipe, |
195 | struct vsp1_dl_list *dl, |
196 | struct vsp1_dl_body *dlb) |
197 | { |
198 | struct vsp1_uif *uif = to_uif(subdev: &entity->subdev); |
199 | const struct v4l2_rect *crop; |
200 | unsigned int left; |
201 | unsigned int width; |
202 | |
203 | vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMPMR, |
204 | VI6_UIF_DISCOM_DOCMPMR_SEL(9)); |
205 | |
206 | crop = vsp1_entity_get_pad_selection(entity, sd_state: entity->state, |
207 | UIF_PAD_SINK, V4L2_SEL_TGT_CROP); |
208 | |
209 | left = crop->left; |
210 | width = crop->width; |
211 | |
212 | /* On M3-W the horizontal coordinates are twice the register value. */ |
213 | if (uif->m3w_quirk) { |
214 | left /= 2; |
215 | width /= 2; |
216 | } |
217 | |
218 | vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSPXR, data: left); |
219 | vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSPYR, data: crop->top); |
220 | vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSZXR, data: width); |
221 | vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSZYR, data: crop->height); |
222 | |
223 | vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMCR, |
224 | VI6_UIF_DISCOM_DOCMCR_CMPR); |
225 | } |
226 | |
227 | static const struct vsp1_entity_operations uif_entity_ops = { |
228 | .configure_stream = uif_configure_stream, |
229 | }; |
230 | |
231 | /* ----------------------------------------------------------------------------- |
232 | * Initialization and Cleanup |
233 | */ |
234 | |
235 | static const struct soc_device_attribute vsp1_r8a7796[] = { |
236 | { .soc_id = "r8a7796" }, |
237 | { /* sentinel */ } |
238 | }; |
239 | |
240 | struct vsp1_uif *vsp1_uif_create(struct vsp1_device *vsp1, unsigned int index) |
241 | { |
242 | struct vsp1_uif *uif; |
243 | char name[6]; |
244 | int ret; |
245 | |
246 | uif = devm_kzalloc(dev: vsp1->dev, size: sizeof(*uif), GFP_KERNEL); |
247 | if (!uif) |
248 | return ERR_PTR(error: -ENOMEM); |
249 | |
250 | if (soc_device_match(matches: vsp1_r8a7796)) |
251 | uif->m3w_quirk = true; |
252 | |
253 | uif->entity.ops = &uif_entity_ops; |
254 | uif->entity.type = VSP1_ENTITY_UIF; |
255 | uif->entity.index = index; |
256 | |
257 | /* The datasheet names the two UIF instances UIF4 and UIF5. */ |
258 | sprintf(buf: name, fmt: "uif.%u" , index + 4); |
259 | ret = vsp1_entity_init(vsp1, entity: &uif->entity, name, num_pads: 2, ops: &uif_ops, |
260 | MEDIA_ENT_F_PROC_VIDEO_STATISTICS); |
261 | if (ret < 0) |
262 | return ERR_PTR(error: ret); |
263 | |
264 | return uif; |
265 | } |
266 | |