vsp1_drv.c 17.6 KB
Newer Older
1 2 3
/*
 * vsp1_drv.c  --  R-Car VSP1 Driver
 *
4
 * Copyright (C) 2013-2015 Renesas Electronics Corporation
5 6 7 8 9 10 11 12 13 14 15 16 17 18
 *
 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 */

#include <linux/clk.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <linux/interrupt.h>
#include <linux/module.h>
19
#include <linux/of.h>
20
#include <linux/of_device.h>
21
#include <linux/platform_device.h>
22
#include <linux/pm_runtime.h>
23 24
#include <linux/videodev2.h>

25
#include <media/rcar-fcp.h>
26 27
#include <media/v4l2-subdev.h>

28
#include "vsp1.h"
29
#include "vsp1_bru.h"
30
#include "vsp1_clu.h"
31
#include "vsp1_dl.h"
32
#include "vsp1_drm.h"
33
#include "vsp1_hsit.h"
34
#include "vsp1_lif.h"
35
#include "vsp1_lut.h"
36
#include "vsp1_pipe.h"
37
#include "vsp1_rwpf.h"
38
#include "vsp1_sru.h"
39
#include "vsp1_uds.h"
40
#include "vsp1_video.h"
41 42 43 44 45 46 47 48 49 50 51

/* -----------------------------------------------------------------------------
 * Interrupt Handling
 */

static irqreturn_t vsp1_irq_handler(int irq, void *data)
{
	u32 mask = VI6_WFP_IRQ_STA_DFE | VI6_WFP_IRQ_STA_FRE;
	struct vsp1_device *vsp1 = data;
	irqreturn_t ret = IRQ_NONE;
	unsigned int i;
52
	u32 status;
53

54
	for (i = 0; i < vsp1->info->wpf_count; ++i) {
55 56 57 58 59 60 61 62 63
		struct vsp1_rwpf *wpf = vsp1->wpf[i];

		if (wpf == NULL)
			continue;

		status = vsp1_read(vsp1, VI6_WPF_IRQ_STA(i));
		vsp1_write(vsp1, VI6_WPF_IRQ_STA(i), ~status & mask);

		if (status & VI6_WFP_IRQ_STA_FRE) {
64
			vsp1_pipeline_frame_end(wpf->pipe);
65 66 67 68
			ret = IRQ_HANDLED;
		}
	}

69 70 71 72
	status = vsp1_read(vsp1, VI6_DISP_IRQ_STA);
	vsp1_write(vsp1, VI6_DISP_IRQ_STA, ~status & VI6_DISP_IRQ_STA_DST);

	if (status & VI6_DISP_IRQ_STA_DST) {
73
		vsp1_drm_display_start(vsp1);
74 75 76
		ret = IRQ_HANDLED;
	}

77 78 79 80 81 82 83 84
	return ret;
}

/* -----------------------------------------------------------------------------
 * Entities
 */

/*
85
 * vsp1_create_sink_links - Create links from all sources to the given sink
86 87 88 89 90 91 92 93
 *
 * This function creates media links from all valid sources to the given sink
 * pad. Links that would be invalid according to the VSP1 hardware capabilities
 * are skipped. Those include all links
 *
 * - from a UDS to a UDS (UDS entities can't be chained)
 * - from an entity to itself (no loops are allowed)
 */
94 95
static int vsp1_create_sink_links(struct vsp1_device *vsp1,
				  struct vsp1_entity *sink)
96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120
{
	struct media_entity *entity = &sink->subdev.entity;
	struct vsp1_entity *source;
	unsigned int pad;
	int ret;

	list_for_each_entry(source, &vsp1->entities, list_dev) {
		u32 flags;

		if (source->type == sink->type)
			continue;

		if (source->type == VSP1_ENTITY_LIF ||
		    source->type == VSP1_ENTITY_WPF)
			continue;

		flags = source->type == VSP1_ENTITY_RPF &&
			sink->type == VSP1_ENTITY_WPF &&
			source->index == sink->index
		      ? MEDIA_LNK_FL_ENABLED : 0;

		for (pad = 0; pad < entity->num_pads; ++pad) {
			if (!(entity->pads[pad].flags & MEDIA_PAD_FL_SINK))
				continue;

121
			ret = media_create_pad_link(&source->subdev.entity,
122 123 124 125
						       source->source_pad,
						       entity, pad, flags);
			if (ret < 0)
				return ret;
126 127 128

			if (flags & MEDIA_LNK_FL_ENABLED)
				source->sink = entity;
129 130 131
		}
	}

132 133
	return 0;
}
134

