xref: /OK3568_Linux_fs/kernel/drivers/media/platform/vsp1/vsp1_drv.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * vsp1_drv.c  --  R-Car VSP1 Driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2013-2015 Renesas Electronics Corporation
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun #include <linux/clk.h>
11*4882a593Smuzhiyun #include <linux/delay.h>
12*4882a593Smuzhiyun #include <linux/device.h>
13*4882a593Smuzhiyun #include <linux/interrupt.h>
14*4882a593Smuzhiyun #include <linux/module.h>
15*4882a593Smuzhiyun #include <linux/of.h>
16*4882a593Smuzhiyun #include <linux/of_device.h>
17*4882a593Smuzhiyun #include <linux/platform_device.h>
18*4882a593Smuzhiyun #include <linux/pm_runtime.h>
19*4882a593Smuzhiyun #include <linux/videodev2.h>
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun #include <media/rcar-fcp.h>
22*4882a593Smuzhiyun #include <media/v4l2-subdev.h>
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun #include "vsp1.h"
25*4882a593Smuzhiyun #include "vsp1_brx.h"
26*4882a593Smuzhiyun #include "vsp1_clu.h"
27*4882a593Smuzhiyun #include "vsp1_dl.h"
28*4882a593Smuzhiyun #include "vsp1_drm.h"
29*4882a593Smuzhiyun #include "vsp1_hgo.h"
30*4882a593Smuzhiyun #include "vsp1_hgt.h"
31*4882a593Smuzhiyun #include "vsp1_hsit.h"
32*4882a593Smuzhiyun #include "vsp1_lif.h"
33*4882a593Smuzhiyun #include "vsp1_lut.h"
34*4882a593Smuzhiyun #include "vsp1_pipe.h"
35*4882a593Smuzhiyun #include "vsp1_rwpf.h"
36*4882a593Smuzhiyun #include "vsp1_sru.h"
37*4882a593Smuzhiyun #include "vsp1_uds.h"
38*4882a593Smuzhiyun #include "vsp1_uif.h"
39*4882a593Smuzhiyun #include "vsp1_video.h"
40*4882a593Smuzhiyun 
41*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
42*4882a593Smuzhiyun  * Interrupt Handling
43*4882a593Smuzhiyun  */
44*4882a593Smuzhiyun 
vsp1_irq_handler(int irq,void * data)45*4882a593Smuzhiyun static irqreturn_t vsp1_irq_handler(int irq, void *data)
46*4882a593Smuzhiyun {
47*4882a593Smuzhiyun 	u32 mask = VI6_WFP_IRQ_STA_DFE | VI6_WFP_IRQ_STA_FRE;
48*4882a593Smuzhiyun 	struct vsp1_device *vsp1 = data;
49*4882a593Smuzhiyun 	irqreturn_t ret = IRQ_NONE;
50*4882a593Smuzhiyun 	unsigned int i;
51*4882a593Smuzhiyun 	u32 status;
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->wpf_count; ++i) {
54*4882a593Smuzhiyun 		struct vsp1_rwpf *wpf = vsp1->wpf[i];
55*4882a593Smuzhiyun 
56*4882a593Smuzhiyun 		if (wpf == NULL)
57*4882a593Smuzhiyun 			continue;
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun 		status = vsp1_read(vsp1, VI6_WPF_IRQ_STA(i));
60*4882a593Smuzhiyun 		vsp1_write(vsp1, VI6_WPF_IRQ_STA(i), ~status & mask);
61*4882a593Smuzhiyun 
62*4882a593Smuzhiyun 		if (status & VI6_WFP_IRQ_STA_DFE) {
63*4882a593Smuzhiyun 			vsp1_pipeline_frame_end(wpf->entity.pipe);
64*4882a593Smuzhiyun 			ret = IRQ_HANDLED;
65*4882a593Smuzhiyun 		}
66*4882a593Smuzhiyun 	}
67*4882a593Smuzhiyun 
68*4882a593Smuzhiyun 	return ret;
69*4882a593Smuzhiyun }
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
72*4882a593Smuzhiyun  * Entities
73*4882a593Smuzhiyun  */
74*4882a593Smuzhiyun 
75*4882a593Smuzhiyun /*
76*4882a593Smuzhiyun  * vsp1_create_sink_links - Create links from all sources to the given sink
77*4882a593Smuzhiyun  *
78*4882a593Smuzhiyun  * This function creates media links from all valid sources to the given sink
79*4882a593Smuzhiyun  * pad. Links that would be invalid according to the VSP1 hardware capabilities
80*4882a593Smuzhiyun  * are skipped. Those include all links
81*4882a593Smuzhiyun  *
82*4882a593Smuzhiyun  * - from a UDS to a UDS (UDS entities can't be chained)
83*4882a593Smuzhiyun  * - from an entity to itself (no loops are allowed)
84*4882a593Smuzhiyun  *
85*4882a593Smuzhiyun  * Furthermore, the BRS can't be connected to histogram generators, but no
86*4882a593Smuzhiyun  * special check is currently needed as all VSP instances that include a BRS
87*4882a593Smuzhiyun  * have no histogram generator.
88*4882a593Smuzhiyun  */
vsp1_create_sink_links(struct vsp1_device * vsp1,struct vsp1_entity * sink)89*4882a593Smuzhiyun static int vsp1_create_sink_links(struct vsp1_device *vsp1,
90*4882a593Smuzhiyun 				  struct vsp1_entity *sink)
91*4882a593Smuzhiyun {
92*4882a593Smuzhiyun 	struct media_entity *entity = &sink->subdev.entity;
93*4882a593Smuzhiyun 	struct vsp1_entity *source;
94*4882a593Smuzhiyun 	unsigned int pad;
95*4882a593Smuzhiyun 	int ret;
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 	list_for_each_entry(source, &vsp1->entities, list_dev) {
98*4882a593Smuzhiyun 		u32 flags;
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun 		if (source->type == sink->type)
101*4882a593Smuzhiyun 			continue;
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun 		if (source->type == VSP1_ENTITY_HGO ||
104*4882a593Smuzhiyun 		    source->type == VSP1_ENTITY_HGT ||
105*4882a593Smuzhiyun 		    source->type == VSP1_ENTITY_LIF ||
106*4882a593Smuzhiyun 		    source->type == VSP1_ENTITY_WPF)
107*4882a593Smuzhiyun 			continue;
108*4882a593Smuzhiyun 
109*4882a593Smuzhiyun 		flags = source->type == VSP1_ENTITY_RPF &&
110*4882a593Smuzhiyun 			sink->type == VSP1_ENTITY_WPF &&
111*4882a593Smuzhiyun 			source->index == sink->index
112*4882a593Smuzhiyun 		      ? MEDIA_LNK_FL_ENABLED : 0;
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun 		for (pad = 0; pad < entity->num_pads; ++pad) {
115*4882a593Smuzhiyun 			if (!(entity->pads[pad].flags & MEDIA_PAD_FL_SINK))
116*4882a593Smuzhiyun 				continue;
117*4882a593Smuzhiyun 
118*4882a593Smuzhiyun 			ret = media_create_pad_link(&source->subdev.entity,
119*4882a593Smuzhiyun 						       source->source_pad,
120*4882a593Smuzhiyun 						       entity, pad, flags);
121*4882a593Smuzhiyun 			if (ret < 0)
122*4882a593Smuzhiyun 				return ret;
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun 			if (flags & MEDIA_LNK_FL_ENABLED)
125*4882a593Smuzhiyun 				source->sink = sink;
126*4882a593Smuzhiyun 		}
127*4882a593Smuzhiyun 	}
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun 	return 0;
130*4882a593Smuzhiyun }
131*4882a593Smuzhiyun 
vsp1_uapi_create_links(struct vsp1_device * vsp1)132*4882a593Smuzhiyun static int vsp1_uapi_create_links(struct vsp1_device *vsp1)
133*4882a593Smuzhiyun {
134*4882a593Smuzhiyun 	struct vsp1_entity *entity;
135*4882a593Smuzhiyun 	unsigned int i;
136*4882a593Smuzhiyun 	int ret;
137*4882a593Smuzhiyun 
138*4882a593Smuzhiyun 	list_for_each_entry(entity, &vsp1->entities, list_dev) {
139*4882a593Smuzhiyun 		if (entity->type == VSP1_ENTITY_LIF ||
140*4882a593Smuzhiyun 		    entity->type == VSP1_ENTITY_RPF)
141*4882a593Smuzhiyun 			continue;
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun 		ret = vsp1_create_sink_links(vsp1, entity);
144*4882a593Smuzhiyun 		if (ret < 0)
145*4882a593Smuzhiyun 			return ret;
146*4882a593Smuzhiyun 	}
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun 	if (vsp1->hgo) {
149*4882a593Smuzhiyun 		ret = media_create_pad_link(&vsp1->hgo->histo.entity.subdev.entity,
150*4882a593Smuzhiyun 					    HISTO_PAD_SOURCE,
151*4882a593Smuzhiyun 					    &vsp1->hgo->histo.video.entity, 0,
152*4882a593Smuzhiyun 					    MEDIA_LNK_FL_ENABLED |
153*4882a593Smuzhiyun 					    MEDIA_LNK_FL_IMMUTABLE);
154*4882a593Smuzhiyun 		if (ret < 0)
155*4882a593Smuzhiyun 			return ret;
156*4882a593Smuzhiyun 	}
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun 	if (vsp1->hgt) {
159*4882a593Smuzhiyun 		ret = media_create_pad_link(&vsp1->hgt->histo.entity.subdev.entity,
160*4882a593Smuzhiyun 					    HISTO_PAD_SOURCE,
161*4882a593Smuzhiyun 					    &vsp1->hgt->histo.video.entity, 0,
162*4882a593Smuzhiyun 					    MEDIA_LNK_FL_ENABLED |
163*4882a593Smuzhiyun 					    MEDIA_LNK_FL_IMMUTABLE);
164*4882a593Smuzhiyun 		if (ret < 0)
165*4882a593Smuzhiyun 			return ret;
166*4882a593Smuzhiyun 	}
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->lif_count; ++i) {
169*4882a593Smuzhiyun 		if (!vsp1->lif[i])
170*4882a593Smuzhiyun 			continue;
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 		ret = media_create_pad_link(&vsp1->wpf[i]->entity.subdev.entity,
173*4882a593Smuzhiyun 					    RWPF_PAD_SOURCE,
174*4882a593Smuzhiyun 					    &vsp1->lif[i]->entity.subdev.entity,
175*4882a593Smuzhiyun 					    LIF_PAD_SINK, 0);
176*4882a593Smuzhiyun 		if (ret < 0)
177*4882a593Smuzhiyun 			return ret;
178*4882a593Smuzhiyun 	}
179*4882a593Smuzhiyun 
180*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->rpf_count; ++i) {
181*4882a593Smuzhiyun 		struct vsp1_rwpf *rpf = vsp1->rpf[i];
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 		ret = media_create_pad_link(&rpf->video->video.entity, 0,
184*4882a593Smuzhiyun 					    &rpf->entity.subdev.entity,
185*4882a593Smuzhiyun 					    RWPF_PAD_SINK,
186*4882a593Smuzhiyun 					    MEDIA_LNK_FL_ENABLED |
187*4882a593Smuzhiyun 					    MEDIA_LNK_FL_IMMUTABLE);
188*4882a593Smuzhiyun 		if (ret < 0)
189*4882a593Smuzhiyun 			return ret;
190*4882a593Smuzhiyun 	}
191*4882a593Smuzhiyun 
192*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->wpf_count; ++i) {
193*4882a593Smuzhiyun 		/*
194*4882a593Smuzhiyun 		 * Connect the video device to the WPF. All connections are
195*4882a593Smuzhiyun 		 * immutable.
196*4882a593Smuzhiyun 		 */
197*4882a593Smuzhiyun 		struct vsp1_rwpf *wpf = vsp1->wpf[i];
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun 		ret = media_create_pad_link(&wpf->entity.subdev.entity,
200*4882a593Smuzhiyun 					    RWPF_PAD_SOURCE,
201*4882a593Smuzhiyun 					    &wpf->video->video.entity, 0,
202*4882a593Smuzhiyun 					    MEDIA_LNK_FL_IMMUTABLE |
203*4882a593Smuzhiyun 					    MEDIA_LNK_FL_ENABLED);
204*4882a593Smuzhiyun 		if (ret < 0)
205*4882a593Smuzhiyun 			return ret;
206*4882a593Smuzhiyun 	}
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun 	return 0;
209*4882a593Smuzhiyun }
210*4882a593Smuzhiyun 
vsp1_destroy_entities(struct vsp1_device * vsp1)211*4882a593Smuzhiyun static void vsp1_destroy_entities(struct vsp1_device *vsp1)
212*4882a593Smuzhiyun {
213*4882a593Smuzhiyun 	struct vsp1_entity *entity, *_entity;
214*4882a593Smuzhiyun 	struct vsp1_video *video, *_video;
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 	list_for_each_entry_safe(entity, _entity, &vsp1->entities, list_dev) {
217*4882a593Smuzhiyun 		list_del(&entity->list_dev);
218*4882a593Smuzhiyun 		vsp1_entity_destroy(entity);
219*4882a593Smuzhiyun 	}
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun 	list_for_each_entry_safe(video, _video, &vsp1->videos, list) {
222*4882a593Smuzhiyun 		list_del(&video->list);
223*4882a593Smuzhiyun 		vsp1_video_cleanup(video);
224*4882a593Smuzhiyun 	}
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun 	v4l2_device_unregister(&vsp1->v4l2_dev);
227*4882a593Smuzhiyun 	if (vsp1->info->uapi)
228*4882a593Smuzhiyun 		media_device_unregister(&vsp1->media_dev);
229*4882a593Smuzhiyun 	media_device_cleanup(&vsp1->media_dev);
230*4882a593Smuzhiyun 
231*4882a593Smuzhiyun 	if (!vsp1->info->uapi)
232*4882a593Smuzhiyun 		vsp1_drm_cleanup(vsp1);
233*4882a593Smuzhiyun }
234*4882a593Smuzhiyun 
vsp1_create_entities(struct vsp1_device * vsp1)235*4882a593Smuzhiyun static int vsp1_create_entities(struct vsp1_device *vsp1)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun 	struct media_device *mdev = &vsp1->media_dev;
238*4882a593Smuzhiyun 	struct v4l2_device *vdev = &vsp1->v4l2_dev;
239*4882a593Smuzhiyun 	struct vsp1_entity *entity;
240*4882a593Smuzhiyun 	unsigned int i;
241*4882a593Smuzhiyun 	int ret;
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 	mdev->dev = vsp1->dev;
244*4882a593Smuzhiyun 	mdev->hw_revision = vsp1->version;
245*4882a593Smuzhiyun 	strscpy(mdev->model, vsp1->info->model, sizeof(mdev->model));
246*4882a593Smuzhiyun 	snprintf(mdev->bus_info, sizeof(mdev->bus_info), "platform:%s",
247*4882a593Smuzhiyun 		 dev_name(mdev->dev));
248*4882a593Smuzhiyun 	media_device_init(mdev);
249*4882a593Smuzhiyun 
250*4882a593Smuzhiyun 	vsp1->media_ops.link_setup = vsp1_entity_link_setup;
251*4882a593Smuzhiyun 	/*
252*4882a593Smuzhiyun 	 * Don't perform link validation when the userspace API is disabled as
253*4882a593Smuzhiyun 	 * the pipeline is configured internally by the driver in that case, and
254*4882a593Smuzhiyun 	 * its configuration can thus be trusted.
255*4882a593Smuzhiyun 	 */
256*4882a593Smuzhiyun 	if (vsp1->info->uapi)
257*4882a593Smuzhiyun 		vsp1->media_ops.link_validate = v4l2_subdev_link_validate;
258*4882a593Smuzhiyun 
259*4882a593Smuzhiyun 	vdev->mdev = mdev;
260*4882a593Smuzhiyun 	ret = v4l2_device_register(vsp1->dev, vdev);
261*4882a593Smuzhiyun 	if (ret < 0) {
262*4882a593Smuzhiyun 		dev_err(vsp1->dev, "V4L2 device registration failed (%d)\n",
263*4882a593Smuzhiyun 			ret);
264*4882a593Smuzhiyun 		goto done;
265*4882a593Smuzhiyun 	}
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun 	/* Instantiate all the entities. */
268*4882a593Smuzhiyun 	if (vsp1_feature(vsp1, VSP1_HAS_BRS)) {
269*4882a593Smuzhiyun 		vsp1->brs = vsp1_brx_create(vsp1, VSP1_ENTITY_BRS);
270*4882a593Smuzhiyun 		if (IS_ERR(vsp1->brs)) {
271*4882a593Smuzhiyun 			ret = PTR_ERR(vsp1->brs);
272*4882a593Smuzhiyun 			goto done;
273*4882a593Smuzhiyun 		}
274*4882a593Smuzhiyun 
275*4882a593Smuzhiyun 		list_add_tail(&vsp1->brs->entity.list_dev, &vsp1->entities);
276*4882a593Smuzhiyun 	}
277*4882a593Smuzhiyun 
278*4882a593Smuzhiyun 	if (vsp1_feature(vsp1, VSP1_HAS_BRU)) {
279*4882a593Smuzhiyun 		vsp1->bru = vsp1_brx_create(vsp1, VSP1_ENTITY_BRU);
280*4882a593Smuzhiyun 		if (IS_ERR(vsp1->bru)) {
281*4882a593Smuzhiyun 			ret = PTR_ERR(vsp1->bru);
282*4882a593Smuzhiyun 			goto done;
283*4882a593Smuzhiyun 		}
284*4882a593Smuzhiyun 
285*4882a593Smuzhiyun 		list_add_tail(&vsp1->bru->entity.list_dev, &vsp1->entities);
286*4882a593Smuzhiyun 	}
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	if (vsp1_feature(vsp1, VSP1_HAS_CLU)) {
289*4882a593Smuzhiyun 		vsp1->clu = vsp1_clu_create(vsp1);
290*4882a593Smuzhiyun 		if (IS_ERR(vsp1->clu)) {
291*4882a593Smuzhiyun 			ret = PTR_ERR(vsp1->clu);
292*4882a593Smuzhiyun 			goto done;
293*4882a593Smuzhiyun 		}
294*4882a593Smuzhiyun 
295*4882a593Smuzhiyun 		list_add_tail(&vsp1->clu->entity.list_dev, &vsp1->entities);
296*4882a593Smuzhiyun 	}
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun 	vsp1->hsi = vsp1_hsit_create(vsp1, true);
299*4882a593Smuzhiyun 	if (IS_ERR(vsp1->hsi)) {
300*4882a593Smuzhiyun 		ret = PTR_ERR(vsp1->hsi);
301*4882a593Smuzhiyun 		goto done;
302*4882a593Smuzhiyun 	}
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	list_add_tail(&vsp1->hsi->entity.list_dev, &vsp1->entities);
305*4882a593Smuzhiyun 
306*4882a593Smuzhiyun 	vsp1->hst = vsp1_hsit_create(vsp1, false);
307*4882a593Smuzhiyun 	if (IS_ERR(vsp1->hst)) {
308*4882a593Smuzhiyun 		ret = PTR_ERR(vsp1->hst);
309*4882a593Smuzhiyun 		goto done;
310*4882a593Smuzhiyun 	}
311*4882a593Smuzhiyun 
312*4882a593Smuzhiyun 	list_add_tail(&vsp1->hst->entity.list_dev, &vsp1->entities);
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 	if (vsp1_feature(vsp1, VSP1_HAS_HGO) && vsp1->info->uapi) {
315*4882a593Smuzhiyun 		vsp1->hgo = vsp1_hgo_create(vsp1);
316*4882a593Smuzhiyun 		if (IS_ERR(vsp1->hgo)) {
317*4882a593Smuzhiyun 			ret = PTR_ERR(vsp1->hgo);
318*4882a593Smuzhiyun 			goto done;
319*4882a593Smuzhiyun 		}
320*4882a593Smuzhiyun 
321*4882a593Smuzhiyun 		list_add_tail(&vsp1->hgo->histo.entity.list_dev,
322*4882a593Smuzhiyun 			      &vsp1->entities);
323*4882a593Smuzhiyun 	}
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	if (vsp1_feature(vsp1, VSP1_HAS_HGT) && vsp1->info->uapi) {
326*4882a593Smuzhiyun 		vsp1->hgt = vsp1_hgt_create(vsp1);
327*4882a593Smuzhiyun 		if (IS_ERR(vsp1->hgt)) {
328*4882a593Smuzhiyun 			ret = PTR_ERR(vsp1->hgt);
329*4882a593Smuzhiyun 			goto done;
330*4882a593Smuzhiyun 		}
331*4882a593Smuzhiyun 
332*4882a593Smuzhiyun 		list_add_tail(&vsp1->hgt->histo.entity.list_dev,
333*4882a593Smuzhiyun 			      &vsp1->entities);
334*4882a593Smuzhiyun 	}
335*4882a593Smuzhiyun 
336*4882a593Smuzhiyun 	/*
337*4882a593Smuzhiyun 	 * The LIFs are only supported when used in conjunction with the DU, in
338*4882a593Smuzhiyun 	 * which case the userspace API is disabled. If the userspace API is
339*4882a593Smuzhiyun 	 * enabled skip the LIFs, even when present.
340*4882a593Smuzhiyun 	 */
341*4882a593Smuzhiyun 	if (!vsp1->info->uapi) {
342*4882a593Smuzhiyun 		for (i = 0; i < vsp1->info->lif_count; ++i) {
343*4882a593Smuzhiyun 			struct vsp1_lif *lif;
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun 			lif = vsp1_lif_create(vsp1, i);
346*4882a593Smuzhiyun 			if (IS_ERR(lif)) {
347*4882a593Smuzhiyun 				ret = PTR_ERR(lif);
348*4882a593Smuzhiyun 				goto done;
349*4882a593Smuzhiyun 			}
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun 			vsp1->lif[i] = lif;
352*4882a593Smuzhiyun 			list_add_tail(&lif->entity.list_dev, &vsp1->entities);
353*4882a593Smuzhiyun 		}
354*4882a593Smuzhiyun 	}
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 	if (vsp1_feature(vsp1, VSP1_HAS_LUT)) {
357*4882a593Smuzhiyun 		vsp1->lut = vsp1_lut_create(vsp1);
358*4882a593Smuzhiyun 		if (IS_ERR(vsp1->lut)) {
359*4882a593Smuzhiyun 			ret = PTR_ERR(vsp1->lut);
360*4882a593Smuzhiyun 			goto done;
361*4882a593Smuzhiyun 		}
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 		list_add_tail(&vsp1->lut->entity.list_dev, &vsp1->entities);
364*4882a593Smuzhiyun 	}
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->rpf_count; ++i) {
367*4882a593Smuzhiyun 		struct vsp1_rwpf *rpf;
368*4882a593Smuzhiyun 
369*4882a593Smuzhiyun 		rpf = vsp1_rpf_create(vsp1, i);
370*4882a593Smuzhiyun 		if (IS_ERR(rpf)) {
371*4882a593Smuzhiyun 			ret = PTR_ERR(rpf);
372*4882a593Smuzhiyun 			goto done;
373*4882a593Smuzhiyun 		}
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun 		vsp1->rpf[i] = rpf;
376*4882a593Smuzhiyun 		list_add_tail(&rpf->entity.list_dev, &vsp1->entities);
377*4882a593Smuzhiyun 
378*4882a593Smuzhiyun 		if (vsp1->info->uapi) {
379*4882a593Smuzhiyun 			struct vsp1_video *video = vsp1_video_create(vsp1, rpf);
380*4882a593Smuzhiyun 
381*4882a593Smuzhiyun 			if (IS_ERR(video)) {
382*4882a593Smuzhiyun 				ret = PTR_ERR(video);
383*4882a593Smuzhiyun 				goto done;
384*4882a593Smuzhiyun 			}
385*4882a593Smuzhiyun 
386*4882a593Smuzhiyun 			list_add_tail(&video->list, &vsp1->videos);
387*4882a593Smuzhiyun 		}
388*4882a593Smuzhiyun 	}
389*4882a593Smuzhiyun 
390*4882a593Smuzhiyun 	if (vsp1_feature(vsp1, VSP1_HAS_SRU)) {
391*4882a593Smuzhiyun 		vsp1->sru = vsp1_sru_create(vsp1);
392*4882a593Smuzhiyun 		if (IS_ERR(vsp1->sru)) {
393*4882a593Smuzhiyun 			ret = PTR_ERR(vsp1->sru);
394*4882a593Smuzhiyun 			goto done;
395*4882a593Smuzhiyun 		}
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun 		list_add_tail(&vsp1->sru->entity.list_dev, &vsp1->entities);
398*4882a593Smuzhiyun 	}
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->uds_count; ++i) {
401*4882a593Smuzhiyun 		struct vsp1_uds *uds;
402*4882a593Smuzhiyun 
403*4882a593Smuzhiyun 		uds = vsp1_uds_create(vsp1, i);
404*4882a593Smuzhiyun 		if (IS_ERR(uds)) {
405*4882a593Smuzhiyun 			ret = PTR_ERR(uds);
406*4882a593Smuzhiyun 			goto done;
407*4882a593Smuzhiyun 		}
408*4882a593Smuzhiyun 
409*4882a593Smuzhiyun 		vsp1->uds[i] = uds;
410*4882a593Smuzhiyun 		list_add_tail(&uds->entity.list_dev, &vsp1->entities);
411*4882a593Smuzhiyun 	}
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->uif_count; ++i) {
414*4882a593Smuzhiyun 		struct vsp1_uif *uif;
415*4882a593Smuzhiyun 
416*4882a593Smuzhiyun 		uif = vsp1_uif_create(vsp1, i);
417*4882a593Smuzhiyun 		if (IS_ERR(uif)) {
418*4882a593Smuzhiyun 			ret = PTR_ERR(uif);
419*4882a593Smuzhiyun 			goto done;
420*4882a593Smuzhiyun 		}
421*4882a593Smuzhiyun 
422*4882a593Smuzhiyun 		vsp1->uif[i] = uif;
423*4882a593Smuzhiyun 		list_add_tail(&uif->entity.list_dev, &vsp1->entities);
424*4882a593Smuzhiyun 	}
425*4882a593Smuzhiyun 
426*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->wpf_count; ++i) {
427*4882a593Smuzhiyun 		struct vsp1_rwpf *wpf;
428*4882a593Smuzhiyun 
429*4882a593Smuzhiyun 		wpf = vsp1_wpf_create(vsp1, i);
430*4882a593Smuzhiyun 		if (IS_ERR(wpf)) {
431*4882a593Smuzhiyun 			ret = PTR_ERR(wpf);
432*4882a593Smuzhiyun 			goto done;
433*4882a593Smuzhiyun 		}
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun 		vsp1->wpf[i] = wpf;
436*4882a593Smuzhiyun 		list_add_tail(&wpf->entity.list_dev, &vsp1->entities);
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun 		if (vsp1->info->uapi) {
439*4882a593Smuzhiyun 			struct vsp1_video *video = vsp1_video_create(vsp1, wpf);
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun 			if (IS_ERR(video)) {
442*4882a593Smuzhiyun 				ret = PTR_ERR(video);
443*4882a593Smuzhiyun 				goto done;
444*4882a593Smuzhiyun 			}
445*4882a593Smuzhiyun 
446*4882a593Smuzhiyun 			list_add_tail(&video->list, &vsp1->videos);
447*4882a593Smuzhiyun 		}
448*4882a593Smuzhiyun 	}
449*4882a593Smuzhiyun 
450*4882a593Smuzhiyun 	/* Register all subdevs. */
451*4882a593Smuzhiyun 	list_for_each_entry(entity, &vsp1->entities, list_dev) {
452*4882a593Smuzhiyun 		ret = v4l2_device_register_subdev(&vsp1->v4l2_dev,
453*4882a593Smuzhiyun 						  &entity->subdev);
454*4882a593Smuzhiyun 		if (ret < 0)
455*4882a593Smuzhiyun 			goto done;
456*4882a593Smuzhiyun 	}
457*4882a593Smuzhiyun 
458*4882a593Smuzhiyun 	/*
459*4882a593Smuzhiyun 	 * Create links and register subdev nodes if the userspace API is
460*4882a593Smuzhiyun 	 * enabled or initialize the DRM pipeline otherwise.
461*4882a593Smuzhiyun 	 */
462*4882a593Smuzhiyun 	if (vsp1->info->uapi) {
463*4882a593Smuzhiyun 		ret = vsp1_uapi_create_links(vsp1);
464*4882a593Smuzhiyun 		if (ret < 0)
465*4882a593Smuzhiyun 			goto done;
466*4882a593Smuzhiyun 
467*4882a593Smuzhiyun 		ret = v4l2_device_register_subdev_nodes(&vsp1->v4l2_dev);
468*4882a593Smuzhiyun 		if (ret < 0)
469*4882a593Smuzhiyun 			goto done;
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 		ret = media_device_register(mdev);
472*4882a593Smuzhiyun 	} else {
473*4882a593Smuzhiyun 		ret = vsp1_drm_init(vsp1);
474*4882a593Smuzhiyun 	}
475*4882a593Smuzhiyun 
476*4882a593Smuzhiyun done:
477*4882a593Smuzhiyun 	if (ret < 0)
478*4882a593Smuzhiyun 		vsp1_destroy_entities(vsp1);
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun 	return ret;
481*4882a593Smuzhiyun }
482*4882a593Smuzhiyun 
vsp1_reset_wpf(struct vsp1_device * vsp1,unsigned int index)483*4882a593Smuzhiyun int vsp1_reset_wpf(struct vsp1_device *vsp1, unsigned int index)
484*4882a593Smuzhiyun {
485*4882a593Smuzhiyun 	unsigned int timeout;
486*4882a593Smuzhiyun 	u32 status;
487*4882a593Smuzhiyun 
488*4882a593Smuzhiyun 	status = vsp1_read(vsp1, VI6_STATUS);
489*4882a593Smuzhiyun 	if (!(status & VI6_STATUS_SYS_ACT(index)))
490*4882a593Smuzhiyun 		return 0;
491*4882a593Smuzhiyun 
492*4882a593Smuzhiyun 	vsp1_write(vsp1, VI6_SRESET, VI6_SRESET_SRTS(index));
493*4882a593Smuzhiyun 	for (timeout = 10; timeout > 0; --timeout) {
494*4882a593Smuzhiyun 		status = vsp1_read(vsp1, VI6_STATUS);
495*4882a593Smuzhiyun 		if (!(status & VI6_STATUS_SYS_ACT(index)))
496*4882a593Smuzhiyun 			break;
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 		usleep_range(1000, 2000);
499*4882a593Smuzhiyun 	}
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun 	if (!timeout) {
502*4882a593Smuzhiyun 		dev_err(vsp1->dev, "failed to reset wpf.%u\n", index);
503*4882a593Smuzhiyun 		return -ETIMEDOUT;
504*4882a593Smuzhiyun 	}
505*4882a593Smuzhiyun 
506*4882a593Smuzhiyun 	return 0;
507*4882a593Smuzhiyun }
508*4882a593Smuzhiyun 
vsp1_device_init(struct vsp1_device * vsp1)509*4882a593Smuzhiyun static int vsp1_device_init(struct vsp1_device *vsp1)
510*4882a593Smuzhiyun {
511*4882a593Smuzhiyun 	unsigned int i;
512*4882a593Smuzhiyun 	int ret;
513*4882a593Smuzhiyun 
514*4882a593Smuzhiyun 	/* Reset any channel that might be running. */
515*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->wpf_count; ++i) {
516*4882a593Smuzhiyun 		ret = vsp1_reset_wpf(vsp1, i);
517*4882a593Smuzhiyun 		if (ret < 0)
518*4882a593Smuzhiyun 			return ret;
519*4882a593Smuzhiyun 	}
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	vsp1_write(vsp1, VI6_CLK_DCSWT, (8 << VI6_CLK_DCSWT_CSTPW_SHIFT) |
522*4882a593Smuzhiyun 		   (8 << VI6_CLK_DCSWT_CSTRW_SHIFT));
523*4882a593Smuzhiyun 
524*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->rpf_count; ++i)
525*4882a593Smuzhiyun 		vsp1_write(vsp1, VI6_DPR_RPF_ROUTE(i), VI6_DPR_NODE_UNUSED);
526*4882a593Smuzhiyun 
527*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->uds_count; ++i)
528*4882a593Smuzhiyun 		vsp1_write(vsp1, VI6_DPR_UDS_ROUTE(i), VI6_DPR_NODE_UNUSED);
529*4882a593Smuzhiyun 
530*4882a593Smuzhiyun 	for (i = 0; i < vsp1->info->uif_count; ++i)
531*4882a593Smuzhiyun 		vsp1_write(vsp1, VI6_DPR_UIF_ROUTE(i), VI6_DPR_NODE_UNUSED);
532*4882a593Smuzhiyun 
533*4882a593Smuzhiyun 	vsp1_write(vsp1, VI6_DPR_SRU_ROUTE, VI6_DPR_NODE_UNUSED);
534*4882a593Smuzhiyun 	vsp1_write(vsp1, VI6_DPR_LUT_ROUTE, VI6_DPR_NODE_UNUSED);
535*4882a593Smuzhiyun 	vsp1_write(vsp1, VI6_DPR_CLU_ROUTE, VI6_DPR_NODE_UNUSED);
536*4882a593Smuzhiyun 	vsp1_write(vsp1, VI6_DPR_HST_ROUTE, VI6_DPR_NODE_UNUSED);
537*4882a593Smuzhiyun 	vsp1_write(vsp1, VI6_DPR_HSI_ROUTE, VI6_DPR_NODE_UNUSED);
538*4882a593Smuzhiyun 	vsp1_write(vsp1, VI6_DPR_BRU_ROUTE, VI6_DPR_NODE_UNUSED);
539*4882a593Smuzhiyun 
540*4882a593Smuzhiyun 	if (vsp1_feature(vsp1, VSP1_HAS_BRS))
541*4882a593Smuzhiyun 		vsp1_write(vsp1, VI6_DPR_ILV_BRS_ROUTE, VI6_DPR_NODE_UNUSED);
542*4882a593Smuzhiyun 
543*4882a593Smuzhiyun 	vsp1_write(vsp1, VI6_DPR_HGO_SMPPT, (7 << VI6_DPR_SMPPT_TGW_SHIFT) |
544*4882a593Smuzhiyun 		   (VI6_DPR_NODE_UNUSED << VI6_DPR_SMPPT_PT_SHIFT));
545*4882a593Smuzhiyun 	vsp1_write(vsp1, VI6_DPR_HGT_SMPPT, (7 << VI6_DPR_SMPPT_TGW_SHIFT) |
546*4882a593Smuzhiyun 		   (VI6_DPR_NODE_UNUSED << VI6_DPR_SMPPT_PT_SHIFT));
547*4882a593Smuzhiyun 
548*4882a593Smuzhiyun 	vsp1_dlm_setup(vsp1);
549*4882a593Smuzhiyun 
550*4882a593Smuzhiyun 	return 0;
551*4882a593Smuzhiyun }
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun /*
554*4882a593Smuzhiyun  * vsp1_device_get - Acquire the VSP1 device
555*4882a593Smuzhiyun  *
556*4882a593Smuzhiyun  * Make sure the device is not suspended and initialize it if needed.
557*4882a593Smuzhiyun  *
558*4882a593Smuzhiyun  * Return 0 on success or a negative error code otherwise.
559*4882a593Smuzhiyun  */
vsp1_device_get(struct vsp1_device * vsp1)560*4882a593Smuzhiyun int vsp1_device_get(struct vsp1_device *vsp1)
561*4882a593Smuzhiyun {
562*4882a593Smuzhiyun 	int ret;
563*4882a593Smuzhiyun 
564*4882a593Smuzhiyun 	ret = pm_runtime_get_sync(vsp1->dev);
565*4882a593Smuzhiyun 	if (ret < 0) {
566*4882a593Smuzhiyun 		pm_runtime_put_noidle(vsp1->dev);
567*4882a593Smuzhiyun 		return ret;
568*4882a593Smuzhiyun 	}
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun 	return 0;
571*4882a593Smuzhiyun }
572*4882a593Smuzhiyun 
573*4882a593Smuzhiyun /*
574*4882a593Smuzhiyun  * vsp1_device_put - Release the VSP1 device
575*4882a593Smuzhiyun  *
576*4882a593Smuzhiyun  * Decrement the VSP1 reference count and cleanup the device if the last
577*4882a593Smuzhiyun  * reference is released.
578*4882a593Smuzhiyun  */
vsp1_device_put(struct vsp1_device * vsp1)579*4882a593Smuzhiyun void vsp1_device_put(struct vsp1_device *vsp1)
580*4882a593Smuzhiyun {
581*4882a593Smuzhiyun 	pm_runtime_put_sync(vsp1->dev);
582*4882a593Smuzhiyun }
583*4882a593Smuzhiyun 
584*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
585*4882a593Smuzhiyun  * Power Management
586*4882a593Smuzhiyun  */
587*4882a593Smuzhiyun 
vsp1_pm_suspend(struct device * dev)588*4882a593Smuzhiyun static int __maybe_unused vsp1_pm_suspend(struct device *dev)
589*4882a593Smuzhiyun {
590*4882a593Smuzhiyun 	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
591*4882a593Smuzhiyun 
592*4882a593Smuzhiyun 	/*
593*4882a593Smuzhiyun 	 * When used as part of a display pipeline, the VSP is stopped and
594*4882a593Smuzhiyun 	 * restarted explicitly by the DU.
595*4882a593Smuzhiyun 	 */
596*4882a593Smuzhiyun 	if (!vsp1->drm)
597*4882a593Smuzhiyun 		vsp1_video_suspend(vsp1);
598*4882a593Smuzhiyun 
599*4882a593Smuzhiyun 	pm_runtime_force_suspend(vsp1->dev);
600*4882a593Smuzhiyun 
601*4882a593Smuzhiyun 	return 0;
602*4882a593Smuzhiyun }
603*4882a593Smuzhiyun 
vsp1_pm_resume(struct device * dev)604*4882a593Smuzhiyun static int __maybe_unused vsp1_pm_resume(struct device *dev)
605*4882a593Smuzhiyun {
606*4882a593Smuzhiyun 	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
607*4882a593Smuzhiyun 
608*4882a593Smuzhiyun 	pm_runtime_force_resume(vsp1->dev);
609*4882a593Smuzhiyun 
610*4882a593Smuzhiyun 	/*
611*4882a593Smuzhiyun 	 * When used as part of a display pipeline, the VSP is stopped and
612*4882a593Smuzhiyun 	 * restarted explicitly by the DU.
613*4882a593Smuzhiyun 	 */
614*4882a593Smuzhiyun 	if (!vsp1->drm)
615*4882a593Smuzhiyun 		vsp1_video_resume(vsp1);
616*4882a593Smuzhiyun 
617*4882a593Smuzhiyun 	return 0;
618*4882a593Smuzhiyun }
619*4882a593Smuzhiyun 
vsp1_pm_runtime_suspend(struct device * dev)620*4882a593Smuzhiyun static int __maybe_unused vsp1_pm_runtime_suspend(struct device *dev)
621*4882a593Smuzhiyun {
622*4882a593Smuzhiyun 	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 	rcar_fcp_disable(vsp1->fcp);
625*4882a593Smuzhiyun 
626*4882a593Smuzhiyun 	return 0;
627*4882a593Smuzhiyun }
628*4882a593Smuzhiyun 
vsp1_pm_runtime_resume(struct device * dev)629*4882a593Smuzhiyun static int __maybe_unused vsp1_pm_runtime_resume(struct device *dev)
630*4882a593Smuzhiyun {
631*4882a593Smuzhiyun 	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
632*4882a593Smuzhiyun 	int ret;
633*4882a593Smuzhiyun 
634*4882a593Smuzhiyun 	if (vsp1->info) {
635*4882a593Smuzhiyun 		ret = vsp1_device_init(vsp1);
636*4882a593Smuzhiyun 		if (ret < 0)
637*4882a593Smuzhiyun 			return ret;
638*4882a593Smuzhiyun 	}
639*4882a593Smuzhiyun 
640*4882a593Smuzhiyun 	return rcar_fcp_enable(vsp1->fcp);
641*4882a593Smuzhiyun }
642*4882a593Smuzhiyun 
643*4882a593Smuzhiyun static const struct dev_pm_ops vsp1_pm_ops = {
644*4882a593Smuzhiyun 	SET_SYSTEM_SLEEP_PM_OPS(vsp1_pm_suspend, vsp1_pm_resume)
645*4882a593Smuzhiyun 	SET_RUNTIME_PM_OPS(vsp1_pm_runtime_suspend, vsp1_pm_runtime_resume, NULL)
646*4882a593Smuzhiyun };
647*4882a593Smuzhiyun 
648*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
649*4882a593Smuzhiyun  * Platform Driver
650*4882a593Smuzhiyun  */
651*4882a593Smuzhiyun 
652*4882a593Smuzhiyun static const struct vsp1_device_info vsp1_device_infos[] = {
653*4882a593Smuzhiyun 	{
654*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPS_H2,
655*4882a593Smuzhiyun 		.model = "VSP1-S",
656*4882a593Smuzhiyun 		.gen = 2,
657*4882a593Smuzhiyun 		.features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_HGO
658*4882a593Smuzhiyun 			  | VSP1_HAS_HGT | VSP1_HAS_LUT | VSP1_HAS_SRU
659*4882a593Smuzhiyun 			  | VSP1_HAS_WPF_VFLIP,
660*4882a593Smuzhiyun 		.rpf_count = 5,
661*4882a593Smuzhiyun 		.uds_count = 3,
662*4882a593Smuzhiyun 		.wpf_count = 4,
663*4882a593Smuzhiyun 		.num_bru_inputs = 4,
664*4882a593Smuzhiyun 		.uapi = true,
665*4882a593Smuzhiyun 	}, {
666*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPR_H2,
667*4882a593Smuzhiyun 		.model = "VSP1-R",
668*4882a593Smuzhiyun 		.gen = 2,
669*4882a593Smuzhiyun 		.features = VSP1_HAS_BRU | VSP1_HAS_SRU | VSP1_HAS_WPF_VFLIP,
670*4882a593Smuzhiyun 		.rpf_count = 5,
671*4882a593Smuzhiyun 		.uds_count = 3,
672*4882a593Smuzhiyun 		.wpf_count = 4,
673*4882a593Smuzhiyun 		.num_bru_inputs = 4,
674*4882a593Smuzhiyun 		.uapi = true,
675*4882a593Smuzhiyun 	}, {
676*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPD_GEN2,
677*4882a593Smuzhiyun 		.model = "VSP1-D",
678*4882a593Smuzhiyun 		.gen = 2,
679*4882a593Smuzhiyun 		.features = VSP1_HAS_BRU | VSP1_HAS_HGO | VSP1_HAS_LUT,
680*4882a593Smuzhiyun 		.lif_count = 1,
681*4882a593Smuzhiyun 		.rpf_count = 4,
682*4882a593Smuzhiyun 		.uds_count = 1,
683*4882a593Smuzhiyun 		.wpf_count = 1,
684*4882a593Smuzhiyun 		.num_bru_inputs = 4,
685*4882a593Smuzhiyun 		.uapi = true,
686*4882a593Smuzhiyun 	}, {
687*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPS_M2,
688*4882a593Smuzhiyun 		.model = "VSP1-S",
689*4882a593Smuzhiyun 		.gen = 2,
690*4882a593Smuzhiyun 		.features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_HGO
691*4882a593Smuzhiyun 			  | VSP1_HAS_HGT | VSP1_HAS_LUT | VSP1_HAS_SRU
692*4882a593Smuzhiyun 			  | VSP1_HAS_WPF_VFLIP,
693*4882a593Smuzhiyun 		.rpf_count = 5,
694*4882a593Smuzhiyun 		.uds_count = 1,
695*4882a593Smuzhiyun 		.wpf_count = 4,
696*4882a593Smuzhiyun 		.num_bru_inputs = 4,
697*4882a593Smuzhiyun 		.uapi = true,
698*4882a593Smuzhiyun 	}, {
699*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPS_V2H,
700*4882a593Smuzhiyun 		.model = "VSP1V-S",
701*4882a593Smuzhiyun 		.gen = 2,
702*4882a593Smuzhiyun 		.features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_LUT
703*4882a593Smuzhiyun 			  | VSP1_HAS_SRU | VSP1_HAS_WPF_VFLIP,
704*4882a593Smuzhiyun 		.rpf_count = 4,
705*4882a593Smuzhiyun 		.uds_count = 1,
706*4882a593Smuzhiyun 		.wpf_count = 4,
707*4882a593Smuzhiyun 		.num_bru_inputs = 4,
708*4882a593Smuzhiyun 		.uapi = true,
709*4882a593Smuzhiyun 	}, {
710*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPD_V2H,
711*4882a593Smuzhiyun 		.model = "VSP1V-D",
712*4882a593Smuzhiyun 		.gen = 2,
713*4882a593Smuzhiyun 		.features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_LUT,
714*4882a593Smuzhiyun 		.lif_count = 1,
715*4882a593Smuzhiyun 		.rpf_count = 4,
716*4882a593Smuzhiyun 		.uds_count = 1,
717*4882a593Smuzhiyun 		.wpf_count = 1,
718*4882a593Smuzhiyun 		.num_bru_inputs = 4,
719*4882a593Smuzhiyun 		.uapi = true,
720*4882a593Smuzhiyun 	}, {
721*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPI_GEN3,
722*4882a593Smuzhiyun 		.model = "VSP2-I",
723*4882a593Smuzhiyun 		.gen = 3,
724*4882a593Smuzhiyun 		.features = VSP1_HAS_CLU | VSP1_HAS_HGO | VSP1_HAS_HGT
725*4882a593Smuzhiyun 			  | VSP1_HAS_LUT | VSP1_HAS_SRU | VSP1_HAS_WPF_HFLIP
726*4882a593Smuzhiyun 			  | VSP1_HAS_WPF_VFLIP,
727*4882a593Smuzhiyun 		.rpf_count = 1,
728*4882a593Smuzhiyun 		.uds_count = 1,
729*4882a593Smuzhiyun 		.wpf_count = 1,
730*4882a593Smuzhiyun 		.uapi = true,
731*4882a593Smuzhiyun 	}, {
732*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPBD_GEN3,
733*4882a593Smuzhiyun 		.model = "VSP2-BD",
734*4882a593Smuzhiyun 		.gen = 3,
735*4882a593Smuzhiyun 		.features = VSP1_HAS_BRU | VSP1_HAS_WPF_VFLIP,
736*4882a593Smuzhiyun 		.rpf_count = 5,
737*4882a593Smuzhiyun 		.wpf_count = 1,
738*4882a593Smuzhiyun 		.num_bru_inputs = 5,
739*4882a593Smuzhiyun 		.uapi = true,
740*4882a593Smuzhiyun 	}, {
741*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPBC_GEN3,
742*4882a593Smuzhiyun 		.model = "VSP2-BC",
743*4882a593Smuzhiyun 		.gen = 3,
744*4882a593Smuzhiyun 		.features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_HGO
745*4882a593Smuzhiyun 			  | VSP1_HAS_LUT | VSP1_HAS_WPF_VFLIP,
746*4882a593Smuzhiyun 		.rpf_count = 5,
747*4882a593Smuzhiyun 		.wpf_count = 1,
748*4882a593Smuzhiyun 		.num_bru_inputs = 5,
749*4882a593Smuzhiyun 		.uapi = true,
750*4882a593Smuzhiyun 	}, {
751*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPBS_GEN3,
752*4882a593Smuzhiyun 		.model = "VSP2-BS",
753*4882a593Smuzhiyun 		.gen = 3,
754*4882a593Smuzhiyun 		.features = VSP1_HAS_BRS | VSP1_HAS_WPF_VFLIP,
755*4882a593Smuzhiyun 		.rpf_count = 2,
756*4882a593Smuzhiyun 		.wpf_count = 1,
757*4882a593Smuzhiyun 		.uapi = true,
758*4882a593Smuzhiyun 	}, {
759*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPD_GEN3,
760*4882a593Smuzhiyun 		.model = "VSP2-D",
761*4882a593Smuzhiyun 		.gen = 3,
762*4882a593Smuzhiyun 		.features = VSP1_HAS_BRU | VSP1_HAS_WPF_VFLIP | VSP1_HAS_EXT_DL,
763*4882a593Smuzhiyun 		.lif_count = 1,
764*4882a593Smuzhiyun 		.rpf_count = 5,
765*4882a593Smuzhiyun 		.uif_count = 1,
766*4882a593Smuzhiyun 		.wpf_count = 2,
767*4882a593Smuzhiyun 		.num_bru_inputs = 5,
768*4882a593Smuzhiyun 	}, {
769*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPD_V3,
770*4882a593Smuzhiyun 		.model = "VSP2-D",
771*4882a593Smuzhiyun 		.gen = 3,
772*4882a593Smuzhiyun 		.features = VSP1_HAS_BRS | VSP1_HAS_BRU,
773*4882a593Smuzhiyun 		.lif_count = 1,
774*4882a593Smuzhiyun 		.rpf_count = 5,
775*4882a593Smuzhiyun 		.uif_count = 1,
776*4882a593Smuzhiyun 		.wpf_count = 1,
777*4882a593Smuzhiyun 		.num_bru_inputs = 5,
778*4882a593Smuzhiyun 	}, {
779*4882a593Smuzhiyun 		.version = VI6_IP_VERSION_MODEL_VSPDL_GEN3,
780*4882a593Smuzhiyun 		.model = "VSP2-DL",
781*4882a593Smuzhiyun 		.gen = 3,
782*4882a593Smuzhiyun 		.features = VSP1_HAS_BRS | VSP1_HAS_BRU | VSP1_HAS_EXT_DL,
783*4882a593Smuzhiyun 		.lif_count = 2,
784*4882a593Smuzhiyun 		.rpf_count = 5,
785*4882a593Smuzhiyun 		.uif_count = 2,
786*4882a593Smuzhiyun 		.wpf_count = 2,
787*4882a593Smuzhiyun 		.num_bru_inputs = 5,
788*4882a593Smuzhiyun 	},
789*4882a593Smuzhiyun };
790*4882a593Smuzhiyun 
vsp1_probe(struct platform_device * pdev)791*4882a593Smuzhiyun static int vsp1_probe(struct platform_device *pdev)
792*4882a593Smuzhiyun {
793*4882a593Smuzhiyun 	struct vsp1_device *vsp1;
794*4882a593Smuzhiyun 	struct device_node *fcp_node;
795*4882a593Smuzhiyun 	struct resource *irq;
796*4882a593Smuzhiyun 	struct resource *io;
797*4882a593Smuzhiyun 	unsigned int i;
798*4882a593Smuzhiyun 	int ret;
799*4882a593Smuzhiyun 
800*4882a593Smuzhiyun 	vsp1 = devm_kzalloc(&pdev->dev, sizeof(*vsp1), GFP_KERNEL);
801*4882a593Smuzhiyun 	if (vsp1 == NULL)
802*4882a593Smuzhiyun 		return -ENOMEM;
803*4882a593Smuzhiyun 
804*4882a593Smuzhiyun 	vsp1->dev = &pdev->dev;
805*4882a593Smuzhiyun 	INIT_LIST_HEAD(&vsp1->entities);
806*4882a593Smuzhiyun 	INIT_LIST_HEAD(&vsp1->videos);
807*4882a593Smuzhiyun 
808*4882a593Smuzhiyun 	platform_set_drvdata(pdev, vsp1);
809*4882a593Smuzhiyun 
810*4882a593Smuzhiyun 	/* I/O and IRQ resources (clock managed by the clock PM domain). */
811*4882a593Smuzhiyun 	io = platform_get_resource(pdev, IORESOURCE_MEM, 0);
812*4882a593Smuzhiyun 	vsp1->mmio = devm_ioremap_resource(&pdev->dev, io);
813*4882a593Smuzhiyun 	if (IS_ERR(vsp1->mmio))
814*4882a593Smuzhiyun 		return PTR_ERR(vsp1->mmio);
815*4882a593Smuzhiyun 
816*4882a593Smuzhiyun 	irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
817*4882a593Smuzhiyun 	if (!irq) {
818*4882a593Smuzhiyun 		dev_err(&pdev->dev, "missing IRQ\n");
819*4882a593Smuzhiyun 		return -EINVAL;
820*4882a593Smuzhiyun 	}
821*4882a593Smuzhiyun 
822*4882a593Smuzhiyun 	ret = devm_request_irq(&pdev->dev, irq->start, vsp1_irq_handler,
823*4882a593Smuzhiyun 			      IRQF_SHARED, dev_name(&pdev->dev), vsp1);
824*4882a593Smuzhiyun 	if (ret < 0) {
825*4882a593Smuzhiyun 		dev_err(&pdev->dev, "failed to request IRQ\n");
826*4882a593Smuzhiyun 		return ret;
827*4882a593Smuzhiyun 	}
828*4882a593Smuzhiyun 
829*4882a593Smuzhiyun 	/* FCP (optional). */
830*4882a593Smuzhiyun 	fcp_node = of_parse_phandle(pdev->dev.of_node, "renesas,fcp", 0);
831*4882a593Smuzhiyun 	if (fcp_node) {
832*4882a593Smuzhiyun 		vsp1->fcp = rcar_fcp_get(fcp_node);
833*4882a593Smuzhiyun 		of_node_put(fcp_node);
834*4882a593Smuzhiyun 		if (IS_ERR(vsp1->fcp)) {
835*4882a593Smuzhiyun 			dev_dbg(&pdev->dev, "FCP not found (%ld)\n",
836*4882a593Smuzhiyun 				PTR_ERR(vsp1->fcp));
837*4882a593Smuzhiyun 			return PTR_ERR(vsp1->fcp);
838*4882a593Smuzhiyun 		}
839*4882a593Smuzhiyun 
840*4882a593Smuzhiyun 		/*
841*4882a593Smuzhiyun 		 * When the FCP is present, it handles all bus master accesses
842*4882a593Smuzhiyun 		 * for the VSP and must thus be used in place of the VSP device
843*4882a593Smuzhiyun 		 * to map DMA buffers.
844*4882a593Smuzhiyun 		 */
845*4882a593Smuzhiyun 		vsp1->bus_master = rcar_fcp_get_device(vsp1->fcp);
846*4882a593Smuzhiyun 	} else {
847*4882a593Smuzhiyun 		vsp1->bus_master = vsp1->dev;
848*4882a593Smuzhiyun 	}
849*4882a593Smuzhiyun 
850*4882a593Smuzhiyun 	/* Configure device parameters based on the version register. */
851*4882a593Smuzhiyun 	pm_runtime_enable(&pdev->dev);
852*4882a593Smuzhiyun 
853*4882a593Smuzhiyun 	ret = vsp1_device_get(vsp1);
854*4882a593Smuzhiyun 	if (ret < 0)
855*4882a593Smuzhiyun 		goto done;
856*4882a593Smuzhiyun 
857*4882a593Smuzhiyun 	vsp1->version = vsp1_read(vsp1, VI6_IP_VERSION);
858*4882a593Smuzhiyun 	vsp1_device_put(vsp1);
859*4882a593Smuzhiyun 
860*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(vsp1_device_infos); ++i) {
861*4882a593Smuzhiyun 		if ((vsp1->version & VI6_IP_VERSION_MODEL_MASK) ==
862*4882a593Smuzhiyun 		    vsp1_device_infos[i].version) {
863*4882a593Smuzhiyun 			vsp1->info = &vsp1_device_infos[i];
864*4882a593Smuzhiyun 			break;
865*4882a593Smuzhiyun 		}
866*4882a593Smuzhiyun 	}
867*4882a593Smuzhiyun 
868*4882a593Smuzhiyun 	if (!vsp1->info) {
869*4882a593Smuzhiyun 		dev_err(&pdev->dev, "unsupported IP version 0x%08x\n",
870*4882a593Smuzhiyun 			vsp1->version);
871*4882a593Smuzhiyun 		ret = -ENXIO;
872*4882a593Smuzhiyun 		goto done;
873*4882a593Smuzhiyun 	}
874*4882a593Smuzhiyun 
875*4882a593Smuzhiyun 	dev_dbg(&pdev->dev, "IP version 0x%08x\n", vsp1->version);
876*4882a593Smuzhiyun 
877*4882a593Smuzhiyun 	/* Instantiate entities. */
878*4882a593Smuzhiyun 	ret = vsp1_create_entities(vsp1);
879*4882a593Smuzhiyun 	if (ret < 0) {
880*4882a593Smuzhiyun 		dev_err(&pdev->dev, "failed to create entities\n");
881*4882a593Smuzhiyun 		goto done;
882*4882a593Smuzhiyun 	}
883*4882a593Smuzhiyun 
884*4882a593Smuzhiyun done:
885*4882a593Smuzhiyun 	if (ret) {
886*4882a593Smuzhiyun 		pm_runtime_disable(&pdev->dev);
887*4882a593Smuzhiyun 		rcar_fcp_put(vsp1->fcp);
888*4882a593Smuzhiyun 	}
889*4882a593Smuzhiyun 
890*4882a593Smuzhiyun 	return ret;
891*4882a593Smuzhiyun }
892*4882a593Smuzhiyun 
vsp1_remove(struct platform_device * pdev)893*4882a593Smuzhiyun static int vsp1_remove(struct platform_device *pdev)
894*4882a593Smuzhiyun {
895*4882a593Smuzhiyun 	struct vsp1_device *vsp1 = platform_get_drvdata(pdev);
896*4882a593Smuzhiyun 
897*4882a593Smuzhiyun 	vsp1_destroy_entities(vsp1);
898*4882a593Smuzhiyun 	rcar_fcp_put(vsp1->fcp);
899*4882a593Smuzhiyun 
900*4882a593Smuzhiyun 	pm_runtime_disable(&pdev->dev);
901*4882a593Smuzhiyun 
902*4882a593Smuzhiyun 	return 0;
903*4882a593Smuzhiyun }
904*4882a593Smuzhiyun 
905*4882a593Smuzhiyun static const struct of_device_id vsp1_of_match[] = {
906*4882a593Smuzhiyun 	{ .compatible = "renesas,vsp1" },
907*4882a593Smuzhiyun 	{ .compatible = "renesas,vsp2" },
908*4882a593Smuzhiyun 	{ },
909*4882a593Smuzhiyun };
910*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, vsp1_of_match);
911*4882a593Smuzhiyun 
912*4882a593Smuzhiyun static struct platform_driver vsp1_platform_driver = {
913*4882a593Smuzhiyun 	.probe		= vsp1_probe,
914*4882a593Smuzhiyun 	.remove		= vsp1_remove,
915*4882a593Smuzhiyun 	.driver		= {
916*4882a593Smuzhiyun 		.name	= "vsp1",
917*4882a593Smuzhiyun 		.pm	= &vsp1_pm_ops,
918*4882a593Smuzhiyun 		.of_match_table = vsp1_of_match,
919*4882a593Smuzhiyun 	},
920*4882a593Smuzhiyun };
921*4882a593Smuzhiyun 
922*4882a593Smuzhiyun module_platform_driver(vsp1_platform_driver);
923*4882a593Smuzhiyun 
924*4882a593Smuzhiyun MODULE_ALIAS("vsp1");
925*4882a593Smuzhiyun MODULE_AUTHOR("Laurent Pinchart <laurent.pinchart@ideasonboard.com>");
926*4882a593Smuzhiyun MODULE_DESCRIPTION("Renesas VSP1 Driver");
927*4882a593Smuzhiyun MODULE_LICENSE("GPL");
928