1ee4a77a3SMauro Carvalho Chehab // SPDX-License-Identifier: GPL-2.0+
2ee4a77a3SMauro Carvalho Chehab /*
3ee4a77a3SMauro Carvalho Chehab * vsp1_drv.c -- R-Car VSP1 Driver
4ee4a77a3SMauro Carvalho Chehab *
5ee4a77a3SMauro Carvalho Chehab * Copyright (C) 2013-2015 Renesas Electronics Corporation
6ee4a77a3SMauro Carvalho Chehab *
7ee4a77a3SMauro Carvalho Chehab * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
8ee4a77a3SMauro Carvalho Chehab */
9ee4a77a3SMauro Carvalho Chehab
10ee4a77a3SMauro Carvalho Chehab #include <linux/clk.h>
11ee4a77a3SMauro Carvalho Chehab #include <linux/delay.h>
12ee4a77a3SMauro Carvalho Chehab #include <linux/device.h>
13ee4a77a3SMauro Carvalho Chehab #include <linux/interrupt.h>
14ee4a77a3SMauro Carvalho Chehab #include <linux/module.h>
15ee4a77a3SMauro Carvalho Chehab #include <linux/of.h>
16ee4a77a3SMauro Carvalho Chehab #include <linux/platform_device.h>
17ee4a77a3SMauro Carvalho Chehab #include <linux/pm_runtime.h>
1824c52aa3SBiju Das #include <linux/reset.h>
19ee4a77a3SMauro Carvalho Chehab #include <linux/videodev2.h>
20ee4a77a3SMauro Carvalho Chehab
21ee4a77a3SMauro Carvalho Chehab #include <media/rcar-fcp.h>
22ee4a77a3SMauro Carvalho Chehab #include <media/v4l2-subdev.h>
23ee4a77a3SMauro Carvalho Chehab
24ee4a77a3SMauro Carvalho Chehab #include "vsp1.h"
25ee4a77a3SMauro Carvalho Chehab #include "vsp1_brx.h"
26ee4a77a3SMauro Carvalho Chehab #include "vsp1_clu.h"
27ee4a77a3SMauro Carvalho Chehab #include "vsp1_dl.h"
28ee4a77a3SMauro Carvalho Chehab #include "vsp1_drm.h"
29ee4a77a3SMauro Carvalho Chehab #include "vsp1_hgo.h"
30ee4a77a3SMauro Carvalho Chehab #include "vsp1_hgt.h"
31ee4a77a3SMauro Carvalho Chehab #include "vsp1_hsit.h"
32ee4a77a3SMauro Carvalho Chehab #include "vsp1_lif.h"
33ee4a77a3SMauro Carvalho Chehab #include "vsp1_lut.h"
34ee4a77a3SMauro Carvalho Chehab #include "vsp1_pipe.h"
35ee4a77a3SMauro Carvalho Chehab #include "vsp1_rwpf.h"
36ee4a77a3SMauro Carvalho Chehab #include "vsp1_sru.h"
37ee4a77a3SMauro Carvalho Chehab #include "vsp1_uds.h"
38ee4a77a3SMauro Carvalho Chehab #include "vsp1_uif.h"
39ee4a77a3SMauro Carvalho Chehab #include "vsp1_video.h"
40ee4a77a3SMauro Carvalho Chehab
41ee4a77a3SMauro Carvalho Chehab /* -----------------------------------------------------------------------------
42ee4a77a3SMauro Carvalho Chehab * Interrupt Handling
43ee4a77a3SMauro Carvalho Chehab */
44ee4a77a3SMauro Carvalho Chehab
vsp1_irq_handler(int irq,void * data)45ee4a77a3SMauro Carvalho Chehab static irqreturn_t vsp1_irq_handler(int irq, void *data)
46ee4a77a3SMauro Carvalho Chehab {
47*1dc30075STomi Valkeinen u32 mask = VI6_WPF_IRQ_STA_DFE | VI6_WPF_IRQ_STA_FRE |
48*1dc30075STomi Valkeinen VI6_WPF_IRQ_STA_UND;
49ee4a77a3SMauro Carvalho Chehab struct vsp1_device *vsp1 = data;
50ee4a77a3SMauro Carvalho Chehab irqreturn_t ret = IRQ_NONE;
51ee4a77a3SMauro Carvalho Chehab unsigned int i;
52ee4a77a3SMauro Carvalho Chehab u32 status;
53ee4a77a3SMauro Carvalho Chehab
54ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->wpf_count; ++i) {
55ee4a77a3SMauro Carvalho Chehab struct vsp1_rwpf *wpf = vsp1->wpf[i];
56ee4a77a3SMauro Carvalho Chehab
57ee4a77a3SMauro Carvalho Chehab if (wpf == NULL)
58ee4a77a3SMauro Carvalho Chehab continue;
59ee4a77a3SMauro Carvalho Chehab
60ee4a77a3SMauro Carvalho Chehab status = vsp1_read(vsp1, VI6_WPF_IRQ_STA(i));
61ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_WPF_IRQ_STA(i), ~status & mask);
62ee4a77a3SMauro Carvalho Chehab
63*1dc30075STomi Valkeinen if ((status & VI6_WPF_IRQ_STA_UND) && wpf->entity.pipe) {
64*1dc30075STomi Valkeinen wpf->entity.pipe->underrun_count++;
65*1dc30075STomi Valkeinen
66*1dc30075STomi Valkeinen dev_warn_ratelimited(vsp1->dev,
67*1dc30075STomi Valkeinen "Underrun occurred at WPF%u (total underruns %u)\n",
68*1dc30075STomi Valkeinen i, wpf->entity.pipe->underrun_count);
69*1dc30075STomi Valkeinen }
70*1dc30075STomi Valkeinen
71ee4a77a3SMauro Carvalho Chehab if (status & VI6_WPF_IRQ_STA_DFE) {
72ee4a77a3SMauro Carvalho Chehab vsp1_pipeline_frame_end(wpf->entity.pipe);
73ee4a77a3SMauro Carvalho Chehab ret = IRQ_HANDLED;
74ee4a77a3SMauro Carvalho Chehab }
75ee4a77a3SMauro Carvalho Chehab }
76ee4a77a3SMauro Carvalho Chehab
77ee4a77a3SMauro Carvalho Chehab return ret;
78ee4a77a3SMauro Carvalho Chehab }
79ee4a77a3SMauro Carvalho Chehab
80ee4a77a3SMauro Carvalho Chehab /* -----------------------------------------------------------------------------
81ee4a77a3SMauro Carvalho Chehab * Entities
82ee4a77a3SMauro Carvalho Chehab */
83ee4a77a3SMauro Carvalho Chehab
84ee4a77a3SMauro Carvalho Chehab /*
85ee4a77a3SMauro Carvalho Chehab * vsp1_create_sink_links - Create links from all sources to the given sink
86ee4a77a3SMauro Carvalho Chehab *
87ee4a77a3SMauro Carvalho Chehab * This function creates media links from all valid sources to the given sink
88ee4a77a3SMauro Carvalho Chehab * pad. Links that would be invalid according to the VSP1 hardware capabilities
89ee4a77a3SMauro Carvalho Chehab * are skipped. Those include all links
90ee4a77a3SMauro Carvalho Chehab *
91ee4a77a3SMauro Carvalho Chehab * - from a UDS to a UDS (UDS entities can't be chained)
92ee4a77a3SMauro Carvalho Chehab * - from an entity to itself (no loops are allowed)
93ee4a77a3SMauro Carvalho Chehab *
94ee4a77a3SMauro Carvalho Chehab * Furthermore, the BRS can't be connected to histogram generators, but no
95ee4a77a3SMauro Carvalho Chehab * special check is currently needed as all VSP instances that include a BRS
96ee4a77a3SMauro Carvalho Chehab * have no histogram generator.
97ee4a77a3SMauro Carvalho Chehab */
vsp1_create_sink_links(struct vsp1_device * vsp1,struct vsp1_entity * sink)98ee4a77a3SMauro Carvalho Chehab static int vsp1_create_sink_links(struct vsp1_device *vsp1,
99ee4a77a3SMauro Carvalho Chehab struct vsp1_entity *sink)
100ee4a77a3SMauro Carvalho Chehab {
101ee4a77a3SMauro Carvalho Chehab struct media_entity *entity = &sink->subdev.entity;
102ee4a77a3SMauro Carvalho Chehab struct vsp1_entity *source;
103ee4a77a3SMauro Carvalho Chehab unsigned int pad;
104ee4a77a3SMauro Carvalho Chehab int ret;
105ee4a77a3SMauro Carvalho Chehab
106ee4a77a3SMauro Carvalho Chehab list_for_each_entry(source, &vsp1->entities, list_dev) {
107ee4a77a3SMauro Carvalho Chehab u32 flags;
108ee4a77a3SMauro Carvalho Chehab
109ee4a77a3SMauro Carvalho Chehab if (source->type == sink->type)
110ee4a77a3SMauro Carvalho Chehab continue;
111ee4a77a3SMauro Carvalho Chehab
112ee4a77a3SMauro Carvalho Chehab if (source->type == VSP1_ENTITY_HGO ||
113ee4a77a3SMauro Carvalho Chehab source->type == VSP1_ENTITY_HGT ||
114ee4a77a3SMauro Carvalho Chehab source->type == VSP1_ENTITY_LIF ||
115ee4a77a3SMauro Carvalho Chehab source->type == VSP1_ENTITY_WPF)
116ee4a77a3SMauro Carvalho Chehab continue;
117ee4a77a3SMauro Carvalho Chehab
118ee4a77a3SMauro Carvalho Chehab flags = source->type == VSP1_ENTITY_RPF &&
119ee4a77a3SMauro Carvalho Chehab sink->type == VSP1_ENTITY_WPF &&
120ee4a77a3SMauro Carvalho Chehab source->index == sink->index
121ee4a77a3SMauro Carvalho Chehab ? MEDIA_LNK_FL_ENABLED : 0;
122ee4a77a3SMauro Carvalho Chehab
123ee4a77a3SMauro Carvalho Chehab for (pad = 0; pad < entity->num_pads; ++pad) {
124ee4a77a3SMauro Carvalho Chehab if (!(entity->pads[pad].flags & MEDIA_PAD_FL_SINK))
125ee4a77a3SMauro Carvalho Chehab continue;
126ee4a77a3SMauro Carvalho Chehab
127ee4a77a3SMauro Carvalho Chehab ret = media_create_pad_link(&source->subdev.entity,
128ee4a77a3SMauro Carvalho Chehab source->source_pad,
129ee4a77a3SMauro Carvalho Chehab entity, pad, flags);
130ee4a77a3SMauro Carvalho Chehab if (ret < 0)
131ee4a77a3SMauro Carvalho Chehab return ret;
132ee4a77a3SMauro Carvalho Chehab
133ee4a77a3SMauro Carvalho Chehab if (flags & MEDIA_LNK_FL_ENABLED)
134ee4a77a3SMauro Carvalho Chehab source->sink = sink;
135ee4a77a3SMauro Carvalho Chehab }
136ee4a77a3SMauro Carvalho Chehab }
137ee4a77a3SMauro Carvalho Chehab
138ee4a77a3SMauro Carvalho Chehab return 0;
139ee4a77a3SMauro Carvalho Chehab }
140ee4a77a3SMauro Carvalho Chehab
vsp1_uapi_create_links(struct vsp1_device * vsp1)141ee4a77a3SMauro Carvalho Chehab static int vsp1_uapi_create_links(struct vsp1_device *vsp1)
142ee4a77a3SMauro Carvalho Chehab {
143ee4a77a3SMauro Carvalho Chehab struct vsp1_entity *entity;
144ee4a77a3SMauro Carvalho Chehab unsigned int i;
145ee4a77a3SMauro Carvalho Chehab int ret;
146ee4a77a3SMauro Carvalho Chehab
147ee4a77a3SMauro Carvalho Chehab list_for_each_entry(entity, &vsp1->entities, list_dev) {
148ee4a77a3SMauro Carvalho Chehab if (entity->type == VSP1_ENTITY_LIF ||
149ee4a77a3SMauro Carvalho Chehab entity->type == VSP1_ENTITY_RPF)
150ee4a77a3SMauro Carvalho Chehab continue;
151ee4a77a3SMauro Carvalho Chehab
152ee4a77a3SMauro Carvalho Chehab ret = vsp1_create_sink_links(vsp1, entity);
153ee4a77a3SMauro Carvalho Chehab if (ret < 0)
154ee4a77a3SMauro Carvalho Chehab return ret;
155ee4a77a3SMauro Carvalho Chehab }
156ee4a77a3SMauro Carvalho Chehab
157ee4a77a3SMauro Carvalho Chehab if (vsp1->hgo) {
158ee4a77a3SMauro Carvalho Chehab ret = media_create_pad_link(&vsp1->hgo->histo.entity.subdev.entity,
159ee4a77a3SMauro Carvalho Chehab HISTO_PAD_SOURCE,
160ee4a77a3SMauro Carvalho Chehab &vsp1->hgo->histo.video.entity, 0,
161ee4a77a3SMauro Carvalho Chehab MEDIA_LNK_FL_ENABLED |
162ee4a77a3SMauro Carvalho Chehab MEDIA_LNK_FL_IMMUTABLE);
163ee4a77a3SMauro Carvalho Chehab if (ret < 0)
164ee4a77a3SMauro Carvalho Chehab return ret;
165ee4a77a3SMauro Carvalho Chehab }
166ee4a77a3SMauro Carvalho Chehab
167ee4a77a3SMauro Carvalho Chehab if (vsp1->hgt) {
168ee4a77a3SMauro Carvalho Chehab ret = media_create_pad_link(&vsp1->hgt->histo.entity.subdev.entity,
169ee4a77a3SMauro Carvalho Chehab HISTO_PAD_SOURCE,
170ee4a77a3SMauro Carvalho Chehab &vsp1->hgt->histo.video.entity, 0,
171ee4a77a3SMauro Carvalho Chehab MEDIA_LNK_FL_ENABLED |
172ee4a77a3SMauro Carvalho Chehab MEDIA_LNK_FL_IMMUTABLE);
173ee4a77a3SMauro Carvalho Chehab if (ret < 0)
174ee4a77a3SMauro Carvalho Chehab return ret;
175ee4a77a3SMauro Carvalho Chehab }
176ee4a77a3SMauro Carvalho Chehab
177ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->lif_count; ++i) {
178ee4a77a3SMauro Carvalho Chehab if (!vsp1->lif[i])
179ee4a77a3SMauro Carvalho Chehab continue;
180ee4a77a3SMauro Carvalho Chehab
181ee4a77a3SMauro Carvalho Chehab ret = media_create_pad_link(&vsp1->wpf[i]->entity.subdev.entity,
182ee4a77a3SMauro Carvalho Chehab RWPF_PAD_SOURCE,
183ee4a77a3SMauro Carvalho Chehab &vsp1->lif[i]->entity.subdev.entity,
184ee4a77a3SMauro Carvalho Chehab LIF_PAD_SINK, 0);
185ee4a77a3SMauro Carvalho Chehab if (ret < 0)
186ee4a77a3SMauro Carvalho Chehab return ret;
187ee4a77a3SMauro Carvalho Chehab }
188ee4a77a3SMauro Carvalho Chehab
189ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->rpf_count; ++i) {
190ee4a77a3SMauro Carvalho Chehab struct vsp1_rwpf *rpf = vsp1->rpf[i];
191ee4a77a3SMauro Carvalho Chehab
192ee4a77a3SMauro Carvalho Chehab ret = media_create_pad_link(&rpf->video->video.entity, 0,
193ee4a77a3SMauro Carvalho Chehab &rpf->entity.subdev.entity,
194ee4a77a3SMauro Carvalho Chehab RWPF_PAD_SINK,
195ee4a77a3SMauro Carvalho Chehab MEDIA_LNK_FL_ENABLED |
196ee4a77a3SMauro Carvalho Chehab MEDIA_LNK_FL_IMMUTABLE);
197ee4a77a3SMauro Carvalho Chehab if (ret < 0)
198ee4a77a3SMauro Carvalho Chehab return ret;
199ee4a77a3SMauro Carvalho Chehab }
200ee4a77a3SMauro Carvalho Chehab
201ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->wpf_count; ++i) {
202ee4a77a3SMauro Carvalho Chehab /*
203ee4a77a3SMauro Carvalho Chehab * Connect the video device to the WPF. All connections are
204ee4a77a3SMauro Carvalho Chehab * immutable.
205ee4a77a3SMauro Carvalho Chehab */
206ee4a77a3SMauro Carvalho Chehab struct vsp1_rwpf *wpf = vsp1->wpf[i];
207ee4a77a3SMauro Carvalho Chehab
208ee4a77a3SMauro Carvalho Chehab ret = media_create_pad_link(&wpf->entity.subdev.entity,
209ee4a77a3SMauro Carvalho Chehab RWPF_PAD_SOURCE,
210ee4a77a3SMauro Carvalho Chehab &wpf->video->video.entity, 0,
211ee4a77a3SMauro Carvalho Chehab MEDIA_LNK_FL_IMMUTABLE |
212ee4a77a3SMauro Carvalho Chehab MEDIA_LNK_FL_ENABLED);
213ee4a77a3SMauro Carvalho Chehab if (ret < 0)
214ee4a77a3SMauro Carvalho Chehab return ret;
215ee4a77a3SMauro Carvalho Chehab }
216ee4a77a3SMauro Carvalho Chehab
217ee4a77a3SMauro Carvalho Chehab return 0;
218ee4a77a3SMauro Carvalho Chehab }
219ee4a77a3SMauro Carvalho Chehab
vsp1_destroy_entities(struct vsp1_device * vsp1)220ee4a77a3SMauro Carvalho Chehab static void vsp1_destroy_entities(struct vsp1_device *vsp1)
221ee4a77a3SMauro Carvalho Chehab {
222ee4a77a3SMauro Carvalho Chehab struct vsp1_entity *entity, *_entity;
223ee4a77a3SMauro Carvalho Chehab struct vsp1_video *video, *_video;
224ee4a77a3SMauro Carvalho Chehab
225ee4a77a3SMauro Carvalho Chehab list_for_each_entry_safe(entity, _entity, &vsp1->entities, list_dev) {
226ee4a77a3SMauro Carvalho Chehab list_del(&entity->list_dev);
227ee4a77a3SMauro Carvalho Chehab vsp1_entity_destroy(entity);
228ee4a77a3SMauro Carvalho Chehab }
229ee4a77a3SMauro Carvalho Chehab
230ee4a77a3SMauro Carvalho Chehab list_for_each_entry_safe(video, _video, &vsp1->videos, list) {
231ee4a77a3SMauro Carvalho Chehab list_del(&video->list);
232ee4a77a3SMauro Carvalho Chehab vsp1_video_cleanup(video);
233ee4a77a3SMauro Carvalho Chehab }
234ee4a77a3SMauro Carvalho Chehab
235ee4a77a3SMauro Carvalho Chehab v4l2_device_unregister(&vsp1->v4l2_dev);
236ee4a77a3SMauro Carvalho Chehab if (vsp1->info->uapi)
237ee4a77a3SMauro Carvalho Chehab media_device_unregister(&vsp1->media_dev);
238ee4a77a3SMauro Carvalho Chehab media_device_cleanup(&vsp1->media_dev);
239ee4a77a3SMauro Carvalho Chehab
240ee4a77a3SMauro Carvalho Chehab if (!vsp1->info->uapi)
241ee4a77a3SMauro Carvalho Chehab vsp1_drm_cleanup(vsp1);
242ee4a77a3SMauro Carvalho Chehab }
243ee4a77a3SMauro Carvalho Chehab
vsp1_create_entities(struct vsp1_device * vsp1)244ee4a77a3SMauro Carvalho Chehab static int vsp1_create_entities(struct vsp1_device *vsp1)
245ee4a77a3SMauro Carvalho Chehab {
246ee4a77a3SMauro Carvalho Chehab struct media_device *mdev = &vsp1->media_dev;
247ee4a77a3SMauro Carvalho Chehab struct v4l2_device *vdev = &vsp1->v4l2_dev;
248ee4a77a3SMauro Carvalho Chehab struct vsp1_entity *entity;
249ee4a77a3SMauro Carvalho Chehab unsigned int i;
250ee4a77a3SMauro Carvalho Chehab int ret;
251ee4a77a3SMauro Carvalho Chehab
252ee4a77a3SMauro Carvalho Chehab mdev->dev = vsp1->dev;
253ee4a77a3SMauro Carvalho Chehab mdev->hw_revision = vsp1->version;
254ee4a77a3SMauro Carvalho Chehab strscpy(mdev->model, vsp1->info->model, sizeof(mdev->model));
255ee4a77a3SMauro Carvalho Chehab media_device_init(mdev);
256ee4a77a3SMauro Carvalho Chehab
257ee4a77a3SMauro Carvalho Chehab vsp1->media_ops.link_setup = vsp1_entity_link_setup;
258ee4a77a3SMauro Carvalho Chehab /*
259ee4a77a3SMauro Carvalho Chehab * Don't perform link validation when the userspace API is disabled as
260ee4a77a3SMauro Carvalho Chehab * the pipeline is configured internally by the driver in that case, and
261ee4a77a3SMauro Carvalho Chehab * its configuration can thus be trusted.
262ee4a77a3SMauro Carvalho Chehab */
263ee4a77a3SMauro Carvalho Chehab if (vsp1->info->uapi)
264ee4a77a3SMauro Carvalho Chehab vsp1->media_ops.link_validate = v4l2_subdev_link_validate;
265ee4a77a3SMauro Carvalho Chehab
266ee4a77a3SMauro Carvalho Chehab vdev->mdev = mdev;
267ee4a77a3SMauro Carvalho Chehab ret = v4l2_device_register(vsp1->dev, vdev);
268ee4a77a3SMauro Carvalho Chehab if (ret < 0) {
269ee4a77a3SMauro Carvalho Chehab dev_err(vsp1->dev, "V4L2 device registration failed (%d)\n",
270ee4a77a3SMauro Carvalho Chehab ret);
271ee4a77a3SMauro Carvalho Chehab goto done;
272ee4a77a3SMauro Carvalho Chehab }
273ee4a77a3SMauro Carvalho Chehab
274ee4a77a3SMauro Carvalho Chehab /* Instantiate all the entities. */
275ee4a77a3SMauro Carvalho Chehab if (vsp1_feature(vsp1, VSP1_HAS_BRS)) {
276ee4a77a3SMauro Carvalho Chehab vsp1->brs = vsp1_brx_create(vsp1, VSP1_ENTITY_BRS);
277ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->brs)) {
278ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(vsp1->brs);
279ee4a77a3SMauro Carvalho Chehab goto done;
280ee4a77a3SMauro Carvalho Chehab }
281ee4a77a3SMauro Carvalho Chehab
282ee4a77a3SMauro Carvalho Chehab list_add_tail(&vsp1->brs->entity.list_dev, &vsp1->entities);
283ee4a77a3SMauro Carvalho Chehab }
284ee4a77a3SMauro Carvalho Chehab
285ee4a77a3SMauro Carvalho Chehab if (vsp1_feature(vsp1, VSP1_HAS_BRU)) {
286ee4a77a3SMauro Carvalho Chehab vsp1->bru = vsp1_brx_create(vsp1, VSP1_ENTITY_BRU);
287ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->bru)) {
288ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(vsp1->bru);
289ee4a77a3SMauro Carvalho Chehab goto done;
290ee4a77a3SMauro Carvalho Chehab }
291ee4a77a3SMauro Carvalho Chehab
292ee4a77a3SMauro Carvalho Chehab list_add_tail(&vsp1->bru->entity.list_dev, &vsp1->entities);
293ee4a77a3SMauro Carvalho Chehab }
294ee4a77a3SMauro Carvalho Chehab
295ee4a77a3SMauro Carvalho Chehab if (vsp1_feature(vsp1, VSP1_HAS_CLU)) {
296ee4a77a3SMauro Carvalho Chehab vsp1->clu = vsp1_clu_create(vsp1);
297ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->clu)) {
298ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(vsp1->clu);
299ee4a77a3SMauro Carvalho Chehab goto done;
300ee4a77a3SMauro Carvalho Chehab }
301ee4a77a3SMauro Carvalho Chehab
302ee4a77a3SMauro Carvalho Chehab list_add_tail(&vsp1->clu->entity.list_dev, &vsp1->entities);
303ee4a77a3SMauro Carvalho Chehab }
304ee4a77a3SMauro Carvalho Chehab
305ee4a77a3SMauro Carvalho Chehab vsp1->hsi = vsp1_hsit_create(vsp1, true);
306ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->hsi)) {
307ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(vsp1->hsi);
308ee4a77a3SMauro Carvalho Chehab goto done;
309ee4a77a3SMauro Carvalho Chehab }
310ee4a77a3SMauro Carvalho Chehab
311ee4a77a3SMauro Carvalho Chehab list_add_tail(&vsp1->hsi->entity.list_dev, &vsp1->entities);
312ee4a77a3SMauro Carvalho Chehab
313ee4a77a3SMauro Carvalho Chehab vsp1->hst = vsp1_hsit_create(vsp1, false);
314ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->hst)) {
315ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(vsp1->hst);
316ee4a77a3SMauro Carvalho Chehab goto done;
317ee4a77a3SMauro Carvalho Chehab }
318ee4a77a3SMauro Carvalho Chehab
319ee4a77a3SMauro Carvalho Chehab list_add_tail(&vsp1->hst->entity.list_dev, &vsp1->entities);
320ee4a77a3SMauro Carvalho Chehab
321ee4a77a3SMauro Carvalho Chehab if (vsp1_feature(vsp1, VSP1_HAS_HGO) && vsp1->info->uapi) {
322ee4a77a3SMauro Carvalho Chehab vsp1->hgo = vsp1_hgo_create(vsp1);
323ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->hgo)) {
324ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(vsp1->hgo);
325ee4a77a3SMauro Carvalho Chehab goto done;
326ee4a77a3SMauro Carvalho Chehab }
327ee4a77a3SMauro Carvalho Chehab
328ee4a77a3SMauro Carvalho Chehab list_add_tail(&vsp1->hgo->histo.entity.list_dev,
329ee4a77a3SMauro Carvalho Chehab &vsp1->entities);
330ee4a77a3SMauro Carvalho Chehab }
331ee4a77a3SMauro Carvalho Chehab
332ee4a77a3SMauro Carvalho Chehab if (vsp1_feature(vsp1, VSP1_HAS_HGT) && vsp1->info->uapi) {
333ee4a77a3SMauro Carvalho Chehab vsp1->hgt = vsp1_hgt_create(vsp1);
334ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->hgt)) {
335ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(vsp1->hgt);
336ee4a77a3SMauro Carvalho Chehab goto done;
337ee4a77a3SMauro Carvalho Chehab }
338ee4a77a3SMauro Carvalho Chehab
339ee4a77a3SMauro Carvalho Chehab list_add_tail(&vsp1->hgt->histo.entity.list_dev,
340ee4a77a3SMauro Carvalho Chehab &vsp1->entities);
341ee4a77a3SMauro Carvalho Chehab }
342ee4a77a3SMauro Carvalho Chehab
343ee4a77a3SMauro Carvalho Chehab /*
344ee4a77a3SMauro Carvalho Chehab * The LIFs are only supported when used in conjunction with the DU, in
345ee4a77a3SMauro Carvalho Chehab * which case the userspace API is disabled. If the userspace API is
346ee4a77a3SMauro Carvalho Chehab * enabled skip the LIFs, even when present.
347ee4a77a3SMauro Carvalho Chehab */
348ee4a77a3SMauro Carvalho Chehab if (!vsp1->info->uapi) {
349ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->lif_count; ++i) {
350ee4a77a3SMauro Carvalho Chehab struct vsp1_lif *lif;
351ee4a77a3SMauro Carvalho Chehab
352ee4a77a3SMauro Carvalho Chehab lif = vsp1_lif_create(vsp1, i);
353ee4a77a3SMauro Carvalho Chehab if (IS_ERR(lif)) {
354ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(lif);
355ee4a77a3SMauro Carvalho Chehab goto done;
356ee4a77a3SMauro Carvalho Chehab }
357ee4a77a3SMauro Carvalho Chehab
358ee4a77a3SMauro Carvalho Chehab vsp1->lif[i] = lif;
359ee4a77a3SMauro Carvalho Chehab list_add_tail(&lif->entity.list_dev, &vsp1->entities);
360ee4a77a3SMauro Carvalho Chehab }
361ee4a77a3SMauro Carvalho Chehab }
362ee4a77a3SMauro Carvalho Chehab
363ee4a77a3SMauro Carvalho Chehab if (vsp1_feature(vsp1, VSP1_HAS_LUT)) {
364ee4a77a3SMauro Carvalho Chehab vsp1->lut = vsp1_lut_create(vsp1);
365ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->lut)) {
366ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(vsp1->lut);
367ee4a77a3SMauro Carvalho Chehab goto done;
368ee4a77a3SMauro Carvalho Chehab }
369ee4a77a3SMauro Carvalho Chehab
370ee4a77a3SMauro Carvalho Chehab list_add_tail(&vsp1->lut->entity.list_dev, &vsp1->entities);
371ee4a77a3SMauro Carvalho Chehab }
372ee4a77a3SMauro Carvalho Chehab
373ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->rpf_count; ++i) {
374ee4a77a3SMauro Carvalho Chehab struct vsp1_rwpf *rpf;
375ee4a77a3SMauro Carvalho Chehab
376ee4a77a3SMauro Carvalho Chehab rpf = vsp1_rpf_create(vsp1, i);
377ee4a77a3SMauro Carvalho Chehab if (IS_ERR(rpf)) {
378ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(rpf);
379ee4a77a3SMauro Carvalho Chehab goto done;
380ee4a77a3SMauro Carvalho Chehab }
381ee4a77a3SMauro Carvalho Chehab
382ee4a77a3SMauro Carvalho Chehab vsp1->rpf[i] = rpf;
383ee4a77a3SMauro Carvalho Chehab list_add_tail(&rpf->entity.list_dev, &vsp1->entities);
384ee4a77a3SMauro Carvalho Chehab
385ee4a77a3SMauro Carvalho Chehab if (vsp1->info->uapi) {
386ee4a77a3SMauro Carvalho Chehab struct vsp1_video *video = vsp1_video_create(vsp1, rpf);
387ee4a77a3SMauro Carvalho Chehab
388ee4a77a3SMauro Carvalho Chehab if (IS_ERR(video)) {
389ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(video);
390ee4a77a3SMauro Carvalho Chehab goto done;
391ee4a77a3SMauro Carvalho Chehab }
392ee4a77a3SMauro Carvalho Chehab
393ee4a77a3SMauro Carvalho Chehab list_add_tail(&video->list, &vsp1->videos);
394ee4a77a3SMauro Carvalho Chehab }
395ee4a77a3SMauro Carvalho Chehab }
396ee4a77a3SMauro Carvalho Chehab
397ee4a77a3SMauro Carvalho Chehab if (vsp1_feature(vsp1, VSP1_HAS_SRU)) {
398ee4a77a3SMauro Carvalho Chehab vsp1->sru = vsp1_sru_create(vsp1);
399ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->sru)) {
400ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(vsp1->sru);
401ee4a77a3SMauro Carvalho Chehab goto done;
402ee4a77a3SMauro Carvalho Chehab }
403ee4a77a3SMauro Carvalho Chehab
404ee4a77a3SMauro Carvalho Chehab list_add_tail(&vsp1->sru->entity.list_dev, &vsp1->entities);
405ee4a77a3SMauro Carvalho Chehab }
406ee4a77a3SMauro Carvalho Chehab
407ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->uds_count; ++i) {
408ee4a77a3SMauro Carvalho Chehab struct vsp1_uds *uds;
409ee4a77a3SMauro Carvalho Chehab
410ee4a77a3SMauro Carvalho Chehab uds = vsp1_uds_create(vsp1, i);
411ee4a77a3SMauro Carvalho Chehab if (IS_ERR(uds)) {
412ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(uds);
413ee4a77a3SMauro Carvalho Chehab goto done;
414ee4a77a3SMauro Carvalho Chehab }
415ee4a77a3SMauro Carvalho Chehab
416ee4a77a3SMauro Carvalho Chehab vsp1->uds[i] = uds;
417ee4a77a3SMauro Carvalho Chehab list_add_tail(&uds->entity.list_dev, &vsp1->entities);
418ee4a77a3SMauro Carvalho Chehab }
419ee4a77a3SMauro Carvalho Chehab
420ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->uif_count; ++i) {
421ee4a77a3SMauro Carvalho Chehab struct vsp1_uif *uif;
422ee4a77a3SMauro Carvalho Chehab
423ee4a77a3SMauro Carvalho Chehab uif = vsp1_uif_create(vsp1, i);
424ee4a77a3SMauro Carvalho Chehab if (IS_ERR(uif)) {
425ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(uif);
426ee4a77a3SMauro Carvalho Chehab goto done;
427ee4a77a3SMauro Carvalho Chehab }
428ee4a77a3SMauro Carvalho Chehab
429ee4a77a3SMauro Carvalho Chehab vsp1->uif[i] = uif;
430ee4a77a3SMauro Carvalho Chehab list_add_tail(&uif->entity.list_dev, &vsp1->entities);
431ee4a77a3SMauro Carvalho Chehab }
432ee4a77a3SMauro Carvalho Chehab
433ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->wpf_count; ++i) {
434ee4a77a3SMauro Carvalho Chehab struct vsp1_rwpf *wpf;
435ee4a77a3SMauro Carvalho Chehab
436ee4a77a3SMauro Carvalho Chehab wpf = vsp1_wpf_create(vsp1, i);
437ee4a77a3SMauro Carvalho Chehab if (IS_ERR(wpf)) {
438ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(wpf);
439ee4a77a3SMauro Carvalho Chehab goto done;
440ee4a77a3SMauro Carvalho Chehab }
441ee4a77a3SMauro Carvalho Chehab
442ee4a77a3SMauro Carvalho Chehab vsp1->wpf[i] = wpf;
443ee4a77a3SMauro Carvalho Chehab list_add_tail(&wpf->entity.list_dev, &vsp1->entities);
444ee4a77a3SMauro Carvalho Chehab
445ee4a77a3SMauro Carvalho Chehab if (vsp1->info->uapi) {
446ee4a77a3SMauro Carvalho Chehab struct vsp1_video *video = vsp1_video_create(vsp1, wpf);
447ee4a77a3SMauro Carvalho Chehab
448ee4a77a3SMauro Carvalho Chehab if (IS_ERR(video)) {
449ee4a77a3SMauro Carvalho Chehab ret = PTR_ERR(video);
450ee4a77a3SMauro Carvalho Chehab goto done;
451ee4a77a3SMauro Carvalho Chehab }
452ee4a77a3SMauro Carvalho Chehab
453ee4a77a3SMauro Carvalho Chehab list_add_tail(&video->list, &vsp1->videos);
454ee4a77a3SMauro Carvalho Chehab }
455ee4a77a3SMauro Carvalho Chehab }
456ee4a77a3SMauro Carvalho Chehab
457ee4a77a3SMauro Carvalho Chehab /* Register all subdevs. */
458ee4a77a3SMauro Carvalho Chehab list_for_each_entry(entity, &vsp1->entities, list_dev) {
459ee4a77a3SMauro Carvalho Chehab ret = v4l2_device_register_subdev(&vsp1->v4l2_dev,
460ee4a77a3SMauro Carvalho Chehab &entity->subdev);
461ee4a77a3SMauro Carvalho Chehab if (ret < 0)
462ee4a77a3SMauro Carvalho Chehab goto done;
463ee4a77a3SMauro Carvalho Chehab }
464ee4a77a3SMauro Carvalho Chehab
465ee4a77a3SMauro Carvalho Chehab /*
466ee4a77a3SMauro Carvalho Chehab * Create links and register subdev nodes if the userspace API is
467ee4a77a3SMauro Carvalho Chehab * enabled or initialize the DRM pipeline otherwise.
468ee4a77a3SMauro Carvalho Chehab */
469ee4a77a3SMauro Carvalho Chehab if (vsp1->info->uapi) {
470ee4a77a3SMauro Carvalho Chehab ret = vsp1_uapi_create_links(vsp1);
471ee4a77a3SMauro Carvalho Chehab if (ret < 0)
472ee4a77a3SMauro Carvalho Chehab goto done;
473ee4a77a3SMauro Carvalho Chehab
474ee4a77a3SMauro Carvalho Chehab ret = v4l2_device_register_subdev_nodes(&vsp1->v4l2_dev);
475ee4a77a3SMauro Carvalho Chehab if (ret < 0)
476ee4a77a3SMauro Carvalho Chehab goto done;
477ee4a77a3SMauro Carvalho Chehab
478ee4a77a3SMauro Carvalho Chehab ret = media_device_register(mdev);
479ee4a77a3SMauro Carvalho Chehab } else {
480ee4a77a3SMauro Carvalho Chehab ret = vsp1_drm_init(vsp1);
481ee4a77a3SMauro Carvalho Chehab }
482ee4a77a3SMauro Carvalho Chehab
483ee4a77a3SMauro Carvalho Chehab done:
484ee4a77a3SMauro Carvalho Chehab if (ret < 0)
485ee4a77a3SMauro Carvalho Chehab vsp1_destroy_entities(vsp1);
486ee4a77a3SMauro Carvalho Chehab
487ee4a77a3SMauro Carvalho Chehab return ret;
488ee4a77a3SMauro Carvalho Chehab }
489ee4a77a3SMauro Carvalho Chehab
vsp1_reset_wpf(struct vsp1_device * vsp1,unsigned int index)490ee4a77a3SMauro Carvalho Chehab int vsp1_reset_wpf(struct vsp1_device *vsp1, unsigned int index)
491ee4a77a3SMauro Carvalho Chehab {
492ee4a77a3SMauro Carvalho Chehab unsigned int timeout;
493ee4a77a3SMauro Carvalho Chehab u32 status;
494ee4a77a3SMauro Carvalho Chehab
495ee4a77a3SMauro Carvalho Chehab status = vsp1_read(vsp1, VI6_STATUS);
496ee4a77a3SMauro Carvalho Chehab if (!(status & VI6_STATUS_SYS_ACT(index)))
497ee4a77a3SMauro Carvalho Chehab return 0;
498ee4a77a3SMauro Carvalho Chehab
499ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_SRESET, VI6_SRESET_SRTS(index));
500ee4a77a3SMauro Carvalho Chehab for (timeout = 10; timeout > 0; --timeout) {
501ee4a77a3SMauro Carvalho Chehab status = vsp1_read(vsp1, VI6_STATUS);
502ee4a77a3SMauro Carvalho Chehab if (!(status & VI6_STATUS_SYS_ACT(index)))
503ee4a77a3SMauro Carvalho Chehab break;
504ee4a77a3SMauro Carvalho Chehab
505ee4a77a3SMauro Carvalho Chehab usleep_range(1000, 2000);
506ee4a77a3SMauro Carvalho Chehab }
507ee4a77a3SMauro Carvalho Chehab
508ee4a77a3SMauro Carvalho Chehab if (!timeout) {
509ee4a77a3SMauro Carvalho Chehab dev_err(vsp1->dev, "failed to reset wpf.%u\n", index);
510ee4a77a3SMauro Carvalho Chehab return -ETIMEDOUT;
511ee4a77a3SMauro Carvalho Chehab }
512ee4a77a3SMauro Carvalho Chehab
513ee4a77a3SMauro Carvalho Chehab return 0;
514ee4a77a3SMauro Carvalho Chehab }
515ee4a77a3SMauro Carvalho Chehab
vsp1_device_init(struct vsp1_device * vsp1)516ee4a77a3SMauro Carvalho Chehab static int vsp1_device_init(struct vsp1_device *vsp1)
517ee4a77a3SMauro Carvalho Chehab {
518ee4a77a3SMauro Carvalho Chehab unsigned int i;
519ee4a77a3SMauro Carvalho Chehab int ret;
520ee4a77a3SMauro Carvalho Chehab
521ee4a77a3SMauro Carvalho Chehab /* Reset any channel that might be running. */
522ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->wpf_count; ++i) {
523ee4a77a3SMauro Carvalho Chehab ret = vsp1_reset_wpf(vsp1, i);
524ee4a77a3SMauro Carvalho Chehab if (ret < 0)
525ee4a77a3SMauro Carvalho Chehab return ret;
526ee4a77a3SMauro Carvalho Chehab }
527ee4a77a3SMauro Carvalho Chehab
528ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_CLK_DCSWT, (8 << VI6_CLK_DCSWT_CSTPW_SHIFT) |
529ee4a77a3SMauro Carvalho Chehab (8 << VI6_CLK_DCSWT_CSTRW_SHIFT));
530ee4a77a3SMauro Carvalho Chehab
531ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->rpf_count; ++i)
532ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_RPF_ROUTE(i), VI6_DPR_NODE_UNUSED);
533ee4a77a3SMauro Carvalho Chehab
534ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->uds_count; ++i)
535ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_UDS_ROUTE(i), VI6_DPR_NODE_UNUSED);
536ee4a77a3SMauro Carvalho Chehab
537ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->uif_count; ++i)
538ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_UIF_ROUTE(i), VI6_DPR_NODE_UNUSED);
539ee4a77a3SMauro Carvalho Chehab
540ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_SRU_ROUTE, VI6_DPR_NODE_UNUSED);
541ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_LUT_ROUTE, VI6_DPR_NODE_UNUSED);
542ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_CLU_ROUTE, VI6_DPR_NODE_UNUSED);
543ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_HST_ROUTE, VI6_DPR_NODE_UNUSED);
544ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_HSI_ROUTE, VI6_DPR_NODE_UNUSED);
545ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_BRU_ROUTE, VI6_DPR_NODE_UNUSED);
546ee4a77a3SMauro Carvalho Chehab
547ee4a77a3SMauro Carvalho Chehab if (vsp1_feature(vsp1, VSP1_HAS_BRS))
548ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_ILV_BRS_ROUTE, VI6_DPR_NODE_UNUSED);
549ee4a77a3SMauro Carvalho Chehab
550ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_HGO_SMPPT, (7 << VI6_DPR_SMPPT_TGW_SHIFT) |
551ee4a77a3SMauro Carvalho Chehab (VI6_DPR_NODE_UNUSED << VI6_DPR_SMPPT_PT_SHIFT));
552ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DPR_HGT_SMPPT, (7 << VI6_DPR_SMPPT_TGW_SHIFT) |
553ee4a77a3SMauro Carvalho Chehab (VI6_DPR_NODE_UNUSED << VI6_DPR_SMPPT_PT_SHIFT));
554ee4a77a3SMauro Carvalho Chehab
555ee4a77a3SMauro Carvalho Chehab vsp1_dlm_setup(vsp1);
556ee4a77a3SMauro Carvalho Chehab
557ee4a77a3SMauro Carvalho Chehab return 0;
558ee4a77a3SMauro Carvalho Chehab }
559ee4a77a3SMauro Carvalho Chehab
vsp1_mask_all_interrupts(struct vsp1_device * vsp1)560ee4a77a3SMauro Carvalho Chehab static void vsp1_mask_all_interrupts(struct vsp1_device *vsp1)
561ee4a77a3SMauro Carvalho Chehab {
562ee4a77a3SMauro Carvalho Chehab unsigned int i;
563ee4a77a3SMauro Carvalho Chehab
564ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->lif_count; ++i)
565ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_DISP_IRQ_ENB(i), 0);
566ee4a77a3SMauro Carvalho Chehab for (i = 0; i < vsp1->info->wpf_count; ++i)
567ee4a77a3SMauro Carvalho Chehab vsp1_write(vsp1, VI6_WPF_IRQ_ENB(i), 0);
568ee4a77a3SMauro Carvalho Chehab }
569ee4a77a3SMauro Carvalho Chehab
570ee4a77a3SMauro Carvalho Chehab /*
571ee4a77a3SMauro Carvalho Chehab * vsp1_device_get - Acquire the VSP1 device
572ee4a77a3SMauro Carvalho Chehab *
573ee4a77a3SMauro Carvalho Chehab * Make sure the device is not suspended and initialize it if needed.
574ee4a77a3SMauro Carvalho Chehab *
575ee4a77a3SMauro Carvalho Chehab * Return 0 on success or a negative error code otherwise.
576ee4a77a3SMauro Carvalho Chehab */
vsp1_device_get(struct vsp1_device * vsp1)577ee4a77a3SMauro Carvalho Chehab int vsp1_device_get(struct vsp1_device *vsp1)
578ee4a77a3SMauro Carvalho Chehab {
579ee4a77a3SMauro Carvalho Chehab return pm_runtime_resume_and_get(vsp1->dev);
580ee4a77a3SMauro Carvalho Chehab }
581ee4a77a3SMauro Carvalho Chehab
582ee4a77a3SMauro Carvalho Chehab /*
583ee4a77a3SMauro Carvalho Chehab * vsp1_device_put - Release the VSP1 device
584ee4a77a3SMauro Carvalho Chehab *
585ee4a77a3SMauro Carvalho Chehab * Decrement the VSP1 reference count and cleanup the device if the last
586ee4a77a3SMauro Carvalho Chehab * reference is released.
587ee4a77a3SMauro Carvalho Chehab */
vsp1_device_put(struct vsp1_device * vsp1)588ee4a77a3SMauro Carvalho Chehab void vsp1_device_put(struct vsp1_device *vsp1)
589ee4a77a3SMauro Carvalho Chehab {
590ee4a77a3SMauro Carvalho Chehab pm_runtime_put_sync(vsp1->dev);
591ee4a77a3SMauro Carvalho Chehab }
592ee4a77a3SMauro Carvalho Chehab
593ee4a77a3SMauro Carvalho Chehab /* -----------------------------------------------------------------------------
594ee4a77a3SMauro Carvalho Chehab * Power Management
595ee4a77a3SMauro Carvalho Chehab */
596ee4a77a3SMauro Carvalho Chehab
vsp1_pm_suspend(struct device * dev)597ee4a77a3SMauro Carvalho Chehab static int __maybe_unused vsp1_pm_suspend(struct device *dev)
598ee4a77a3SMauro Carvalho Chehab {
599ee4a77a3SMauro Carvalho Chehab struct vsp1_device *vsp1 = dev_get_drvdata(dev);
600ee4a77a3SMauro Carvalho Chehab
601ee4a77a3SMauro Carvalho Chehab /*
602ee4a77a3SMauro Carvalho Chehab * When used as part of a display pipeline, the VSP is stopped and
603ee4a77a3SMauro Carvalho Chehab * restarted explicitly by the DU.
604ee4a77a3SMauro Carvalho Chehab */
605ee4a77a3SMauro Carvalho Chehab if (!vsp1->drm)
606ee4a77a3SMauro Carvalho Chehab vsp1_video_suspend(vsp1);
607ee4a77a3SMauro Carvalho Chehab
608ee4a77a3SMauro Carvalho Chehab pm_runtime_force_suspend(vsp1->dev);
609ee4a77a3SMauro Carvalho Chehab
610ee4a77a3SMauro Carvalho Chehab return 0;
611ee4a77a3SMauro Carvalho Chehab }
612ee4a77a3SMauro Carvalho Chehab
vsp1_pm_resume(struct device * dev)613ee4a77a3SMauro Carvalho Chehab static int __maybe_unused vsp1_pm_resume(struct device *dev)
614ee4a77a3SMauro Carvalho Chehab {
615ee4a77a3SMauro Carvalho Chehab struct vsp1_device *vsp1 = dev_get_drvdata(dev);
616ee4a77a3SMauro Carvalho Chehab
617ee4a77a3SMauro Carvalho Chehab pm_runtime_force_resume(vsp1->dev);
618ee4a77a3SMauro Carvalho Chehab
619ee4a77a3SMauro Carvalho Chehab /*
620ee4a77a3SMauro Carvalho Chehab * When used as part of a display pipeline, the VSP is stopped and
621ee4a77a3SMauro Carvalho Chehab * restarted explicitly by the DU.
622ee4a77a3SMauro Carvalho Chehab */
623ee4a77a3SMauro Carvalho Chehab if (!vsp1->drm)
624ee4a77a3SMauro Carvalho Chehab vsp1_video_resume(vsp1);
625ee4a77a3SMauro Carvalho Chehab
626ee4a77a3SMauro Carvalho Chehab return 0;
627ee4a77a3SMauro Carvalho Chehab }
628ee4a77a3SMauro Carvalho Chehab
vsp1_pm_runtime_suspend(struct device * dev)629ee4a77a3SMauro Carvalho Chehab static int __maybe_unused vsp1_pm_runtime_suspend(struct device *dev)
630ee4a77a3SMauro Carvalho Chehab {
631ee4a77a3SMauro Carvalho Chehab struct vsp1_device *vsp1 = dev_get_drvdata(dev);
632ee4a77a3SMauro Carvalho Chehab
633ee4a77a3SMauro Carvalho Chehab rcar_fcp_disable(vsp1->fcp);
63424c52aa3SBiju Das reset_control_assert(vsp1->rstc);
635ee4a77a3SMauro Carvalho Chehab
636ee4a77a3SMauro Carvalho Chehab return 0;
637ee4a77a3SMauro Carvalho Chehab }
638ee4a77a3SMauro Carvalho Chehab
vsp1_pm_runtime_resume(struct device * dev)639ee4a77a3SMauro Carvalho Chehab static int __maybe_unused vsp1_pm_runtime_resume(struct device *dev)
640ee4a77a3SMauro Carvalho Chehab {
641ee4a77a3SMauro Carvalho Chehab struct vsp1_device *vsp1 = dev_get_drvdata(dev);
642ee4a77a3SMauro Carvalho Chehab int ret;
643ee4a77a3SMauro Carvalho Chehab
64424c52aa3SBiju Das ret = reset_control_deassert(vsp1->rstc);
645ee4a77a3SMauro Carvalho Chehab if (ret < 0)
646ee4a77a3SMauro Carvalho Chehab return ret;
64724c52aa3SBiju Das
64824c52aa3SBiju Das if (vsp1->info) {
64924c52aa3SBiju Das /*
65024c52aa3SBiju Das * On R-Car Gen2 and RZ/G1, vsp1 register access after deassert
65124c52aa3SBiju Das * can cause lock-up. It is a special case and needs some delay
65224c52aa3SBiju Das * to avoid this lock-up.
65324c52aa3SBiju Das */
65424c52aa3SBiju Das if (vsp1->info->gen == 2)
65524c52aa3SBiju Das udelay(1);
65624c52aa3SBiju Das
65724c52aa3SBiju Das ret = vsp1_device_init(vsp1);
65824c52aa3SBiju Das if (ret < 0)
65924c52aa3SBiju Das goto done;
660ee4a77a3SMauro Carvalho Chehab }
661ee4a77a3SMauro Carvalho Chehab
66224c52aa3SBiju Das ret = rcar_fcp_enable(vsp1->fcp);
66324c52aa3SBiju Das
66424c52aa3SBiju Das done:
66524c52aa3SBiju Das if (ret < 0)
66624c52aa3SBiju Das reset_control_assert(vsp1->rstc);
66724c52aa3SBiju Das
66824c52aa3SBiju Das return ret;
669ee4a77a3SMauro Carvalho Chehab }
670ee4a77a3SMauro Carvalho Chehab
671ee4a77a3SMauro Carvalho Chehab static const struct dev_pm_ops vsp1_pm_ops = {
672ee4a77a3SMauro Carvalho Chehab SET_SYSTEM_SLEEP_PM_OPS(vsp1_pm_suspend, vsp1_pm_resume)
673ee4a77a3SMauro Carvalho Chehab SET_RUNTIME_PM_OPS(vsp1_pm_runtime_suspend, vsp1_pm_runtime_resume, NULL)
674ee4a77a3SMauro Carvalho Chehab };
675ee4a77a3SMauro Carvalho Chehab
676ee4a77a3SMauro Carvalho Chehab /* -----------------------------------------------------------------------------
677ee4a77a3SMauro Carvalho Chehab * Platform Driver
678ee4a77a3SMauro Carvalho Chehab */
679ee4a77a3SMauro Carvalho Chehab
680ee4a77a3SMauro Carvalho Chehab static const struct vsp1_device_info vsp1_device_infos[] = {
681ee4a77a3SMauro Carvalho Chehab {
682ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPS_H2,
683ee4a77a3SMauro Carvalho Chehab .model = "VSP1-S",
684ee4a77a3SMauro Carvalho Chehab .gen = 2,
685ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_HGO
686ee4a77a3SMauro Carvalho Chehab | VSP1_HAS_HGT | VSP1_HAS_LUT | VSP1_HAS_SRU
687ee4a77a3SMauro Carvalho Chehab | VSP1_HAS_WPF_VFLIP,
688ee4a77a3SMauro Carvalho Chehab .rpf_count = 5,
689ee4a77a3SMauro Carvalho Chehab .uds_count = 3,
690ee4a77a3SMauro Carvalho Chehab .wpf_count = 4,
691ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 4,
692ee4a77a3SMauro Carvalho Chehab .uapi = true,
693ee4a77a3SMauro Carvalho Chehab }, {
694ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPR_H2,
695ee4a77a3SMauro Carvalho Chehab .model = "VSP1-R",
696ee4a77a3SMauro Carvalho Chehab .gen = 2,
697ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRU | VSP1_HAS_SRU | VSP1_HAS_WPF_VFLIP,
698ee4a77a3SMauro Carvalho Chehab .rpf_count = 5,
699ee4a77a3SMauro Carvalho Chehab .uds_count = 3,
700ee4a77a3SMauro Carvalho Chehab .wpf_count = 4,
701ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 4,
702ee4a77a3SMauro Carvalho Chehab .uapi = true,
703ee4a77a3SMauro Carvalho Chehab }, {
704ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPD_GEN2,
705ee4a77a3SMauro Carvalho Chehab .model = "VSP1-D",
706ee4a77a3SMauro Carvalho Chehab .gen = 2,
707ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRU | VSP1_HAS_HGO | VSP1_HAS_LUT,
708ee4a77a3SMauro Carvalho Chehab .lif_count = 1,
709ee4a77a3SMauro Carvalho Chehab .rpf_count = 4,
710ee4a77a3SMauro Carvalho Chehab .uds_count = 1,
711ee4a77a3SMauro Carvalho Chehab .wpf_count = 1,
712ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 4,
713ee4a77a3SMauro Carvalho Chehab .uapi = true,
714ee4a77a3SMauro Carvalho Chehab }, {
715ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPS_M2,
716ee4a77a3SMauro Carvalho Chehab .model = "VSP1-S",
717ee4a77a3SMauro Carvalho Chehab .gen = 2,
718ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_HGO
719ee4a77a3SMauro Carvalho Chehab | VSP1_HAS_HGT | VSP1_HAS_LUT | VSP1_HAS_SRU
720ee4a77a3SMauro Carvalho Chehab | VSP1_HAS_WPF_VFLIP,
721ee4a77a3SMauro Carvalho Chehab .rpf_count = 5,
722ee4a77a3SMauro Carvalho Chehab .uds_count = 1,
723ee4a77a3SMauro Carvalho Chehab .wpf_count = 4,
724ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 4,
725ee4a77a3SMauro Carvalho Chehab .uapi = true,
726ee4a77a3SMauro Carvalho Chehab }, {
727ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPS_V2H,
728ee4a77a3SMauro Carvalho Chehab .model = "VSP1V-S",
729ee4a77a3SMauro Carvalho Chehab .gen = 2,
730ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_LUT
731ee4a77a3SMauro Carvalho Chehab | VSP1_HAS_SRU | VSP1_HAS_WPF_VFLIP,
732ee4a77a3SMauro Carvalho Chehab .rpf_count = 4,
733ee4a77a3SMauro Carvalho Chehab .uds_count = 1,
734ee4a77a3SMauro Carvalho Chehab .wpf_count = 4,
735ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 4,
736ee4a77a3SMauro Carvalho Chehab .uapi = true,
737ee4a77a3SMauro Carvalho Chehab }, {
738ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPD_V2H,
739ee4a77a3SMauro Carvalho Chehab .model = "VSP1V-D",
740ee4a77a3SMauro Carvalho Chehab .gen = 2,
741ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_LUT,
742ee4a77a3SMauro Carvalho Chehab .lif_count = 1,
743ee4a77a3SMauro Carvalho Chehab .rpf_count = 4,
744ee4a77a3SMauro Carvalho Chehab .uds_count = 1,
745ee4a77a3SMauro Carvalho Chehab .wpf_count = 1,
746ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 4,
747ee4a77a3SMauro Carvalho Chehab .uapi = true,
748ee4a77a3SMauro Carvalho Chehab }, {
749ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPI_GEN3,
750ee4a77a3SMauro Carvalho Chehab .model = "VSP2-I",
751ee4a77a3SMauro Carvalho Chehab .gen = 3,
752ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_CLU | VSP1_HAS_HGO | VSP1_HAS_HGT
753ee4a77a3SMauro Carvalho Chehab | VSP1_HAS_LUT | VSP1_HAS_SRU | VSP1_HAS_WPF_HFLIP
754ee4a77a3SMauro Carvalho Chehab | VSP1_HAS_WPF_VFLIP,
755ee4a77a3SMauro Carvalho Chehab .rpf_count = 1,
756ee4a77a3SMauro Carvalho Chehab .uds_count = 1,
757ee4a77a3SMauro Carvalho Chehab .wpf_count = 1,
758ee4a77a3SMauro Carvalho Chehab .uapi = true,
759ee4a77a3SMauro Carvalho Chehab }, {
760ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPBD_GEN3,
761ee4a77a3SMauro Carvalho Chehab .model = "VSP2-BD",
762ee4a77a3SMauro Carvalho Chehab .gen = 3,
763ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRU | VSP1_HAS_WPF_VFLIP,
764ee4a77a3SMauro Carvalho Chehab .rpf_count = 5,
765ee4a77a3SMauro Carvalho Chehab .wpf_count = 1,
766ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 5,
767ee4a77a3SMauro Carvalho Chehab .uapi = true,
768ee4a77a3SMauro Carvalho Chehab }, {
769ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPBC_GEN3,
770ee4a77a3SMauro Carvalho Chehab .model = "VSP2-BC",
771ee4a77a3SMauro Carvalho Chehab .gen = 3,
772ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_HGO
773ee4a77a3SMauro Carvalho Chehab | VSP1_HAS_LUT | VSP1_HAS_WPF_VFLIP,
774ee4a77a3SMauro Carvalho Chehab .rpf_count = 5,
775ee4a77a3SMauro Carvalho Chehab .wpf_count = 1,
776ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 5,
777ee4a77a3SMauro Carvalho Chehab .uapi = true,
778ee4a77a3SMauro Carvalho Chehab }, {
779ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPBS_GEN3,
780ee4a77a3SMauro Carvalho Chehab .model = "VSP2-BS",
781ee4a77a3SMauro Carvalho Chehab .gen = 3,
782ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRS | VSP1_HAS_WPF_VFLIP,
783ee4a77a3SMauro Carvalho Chehab .rpf_count = 2,
784ee4a77a3SMauro Carvalho Chehab .wpf_count = 1,
785ee4a77a3SMauro Carvalho Chehab .uapi = true,
786ee4a77a3SMauro Carvalho Chehab }, {
787ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPD_GEN3,
788ee4a77a3SMauro Carvalho Chehab .model = "VSP2-D",
789ee4a77a3SMauro Carvalho Chehab .gen = 3,
790ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRU | VSP1_HAS_WPF_VFLIP | VSP1_HAS_EXT_DL,
791ee4a77a3SMauro Carvalho Chehab .lif_count = 1,
792ee4a77a3SMauro Carvalho Chehab .rpf_count = 5,
793ee4a77a3SMauro Carvalho Chehab .uif_count = 1,
794ee4a77a3SMauro Carvalho Chehab .wpf_count = 2,
795ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 5,
796ee4a77a3SMauro Carvalho Chehab }, {
797ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPD_V3,
798ee4a77a3SMauro Carvalho Chehab .model = "VSP2-D",
7994d728fd4SBiju Das .soc = VI6_IP_VERSION_SOC_V3H,
800ee4a77a3SMauro Carvalho Chehab .gen = 3,
801ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRS | VSP1_HAS_BRU,
802ee4a77a3SMauro Carvalho Chehab .lif_count = 1,
803ee4a77a3SMauro Carvalho Chehab .rpf_count = 5,
804ee4a77a3SMauro Carvalho Chehab .uif_count = 1,
805ee4a77a3SMauro Carvalho Chehab .wpf_count = 1,
806ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 5,
807ee4a77a3SMauro Carvalho Chehab }, {
8084d728fd4SBiju Das .version = VI6_IP_VERSION_MODEL_VSPD_V3,
8094d728fd4SBiju Das .model = "VSP2-D",
8104d728fd4SBiju Das .soc = VI6_IP_VERSION_SOC_V3M,
8114d728fd4SBiju Das .gen = 3,
8124d728fd4SBiju Das .features = VSP1_HAS_BRS | VSP1_HAS_BRU | VSP1_HAS_NON_ZERO_LBA,
8134d728fd4SBiju Das .lif_count = 1,
8144d728fd4SBiju Das .rpf_count = 5,
8154d728fd4SBiju Das .uif_count = 1,
8164d728fd4SBiju Das .wpf_count = 1,
8174d728fd4SBiju Das .num_bru_inputs = 5,
8184d728fd4SBiju Das }, {
819ee4a77a3SMauro Carvalho Chehab .version = VI6_IP_VERSION_MODEL_VSPDL_GEN3,
820ee4a77a3SMauro Carvalho Chehab .model = "VSP2-DL",
821ee4a77a3SMauro Carvalho Chehab .gen = 3,
822ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRS | VSP1_HAS_BRU | VSP1_HAS_EXT_DL,
823ee4a77a3SMauro Carvalho Chehab .lif_count = 2,
824ee4a77a3SMauro Carvalho Chehab .rpf_count = 5,
825ee4a77a3SMauro Carvalho Chehab .uif_count = 2,
826ee4a77a3SMauro Carvalho Chehab .wpf_count = 2,
827ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 5,
828ee4a77a3SMauro Carvalho Chehab }, {
829110d2bd7STomi Valkeinen .version = VI6_IP_VERSION_MODEL_VSPD_GEN4,
830ee4a77a3SMauro Carvalho Chehab .model = "VSP2-D",
831110d2bd7STomi Valkeinen .gen = 4,
832ee4a77a3SMauro Carvalho Chehab .features = VSP1_HAS_BRU | VSP1_HAS_EXT_DL,
833ee4a77a3SMauro Carvalho Chehab .lif_count = 1,
834ee4a77a3SMauro Carvalho Chehab .rpf_count = 5,
835ee4a77a3SMauro Carvalho Chehab .uif_count = 2,
836ee4a77a3SMauro Carvalho Chehab .wpf_count = 1,
837ee4a77a3SMauro Carvalho Chehab .num_bru_inputs = 5,
838ee4a77a3SMauro Carvalho Chehab },
839ee4a77a3SMauro Carvalho Chehab };
840ee4a77a3SMauro Carvalho Chehab
841882bda18SBiju Das static const struct vsp1_device_info rzg2l_vsp2_device_info = {
842882bda18SBiju Das .version = VI6_IP_VERSION_MODEL_VSPD_RZG2L,
843882bda18SBiju Das .model = "VSP2-D",
844882bda18SBiju Das .soc = VI6_IP_VERSION_SOC_RZG2L,
845882bda18SBiju Das .gen = 3,
846882bda18SBiju Das .features = VSP1_HAS_BRS | VSP1_HAS_WPF_VFLIP | VSP1_HAS_EXT_DL
847882bda18SBiju Das | VSP1_HAS_NON_ZERO_LBA,
848882bda18SBiju Das .lif_count = 1,
849882bda18SBiju Das .rpf_count = 2,
850882bda18SBiju Das .wpf_count = 1,
851882bda18SBiju Das };
852882bda18SBiju Das
vsp1_lookup_info(struct vsp1_device * vsp1)8539c639027SBiju Das static const struct vsp1_device_info *vsp1_lookup_info(struct vsp1_device *vsp1)
8549c639027SBiju Das {
8559c639027SBiju Das const struct vsp1_device_info *info;
8569c639027SBiju Das unsigned int i;
8574d728fd4SBiju Das u32 model;
8584d728fd4SBiju Das u32 soc;
8599c639027SBiju Das
8609c639027SBiju Das /*
8619c639027SBiju Das * Try the info stored in match data first for devices that don't have
8629c639027SBiju Das * a version register.
8639c639027SBiju Das */
8649c639027SBiju Das info = of_device_get_match_data(vsp1->dev);
8659c639027SBiju Das if (info) {
8669c639027SBiju Das vsp1->version = VI6_IP_VERSION_VSP_SW | info->version | info->soc;
8679c639027SBiju Das return info;
8689c639027SBiju Das }
8699c639027SBiju Das
8709c639027SBiju Das vsp1->version = vsp1_read(vsp1, VI6_IP_VERSION);
8714d728fd4SBiju Das model = vsp1->version & VI6_IP_VERSION_MODEL_MASK;
8724d728fd4SBiju Das soc = vsp1->version & VI6_IP_VERSION_SOC_MASK;
8739c639027SBiju Das
8749c639027SBiju Das for (i = 0; i < ARRAY_SIZE(vsp1_device_infos); ++i) {
8759c639027SBiju Das info = &vsp1_device_infos[i];
8769c639027SBiju Das
8774d728fd4SBiju Das if (model == info->version && (!info->soc || soc == info->soc))
8789c639027SBiju Das return info;
8799c639027SBiju Das }
8809c639027SBiju Das
8819c639027SBiju Das dev_err(vsp1->dev, "unsupported IP version 0x%08x\n", vsp1->version);
8829c639027SBiju Das
8839c639027SBiju Das return NULL;
8849c639027SBiju Das }
8859c639027SBiju Das
vsp1_probe(struct platform_device * pdev)886ee4a77a3SMauro Carvalho Chehab static int vsp1_probe(struct platform_device *pdev)
887ee4a77a3SMauro Carvalho Chehab {
888ee4a77a3SMauro Carvalho Chehab struct vsp1_device *vsp1;
889ee4a77a3SMauro Carvalho Chehab struct device_node *fcp_node;
890ee4a77a3SMauro Carvalho Chehab int ret;
891ee4a77a3SMauro Carvalho Chehab int irq;
892ee4a77a3SMauro Carvalho Chehab
893ee4a77a3SMauro Carvalho Chehab vsp1 = devm_kzalloc(&pdev->dev, sizeof(*vsp1), GFP_KERNEL);
894ee4a77a3SMauro Carvalho Chehab if (vsp1 == NULL)
895ee4a77a3SMauro Carvalho Chehab return -ENOMEM;
896ee4a77a3SMauro Carvalho Chehab
897ee4a77a3SMauro Carvalho Chehab vsp1->dev = &pdev->dev;
898ee4a77a3SMauro Carvalho Chehab INIT_LIST_HEAD(&vsp1->entities);
899ee4a77a3SMauro Carvalho Chehab INIT_LIST_HEAD(&vsp1->videos);
900ee4a77a3SMauro Carvalho Chehab
901ee4a77a3SMauro Carvalho Chehab platform_set_drvdata(pdev, vsp1);
902ee4a77a3SMauro Carvalho Chehab
903ee4a77a3SMauro Carvalho Chehab /* I/O and IRQ resources (clock managed by the clock PM domain). */
904ee4a77a3SMauro Carvalho Chehab vsp1->mmio = devm_platform_ioremap_resource(pdev, 0);
905ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->mmio))
906ee4a77a3SMauro Carvalho Chehab return PTR_ERR(vsp1->mmio);
907ee4a77a3SMauro Carvalho Chehab
908ee4a77a3SMauro Carvalho Chehab irq = platform_get_irq(pdev, 0);
909ee4a77a3SMauro Carvalho Chehab if (irq < 0)
910ee4a77a3SMauro Carvalho Chehab return irq;
911ee4a77a3SMauro Carvalho Chehab
91224c52aa3SBiju Das vsp1->rstc = devm_reset_control_get_shared(&pdev->dev, NULL);
91324c52aa3SBiju Das if (IS_ERR(vsp1->rstc))
91424c52aa3SBiju Das return dev_err_probe(&pdev->dev, PTR_ERR(vsp1->rstc),
91524c52aa3SBiju Das "failed to get reset control\n");
91624c52aa3SBiju Das
917ee4a77a3SMauro Carvalho Chehab /* FCP (optional). */
918ee4a77a3SMauro Carvalho Chehab fcp_node = of_parse_phandle(pdev->dev.of_node, "renesas,fcp", 0);
919ee4a77a3SMauro Carvalho Chehab if (fcp_node) {
920ee4a77a3SMauro Carvalho Chehab vsp1->fcp = rcar_fcp_get(fcp_node);
921ee4a77a3SMauro Carvalho Chehab of_node_put(fcp_node);
922ee4a77a3SMauro Carvalho Chehab if (IS_ERR(vsp1->fcp)) {
923ee4a77a3SMauro Carvalho Chehab dev_dbg(&pdev->dev, "FCP not found (%ld)\n",
924ee4a77a3SMauro Carvalho Chehab PTR_ERR(vsp1->fcp));
925ee4a77a3SMauro Carvalho Chehab return PTR_ERR(vsp1->fcp);
926ee4a77a3SMauro Carvalho Chehab }
927ee4a77a3SMauro Carvalho Chehab
928ee4a77a3SMauro Carvalho Chehab /*
929ee4a77a3SMauro Carvalho Chehab * When the FCP is present, it handles all bus master accesses
930ee4a77a3SMauro Carvalho Chehab * for the VSP and must thus be used in place of the VSP device
931ee4a77a3SMauro Carvalho Chehab * to map DMA buffers.
932ee4a77a3SMauro Carvalho Chehab */
933ee4a77a3SMauro Carvalho Chehab vsp1->bus_master = rcar_fcp_get_device(vsp1->fcp);
934ee4a77a3SMauro Carvalho Chehab } else {
935ee4a77a3SMauro Carvalho Chehab vsp1->bus_master = vsp1->dev;
936ee4a77a3SMauro Carvalho Chehab }
937ee4a77a3SMauro Carvalho Chehab
938ee4a77a3SMauro Carvalho Chehab /* Configure device parameters based on the version register. */
939ee4a77a3SMauro Carvalho Chehab pm_runtime_enable(&pdev->dev);
940ee4a77a3SMauro Carvalho Chehab
941ee4a77a3SMauro Carvalho Chehab ret = vsp1_device_get(vsp1);
942ee4a77a3SMauro Carvalho Chehab if (ret < 0)
943ee4a77a3SMauro Carvalho Chehab goto done;
944ee4a77a3SMauro Carvalho Chehab
9459c639027SBiju Das vsp1->info = vsp1_lookup_info(vsp1);
946ee4a77a3SMauro Carvalho Chehab if (!vsp1->info) {
947ee4a77a3SMauro Carvalho Chehab vsp1_device_put(vsp1);
948ee4a77a3SMauro Carvalho Chehab ret = -ENXIO;
949ee4a77a3SMauro Carvalho Chehab goto done;
950ee4a77a3SMauro Carvalho Chehab }
951ee4a77a3SMauro Carvalho Chehab
952ee4a77a3SMauro Carvalho Chehab dev_dbg(&pdev->dev, "IP version 0x%08x\n", vsp1->version);
953ee4a77a3SMauro Carvalho Chehab
954ee4a77a3SMauro Carvalho Chehab /*
955ee4a77a3SMauro Carvalho Chehab * Previous use of the hardware (e.g. by the bootloader) could leave
956ee4a77a3SMauro Carvalho Chehab * some interrupts enabled and pending.
957ee4a77a3SMauro Carvalho Chehab *
958ee4a77a3SMauro Carvalho Chehab * TODO: Investigate if this shouldn't be better handled by using the
959ee4a77a3SMauro Carvalho Chehab * device reset provided by the CPG.
960ee4a77a3SMauro Carvalho Chehab */
961ee4a77a3SMauro Carvalho Chehab vsp1_mask_all_interrupts(vsp1);
962ee4a77a3SMauro Carvalho Chehab
963ee4a77a3SMauro Carvalho Chehab vsp1_device_put(vsp1);
964ee4a77a3SMauro Carvalho Chehab
965ee4a77a3SMauro Carvalho Chehab ret = devm_request_irq(&pdev->dev, irq, vsp1_irq_handler,
966ee4a77a3SMauro Carvalho Chehab IRQF_SHARED, dev_name(&pdev->dev), vsp1);
967ee4a77a3SMauro Carvalho Chehab if (ret < 0) {
968ee4a77a3SMauro Carvalho Chehab dev_err(&pdev->dev, "failed to request IRQ\n");
969ee4a77a3SMauro Carvalho Chehab goto done;
970ee4a77a3SMauro Carvalho Chehab }
971ee4a77a3SMauro Carvalho Chehab
972ee4a77a3SMauro Carvalho Chehab /* Instantiate entities. */
973ee4a77a3SMauro Carvalho Chehab ret = vsp1_create_entities(vsp1);
974ee4a77a3SMauro Carvalho Chehab if (ret < 0) {
975ee4a77a3SMauro Carvalho Chehab dev_err(&pdev->dev, "failed to create entities\n");
976ee4a77a3SMauro Carvalho Chehab goto done;
977ee4a77a3SMauro Carvalho Chehab }
978ee4a77a3SMauro Carvalho Chehab
979ee4a77a3SMauro Carvalho Chehab done:
980ee4a77a3SMauro Carvalho Chehab if (ret) {
981ee4a77a3SMauro Carvalho Chehab pm_runtime_disable(&pdev->dev);
982ee4a77a3SMauro Carvalho Chehab rcar_fcp_put(vsp1->fcp);
983ee4a77a3SMauro Carvalho Chehab }
984ee4a77a3SMauro Carvalho Chehab
985ee4a77a3SMauro Carvalho Chehab return ret;
986ee4a77a3SMauro Carvalho Chehab }
987ee4a77a3SMauro Carvalho Chehab
vsp1_remove(struct platform_device * pdev)9881f669271SUwe Kleine-König static void vsp1_remove(struct platform_device *pdev)
989ee4a77a3SMauro Carvalho Chehab {
990ee4a77a3SMauro Carvalho Chehab struct vsp1_device *vsp1 = platform_get_drvdata(pdev);
991ee4a77a3SMauro Carvalho Chehab
992ee4a77a3SMauro Carvalho Chehab vsp1_destroy_entities(vsp1);
993ee4a77a3SMauro Carvalho Chehab rcar_fcp_put(vsp1->fcp);
994ee4a77a3SMauro Carvalho Chehab
995ee4a77a3SMauro Carvalho Chehab pm_runtime_disable(&pdev->dev);
996ee4a77a3SMauro Carvalho Chehab }
997ee4a77a3SMauro Carvalho Chehab
998ee4a77a3SMauro Carvalho Chehab static const struct of_device_id vsp1_of_match[] = {
999ee4a77a3SMauro Carvalho Chehab { .compatible = "renesas,vsp1" },
1000ee4a77a3SMauro Carvalho Chehab { .compatible = "renesas,vsp2" },
1001882bda18SBiju Das { .compatible = "renesas,r9a07g044-vsp2", .data = &rzg2l_vsp2_device_info },
1002ee4a77a3SMauro Carvalho Chehab { },
1003ee4a77a3SMauro Carvalho Chehab };
1004ee4a77a3SMauro Carvalho Chehab MODULE_DEVICE_TABLE(of, vsp1_of_match);
1005ee4a77a3SMauro Carvalho Chehab
1006ee4a77a3SMauro Carvalho Chehab static struct platform_driver vsp1_platform_driver = {
1007ee4a77a3SMauro Carvalho Chehab .probe = vsp1_probe,
10081f669271SUwe Kleine-König .remove_new = vsp1_remove,
1009ee4a77a3SMauro Carvalho Chehab .driver = {
1010ee4a77a3SMauro Carvalho Chehab .name = "vsp1",
1011ee4a77a3SMauro Carvalho Chehab .pm = &vsp1_pm_ops,
1012ee4a77a3SMauro Carvalho Chehab .of_match_table = vsp1_of_match,
1013ee4a77a3SMauro Carvalho Chehab },
1014ee4a77a3SMauro Carvalho Chehab };
1015ee4a77a3SMauro Carvalho Chehab
1016ee4a77a3SMauro Carvalho Chehab module_platform_driver(vsp1_platform_driver);
1017ee4a77a3SMauro Carvalho Chehab
1018ee4a77a3SMauro Carvalho Chehab MODULE_ALIAS("vsp1");
1019ee4a77a3SMauro Carvalho Chehab MODULE_AUTHOR("Laurent Pinchart <laurent.pinchart@ideasonboard.com>");
1020ee4a77a3SMauro Carvalho Chehab MODULE_DESCRIPTION("Renesas VSP1 Driver");
1021ee4a77a3SMauro Carvalho Chehab MODULE_LICENSE("GPL");
1022