135
static int vsp1_uapi_create_links(struct vsp1_device *vsp1)
136 137 138 139 140 141 142 143 144 145 146 147 148 149 150
{
	struct vsp1_entity *entity;
	unsigned int i;
	int ret;

	list_for_each_entry(entity, &vsp1->entities, list_dev) {
		if (entity->type == VSP1_ENTITY_LIF ||
		    entity->type == VSP1_ENTITY_RPF)
			continue;

		ret = vsp1_create_sink_links(vsp1, entity);
		if (ret < 0)
			return ret;
	}

151
	if (vsp1->lif) {
152 153 154 155 156 157 158 159
		ret = media_create_pad_link(&vsp1->wpf[0]->entity.subdev.entity,
					    RWPF_PAD_SOURCE,
					    &vsp1->lif->entity.subdev.entity,
					    LIF_PAD_SINK, 0);
		if (ret < 0)
			return ret;
	}

160
	for (i = 0; i < vsp1->info->rpf_count; ++i) {
161 162 163 164 165 166 167 168 169 170 171
		struct vsp1_rwpf *rpf = vsp1->rpf[i];

		ret = media_create_pad_link(&rpf->video->video.entity, 0,
					    &rpf->entity.subdev.entity,
					    RWPF_PAD_SINK,
					    MEDIA_LNK_FL_ENABLED |
					    MEDIA_LNK_FL_IMMUTABLE);
		if (ret < 0)
			return ret;
	}

172
	for (i = 0; i < vsp1->info->wpf_count; ++i) {
173
		/* Connect the video device to the WPF. All connections are
174
		 * immutable.
175
		 */
176
		struct vsp1_rwpf *wpf = vsp1->wpf[i];
177

178 179 180
		ret = media_create_pad_link(&wpf->entity.subdev.entity,
					    RWPF_PAD_SOURCE,
					    &wpf->video->video.entity, 0,
181 182
					    MEDIA_LNK_FL_IMMUTABLE |
					    MEDIA_LNK_FL_ENABLED);
183 184
		if (ret < 0)
			return ret;
185 186
	}

187 188 189 190 191
	return 0;
}

static void vsp1_destroy_entities(struct vsp1_device *vsp1)
{
192 193
	struct vsp1_entity *entity, *_entity;
	struct vsp1_video *video, *_video;
194

195
	list_for_each_entry_safe(entity, _entity, &vsp1->entities, list_dev) {
196 197 198 199
		list_del(&entity->list_dev);
		vsp1_entity_destroy(entity);
	}

200 201 202 203 204
	list_for_each_entry_safe(video, _video, &vsp1->videos, list) {
		list_del(&video->list);
		vsp1_video_cleanup(video);
	}

205
	v4l2_device_unregister(&vsp1->v4l2_dev);
206 207
	if (vsp1->info->uapi)
		media_device_unregister(&vsp1->media_dev);
208
	media_device_cleanup(&vsp1->media_dev);
209

210
	if (!vsp1->info->uapi)
211
		vsp1_drm_cleanup(vsp1);
212 213 214 215 216 217 218 219 220 221 222 223
}

static int vsp1_create_entities(struct vsp1_device *vsp1)
{
	struct media_device *mdev = &vsp1->media_dev;
	struct v4l2_device *vdev = &vsp1->v4l2_dev;
	struct vsp1_entity *entity;
	unsigned int i;
	int ret;

	mdev->dev = vsp1->dev;
	strlcpy(mdev->model, "VSP1", sizeof(mdev->model));
224 225
	snprintf(mdev->bus_info, sizeof(mdev->bus_info), "platform:%s",
		 dev_name(mdev->dev));
226
	media_device_init(mdev);
227

228 229 230 231 232
	vsp1->media_ops.link_setup = vsp1_entity_link_setup;
	/* Don't perform link validation when the userspace API is disabled as
	 * the pipeline is configured internally by the driver in that case, and
	 * its configuration can thus be trusted.
	 */
233
	if (vsp1->info->uapi)
234 235
		vsp1->media_ops.link_validate = v4l2_subdev_link_validate;

236 237 238 239 240 241 242 243 244
	vdev->mdev = mdev;
	ret = v4l2_device_register(vsp1->dev, vdev);
	if (ret < 0) {
		dev_err(vsp1->dev, "V4L2 device registration failed (%d)\n",
			ret);
		goto done;
	}

	/* Instantiate all the entities. */
245
	if (vsp1->info->features & VSP1_HAS_BRU) {
246 247 248 249 250
		vsp1->bru = vsp1_bru_create(vsp1);
		if (IS_ERR(vsp1->bru)) {
			ret = PTR_ERR(vsp1->bru);
			goto done;
		}
251

252 253
		list_add_tail(&vsp1->bru->entity.list_dev, &vsp1->entities);
	}
254

255 256 257 258 259 260 261 262 263 264
	if (vsp1->info->features & VSP1_HAS_CLU) {
		vsp1->clu = vsp1_clu_create(vsp1);
		if (IS_ERR(vsp1->clu)) {
			ret = PTR_ERR(vsp1->clu);
			goto done;
		}

		list_add_tail(&vsp1->clu->entity.list_dev, &vsp1->entities);
	}

265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280
	vsp1->hsi = vsp1_hsit_create(vsp1, true);
	if (IS_ERR(vsp1->hsi)) {
		ret = PTR_ERR(vsp1->hsi);
		goto done;
	}

	list_add_tail(&vsp1->hsi->entity.list_dev, &vsp1->entities);

	vsp1->hst = vsp1_hsit_create(vsp1, false);
	if (IS_ERR(vsp1->hst)) {
		ret = PTR_ERR(vsp1->hst);
		goto done;
	}

	list_add_tail(&vsp1->hst->entity.list_dev, &vsp1->entities);

281 282 283 284 285
	/* The LIF is only supported when used in conjunction with the DU, in
	 * which case the userspace API is disabled. If the userspace API is
	 * enabled skip the LIF, even when present.
	 */
	if (vsp1->info->features & VSP1_HAS_LIF && !vsp1->info->uapi) {
286 287 288 289 290 291 292 293 294
		vsp1->lif = vsp1_lif_create(vsp1);
		if (IS_ERR(vsp1->lif)) {
			ret = PTR_ERR(vsp1->lif);
			goto done;
		}

		list_add_tail(&vsp1->lif->entity.list_dev, &vsp1->entities);
	}

295
	if (vsp1->info->features & VSP1_HAS_LUT) {
296 297 298 299 300 301 302 303 304
		vsp1->lut = vsp1_lut_create(vsp1);
		if (IS_ERR(vsp1->lut)) {
			ret = PTR_ERR(vsp1->lut);
			goto done;
		}

		list_add_tail(&vsp1->lut->entity.list_dev, &vsp1->entities);
	}

305
	for (i = 0; i < vsp1->info->rpf_count; ++i) {
306 307 308 309 310 311 312 313 314 315
		struct vsp1_rwpf *rpf;

		rpf = vsp1_rpf_create(vsp1, i);
		if (IS_ERR(rpf)) {
			ret = PTR_ERR(rpf);
			goto done;
		}

		vsp1->rpf[i] = rpf;
		list_add_tail(&rpf->entity.list_dev, &vsp1->entities);
316

317
		if (vsp1->info->uapi) {
318
			struct vsp1_video *video = vsp1_video_create(vsp1, rpf);
319

320 321 322 323 324 325 326
			if (IS_ERR(video)) {
				ret = PTR_ERR(video);
				goto done;
			}

			list_add_tail(&video->list, &vsp1->videos);
		}
327 328
	}

329
	if (vsp1->info->features & VSP1_HAS_SRU) {
330 331 332 333 334 335 336 337 338
		vsp1->sru = vsp1_sru_create(vsp1);
		if (IS_ERR(vsp1->sru)) {
			ret = PTR_ERR(vsp1->sru);
			goto done;
		}

		list_add_tail(&vsp1->sru->entity.list_dev, &vsp1->entities);
	}

339
	for (i = 0; i < vsp1->info->uds_count; ++i) {
340 341 342 343 344 345 346 347 348 349 350 351
		struct vsp1_uds *uds;

		uds = vsp1_uds_create(vsp1, i);
		if (IS_ERR(uds)) {
			ret = PTR_ERR(uds);
			goto done;
		}

		vsp1->uds[i] = uds;
		list_add_tail(&uds->entity.list_dev, &vsp1->entities);
	}

352
	for (i = 0; i < vsp1->info->wpf_count; ++i) {
353 354 355 356 357 358 359 360 361 362
		struct vsp1_rwpf *wpf;

		wpf = vsp1_wpf_create(vsp1, i);
		if (IS_ERR(wpf)) {
			ret = PTR_ERR(wpf);
			goto done;
		}

		vsp1->wpf[i] = wpf;
		list_add_tail(&wpf->entity.list_dev, &vsp1->entities);
363

364
		if (vsp1->info->uapi) {
365
			struct vsp1_video *video = vsp1_video_create(vsp1, wpf);
366

367 368 369 370 371 372 373 374
			if (IS_ERR(video)) {
				ret = PTR_ERR(video);
				goto done;
			}

			list_add_tail(&video->list, &vsp1->videos);
			wpf->entity.sink = &video->video.entity;
		}
375 376
	}

377 378 379 380 381 382 383 384
	/* Register all subdevs. */
	list_for_each_entry(entity, &vsp1->entities, list_dev) {
		ret = v4l2_device_register_subdev(&vsp1->v4l2_dev,
						  &entity->subdev);
		if (ret < 0)
			goto done;
	}

385
	/* Create links. */
386
	if (vsp1->info->uapi)
387 388 389
		ret = vsp1_uapi_create_links(vsp1);
	else
		ret = vsp1_drm_create_links(vsp1);
390 391
	if (ret < 0)
		goto done;
392

393 394 395
	/* Register subdev nodes if the userspace API is enabled or initialize
	 * the DRM pipeline otherwise.
	 */
396
	if (vsp1->info->uapi) {
397
		ret = v4l2_device_register_subdev_nodes(&vsp1->v4l2_dev);
398 399
		if (ret < 0)
			goto done;
400

401 402 403 404
		ret = media_device_register(mdev);
	} else {
		ret = vsp1_drm_init(vsp1);
	}
405 406 407 408 409 410 411 412

done:
	if (ret < 0)
		vsp1_destroy_entities(vsp1);

	return ret;
}

413
int vsp1_reset_wpf(struct vsp1_device *vsp1, unsigned int index)
414
{
415
	unsigned int timeout;
416 417 418
	u32 status;

	status = vsp1_read(vsp1, VI6_STATUS);
419 420
	if (!(status & VI6_STATUS_SYS_ACT(index)))
		return 0;
421

422 423 424 425 426
	vsp1_write(vsp1, VI6_SRESET, VI6_SRESET_SRTS(index));
	for (timeout = 10; timeout > 0; --timeout) {
		status = vsp1_read(vsp1, VI6_STATUS);
		if (!(status & VI6_STATUS_SYS_ACT(index)))
			break;
427

428 429
		usleep_range(1000, 2000);
	}
430

431 432 433 434
	if (!timeout) {
		dev_err(vsp1->dev, "failed to reset wpf.%u\n", index);
		return -ETIMEDOUT;
	}
435

436 437
	return 0;
}
438

439 440 441 442 443 444
static int vsp1_device_init(struct vsp1_device *vsp1)
{
	unsigned int i;
	int ret;

	/* Reset any channel that might be running. */
445
	for (i = 0; i < vsp1->info->wpf_count; ++i) {
446 447 448
		ret = vsp1_reset_wpf(vsp1, i);
		if (ret < 0)
			return ret;
449 450 451 452 453
	}

	vsp1_write(vsp1, VI6_CLK_DCSWT, (8 << VI6_CLK_DCSWT_CSTPW_SHIFT) |
		   (8 << VI6_CLK_DCSWT_CSTRW_SHIFT));

454
	for (i = 0; i < vsp1->info->rpf_count; ++i)
455 456
		vsp1_write(vsp1, VI6_DPR_RPF_ROUTE(i), VI6_DPR_NODE_UNUSED);

457
	for (i = 0; i < vsp1->info->uds_count; ++i)
458 459 460 461 462 463 464 465 466 467 468 469 470 471
		vsp1_write(vsp1, VI6_DPR_UDS_ROUTE(i), VI6_DPR_NODE_UNUSED);

	vsp1_write(vsp1, VI6_DPR_SRU_ROUTE, VI6_DPR_NODE_UNUSED);
	vsp1_write(vsp1, VI6_DPR_LUT_ROUTE, VI6_DPR_NODE_UNUSED);
	vsp1_write(vsp1, VI6_DPR_CLU_ROUTE, VI6_DPR_NODE_UNUSED);
	vsp1_write(vsp1, VI6_DPR_HST_ROUTE, VI6_DPR_NODE_UNUSED);
	vsp1_write(vsp1, VI6_DPR_HSI_ROUTE, VI6_DPR_NODE_UNUSED);
	vsp1_write(vsp1, VI6_DPR_BRU_ROUTE, VI6_DPR_NODE_UNUSED);

	vsp1_write(vsp1, VI6_DPR_HGO_SMPPT, (7 << VI6_DPR_SMPPT_TGW_SHIFT) |
		   (VI6_DPR_NODE_UNUSED << VI6_DPR_SMPPT_PT_SHIFT));
	vsp1_write(vsp1, VI6_DPR_HGT_SMPPT, (7 << VI6_DPR_SMPPT_TGW_SHIFT) |
		   (VI6_DPR_NODE_UNUSED << VI6_DPR_SMPPT_PT_SHIFT));

472
	vsp1_dlm_setup(vsp1);
473

474 475 476 477 478 479
	return 0;
}

/*
 * vsp1_device_get - Acquire the VSP1 device
 *
480
 * Make sure the device is not suspended and initialize it if needed.
481
 *
482
 * Return 0 on success or a negative error code otherwise.
483
 */
484
int vsp1_device_get(struct vsp1_device *vsp1)
485
{
486
	int ret;
487

488 489
	ret = pm_runtime_get_sync(vsp1->dev);
	return ret < 0 ? ret : 0;
490 491 492 493 494 495 496 497 498 499
}

/*
 * vsp1_device_put - Release the VSP1 device
 *
 * Decrement the VSP1 reference count and cleanup the device if the last
 * reference is released.
 */
void vsp1_device_put(struct vsp1_device *vsp1)
{
500
	pm_runtime_put_sync(vsp1->dev);
501 502 503 504 505 506 507 508 509 510 511
}

/* -----------------------------------------------------------------------------
 * Power Management
 */

#ifdef CONFIG_PM_SLEEP
static int vsp1_pm_suspend(struct device *dev)
{
	struct vsp1_device *vsp1 = dev_get_drvdata(dev);

512 513
	vsp1_pipelines_suspend(vsp1);
	pm_runtime_force_suspend(vsp1->dev);
514

515 516
	return 0;
}
517

518 519 520
static int vsp1_pm_resume(struct device *dev)
{
	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
521

522 523
	pm_runtime_force_resume(vsp1->dev);
	vsp1_pipelines_resume(vsp1);
524

525 526
	return 0;
}
527
#endif
528

529
static int vsp1_pm_runtime_suspend(struct device *dev)
530
{
531 532 533 534
	struct vsp1_device *vsp1 = dev_get_drvdata(dev);

	rcar_fcp_disable(vsp1->fcp);

535 536
	return 0;
}
537

538 539 540 541
static int vsp1_pm_runtime_resume(struct device *dev)
{
	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
	int ret;
542

543 544
	if (vsp1->info) {
		ret = vsp1_device_init(vsp1);
545
		if (ret < 0)
546 547
			return ret;
	}
548

549
	return rcar_fcp_enable(vsp1->fcp);
550 551 552 553
}

static const struct dev_pm_ops vsp1_pm_ops = {
	SET_SYSTEM_SLEEP_PM_OPS(vsp1_pm_suspend, vsp1_pm_resume)
554
	SET_RUNTIME_PM_OPS(vsp1_pm_runtime_suspend, vsp1_pm_runtime_resume, NULL)
555 556 557 558 559 560
};

/* -----------------------------------------------------------------------------
 * Platform Driver
 */

561 562 563
static const struct vsp1_device_info vsp1_device_infos[] = {
	{
		.version = VI6_IP_VERSION_MODEL_VSPS_H2,
564
		.gen = 2,
565
		.features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_LUT
566
			  | VSP1_HAS_SRU | VSP1_HAS_WPF_VFLIP,
567 568 569 570 571 572 573
		.rpf_count = 5,
		.uds_count = 3,
		.wpf_count = 4,
		.num_bru_inputs = 4,
		.uapi = true,
	}, {
		.version = VI6_IP_VERSION_MODEL_VSPR_H2,
574
		.gen = 2,
575
		.features = VSP1_HAS_BRU | VSP1_HAS_SRU | VSP1_HAS_WPF_VFLIP,
576
		.rpf_count = 5,
577
		.uds_count = 3,
578 579 580 581 582
		.wpf_count = 4,
		.num_bru_inputs = 4,
		.uapi = true,
	}, {
		.version = VI6_IP_VERSION_MODEL_VSPD_GEN2,
583
		.gen = 2,
584 585 586
		.features = VSP1_HAS_BRU | VSP1_HAS_LIF | VSP1_HAS_LUT,
		.rpf_count = 4,
		.uds_count = 1,
587
		.wpf_count = 1,
588 589 590 591
		.num_bru_inputs = 4,
		.uapi = true,
	}, {
		.version = VI6_IP_VERSION_MODEL_VSPS_M2,
592
		.gen = 2,
593
		.features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_LUT
594
			  | VSP1_HAS_SRU | VSP1_HAS_WPF_VFLIP,
595
		.rpf_count = 5,
596
		.uds_count = 1,
597 598 599 600 601
		.wpf_count = 4,
		.num_bru_inputs = 4,
		.uapi = true,
	}, {
		.version = VI6_IP_VERSION_MODEL_VSPI_GEN3,
602
		.gen = 3,
603 604
		.features = VSP1_HAS_CLU | VSP1_HAS_LUT | VSP1_HAS_SRU
			  | VSP1_HAS_WPF_HFLIP | VSP1_HAS_WPF_VFLIP,
605 606 607 608 609 610
		.rpf_count = 1,
		.uds_count = 1,
		.wpf_count = 1,
		.uapi = true,
	}, {
		.version = VI6_IP_VERSION_MODEL_VSPBD_GEN3,
611
		.gen = 3,
612
		.features = VSP1_HAS_BRU | VSP1_HAS_WPF_VFLIP,
613 614 615 616 617 618
		.rpf_count = 5,
		.wpf_count = 1,
		.num_bru_inputs = 5,
		.uapi = true,
	}, {
		.version = VI6_IP_VERSION_MODEL_VSPBC_GEN3,
619
		.gen = 3,
620 621
		.features = VSP1_HAS_BRU | VSP1_HAS_CLU | VSP1_HAS_LUT
			  | VSP1_HAS_WPF_VFLIP,
622 623 624 625 626 627
		.rpf_count = 5,
		.wpf_count = 1,
		.num_bru_inputs = 5,
		.uapi = true,
	}, {
		.version = VI6_IP_VERSION_MODEL_VSPD_GEN3,
628
		.gen = 3,
629
		.features = VSP1_HAS_BRU | VSP1_HAS_LIF | VSP1_HAS_WPF_VFLIP,
630 631 632 633 634
		.rpf_count = 5,
		.wpf_count = 2,
		.num_bru_inputs = 5,
	},
};
635

636 637 638
static int vsp1_probe(struct platform_device *pdev)
{
	struct vsp1_device *vsp1;
639
	struct device_node *fcp_node;
640 641
	struct resource *irq;
	struct resource *io;
642
	unsigned int i;
643
	u32 version;
644 645 646 647 648 649 650 651
	int ret;

	vsp1 = devm_kzalloc(&pdev->dev, sizeof(*vsp1), GFP_KERNEL);
	if (vsp1 == NULL)
		return -ENOMEM;

	vsp1->dev = &pdev->dev;
	INIT_LIST_HEAD(&vsp1->entities);
652
	INIT_LIST_HEAD(&vsp1->videos);
653

654 655
	platform_set_drvdata(pdev, vsp1);

656
	/* I/O and IRQ resources (clock managed by the clock PM domain) */
657 658
	io = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	vsp1->mmio = devm_ioremap_resource(&pdev->dev, io);
659 660
	if (IS_ERR(vsp1->mmio))
		return PTR_ERR(vsp1->mmio);
661 662 663 664 665 666 667 668 669 670 671 672 673 674

	irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
	if (!irq) {
		dev_err(&pdev->dev, "missing IRQ\n");
		return -EINVAL;
	}

	ret = devm_request_irq(&pdev->dev, irq->start, vsp1_irq_handler,
			      IRQF_SHARED, dev_name(&pdev->dev), vsp1);
	if (ret < 0) {
		dev_err(&pdev->dev, "failed to request IRQ\n");
		return ret;
	}

675 676 677 678 679 680 681 682 683 684 685 686
	/* FCP (optional) */
	fcp_node = of_parse_phandle(pdev->dev.of_node, "renesas,fcp", 0);
	if (fcp_node) {
		vsp1->fcp = rcar_fcp_get(fcp_node);
		of_node_put(fcp_node);
		if (IS_ERR(vsp1->fcp)) {
			dev_dbg(&pdev->dev, "FCP not found (%ld)\n",
				PTR_ERR(vsp1->fcp));
			return PTR_ERR(vsp1->fcp);
		}
	}

687
	/* Configure device parameters based on the version register. */
688 689 690
	pm_runtime_enable(&pdev->dev);

	ret = pm_runtime_get_sync(&pdev->dev);
691
	if (ret < 0)
692
		goto done;
693 694

	version = vsp1_read(vsp1, VI6_IP_VERSION);
695
	pm_runtime_put_sync(&pdev->dev);
696

697 698 699 700 701 702 703
	for (i = 0; i < ARRAY_SIZE(vsp1_device_infos); ++i) {
		if ((version & VI6_IP_VERSION_MODEL_MASK) ==
		    vsp1_device_infos[i].version) {
			vsp1->info = &vsp1_device_infos[i];
			break;
		}
	}
704

705 706
	if (!vsp1->info) {
		dev_err(&pdev->dev, "unsupported IP version 0x%08x\n", version);
707 708
		ret = -ENXIO;
		goto done;
709 710
	}

711 712
	dev_dbg(&pdev->dev, "IP version 0x%08x\n", version);

713 714 715 716
	/* Instanciate entities */
	ret = vsp1_create_entities(vsp1);
	if (ret < 0) {
		dev_err(&pdev->dev, "failed to create entities\n");
717
		goto done;
718 719
	}

720 721 722
done:
	if (ret)
		pm_runtime_disable(&pdev->dev);
723

724
	return ret;
725 726 727 728 729 730 731
}

static int vsp1_remove(struct platform_device *pdev)
{
	struct vsp1_device *vsp1 = platform_get_drvdata(pdev);

	vsp1_destroy_entities(vsp1);
732
	rcar_fcp_put(vsp1->fcp);
733

734 735
	pm_runtime_disable(&pdev->dev);

736 737 738
	return 0;
}

739 740
static const struct of_device_id vsp1_of_match[] = {
	{ .compatible = "renesas,vsp1" },
741
	{ .compatible = "renesas,vsp2" },
742 743 744
	{ },
};

745 746 747 748 749 750
static struct platform_driver vsp1_platform_driver = {
	.probe		= vsp1_probe,
	.remove		= vsp1_remove,
	.driver		= {
		.name	= "vsp1",
		.pm	= &vsp1_pm_ops,
751
		.of_match_table = vsp1_of_match,
752 753 754 755 756 757 758 759 760
	},
};

module_platform_driver(vsp1_platform_driver);

MODULE_ALIAS("vsp1");
MODULE_AUTHOR("Laurent Pinchart <laurent.pinchart@ideasonboard.com>");
MODULE_DESCRIPTION("Renesas VSP1 Driver");
MODULE_LICENSE("GPL");