[deliverable/linux.git] / drivers / media / platform / vsp1 / vsp1_drm.c

/*
 * vsp1_drm.c  --  R-Car VSP1 DRM API
 *
 * Copyright (C) 2015 Renesas Electronics Corporation
 *
 * 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/device.h>
#include <linux/slab.h>

#include <media/media-entity.h>
#include <media/v4l2-subdev.h>
#include <media/vsp1.h>

#include "vsp1.h"
#include "vsp1_bru.h"
#include "vsp1_dl.h"
#include "vsp1_drm.h"
#include "vsp1_lif.h"
#include "vsp1_pipe.h"
#include "vsp1_rwpf.h"


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

void vsp1_drm_display_start(struct vsp1_device *vsp1)
{
	vsp1_dlm_irq_display_start(vsp1->drm->pipe.output->dlm);
}

/* -----------------------------------------------------------------------------
 * DU Driver API
 */

int vsp1_du_init(struct device *dev)
{
	struct vsp1_device *vsp1 = dev_get_drvdata(dev);

	if (!vsp1)
		return -EPROBE_DEFER;

	return 0;
}
EXPORT_SYMBOL_GPL(vsp1_du_init);

/**
 * vsp1_du_setup_lif - Setup the output part of the VSP pipeline
 * @dev: the VSP device
 * @width: output frame width in pixels
 * @height: output frame height in pixels
 *
 * Configure the output part of VSP DRM pipeline for the given frame @width and
 * @height. This sets up formats on the BRU source pad, the WPF0 sink and source
 * pads, and the LIF sink pad.
 *
 * As the media bus code on the BRU source pad is conditioned by the
 * configuration of the BRU sink 0 pad, we also set up the formats on all BRU
 * sinks, even if the configuration will be overwritten later by
 * vsp1_du_setup_rpf(). This ensures that the BRU configuration is set to a well
 * defined state.
 *
 * Return 0 on success or a negative error code on failure.
 */
int vsp1_du_setup_lif(struct device *dev, unsigned int width,
		      unsigned int height)
{
	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
	struct vsp1_pipeline *pipe = &vsp1->drm->pipe;
	struct vsp1_bru *bru = vsp1->bru;
	struct v4l2_subdev_format format;
	unsigned int i;
	int ret;

	dev_dbg(vsp1->dev, "%s: configuring LIF with format %ux%u\n",
		__func__, width, height);

	if (width == 0 || height == 0) {
		/* Zero width or height means the CRTC is being disabled, stop
		 * the pipeline and turn the light off.
		 */
		ret = vsp1_pipeline_stop(pipe);
		if (ret == -ETIMEDOUT)
			dev_err(vsp1->dev, "DRM pipeline stop timeout\n");

		media_entity_pipeline_stop(&pipe->output->entity.subdev.entity);

		for (i = 0; i < bru->entity.source_pad; ++i) {
			vsp1->drm->inputs[i].enabled = false;
			bru->inputs[i].rpf = NULL;
			pipe->inputs[i] = NULL;
		}

		pipe->num_inputs = 0;

		vsp1_dlm_reset(pipe->output->dlm);
		vsp1_device_put(vsp1);

		dev_dbg(vsp1->dev, "%s: pipeline disabled\n", __func__);

		return 0;
	}

	/* Configure the format at the BRU sinks and propagate it through the
	 * pipeline.
	 */
	memset(&format, 0, sizeof(format));
	format.which = V4L2_SUBDEV_FORMAT_ACTIVE;

	for (i = 0; i < bru->entity.source_pad; ++i) {
		format.pad = i;

		format.format.width = width;
		format.format.height = height;
		format.format.code = MEDIA_BUS_FMT_ARGB8888_1X32;
		format.format.field = V4L2_FIELD_NONE;

		ret = v4l2_subdev_call(&bru->entity.subdev, pad,
				       set_fmt, NULL, &format);
		if (ret < 0)
			return ret;

		dev_dbg(vsp1->dev, "%s: set format %ux%u (%x) on BRU pad %u\n",
			__func__, format.format.width, format.format.height,
			format.format.code, i);
	}

	format.pad = bru->entity.source_pad;
	format.format.width = width;
	format.format.height = height;
	format.format.code = MEDIA_BUS_FMT_ARGB8888_1X32;
	format.format.field = V4L2_FIELD_NONE;

	ret = v4l2_subdev_call(&bru->entity.subdev, pad, set_fmt, NULL,
			       &format);
	if (ret < 0)
		return ret;

	dev_dbg(vsp1->dev, "%s: set format %ux%u (%x) on BRU pad %u\n",
		__func__, format.format.width, format.format.height,
		format.format.code, i);

	format.pad = RWPF_PAD_SINK;
	ret = v4l2_subdev_call(&vsp1->wpf[0]->entity.subdev, pad, set_fmt, NULL,
			       &format);
	if (ret < 0)
		return ret;

	dev_dbg(vsp1->dev, "%s: set format %ux%u (%x) on WPF0 sink\n",
		__func__, format.format.width, format.format.height,
		format.format.code);

	format.pad = RWPF_PAD_SOURCE;
	ret = v4l2_subdev_call(&vsp1->wpf[0]->entity.subdev, pad, get_fmt, NULL,
			       &format);
	if (ret < 0)
		return ret;

	dev_dbg(vsp1->dev, "%s: got format %ux%u (%x) on WPF0 source\n",
		__func__, format.format.width, format.format.height,
		format.format.code);

	format.pad = LIF_PAD_SINK;
	ret = v4l2_subdev_call(&vsp1->lif->entity.subdev, pad, set_fmt, NULL,
			       &format);
	if (ret < 0)
		return ret;

	dev_dbg(vsp1->dev, "%s: set format %ux%u (%x) on LIF sink\n",
		__func__, format.format.width, format.format.height,
		format.format.code);

	/* Verify that the format at the output of the pipeline matches the
	 * requested frame size and media bus code.
	 */
	if (format.format.width != width || format.format.height != height ||
	    format.format.code != MEDIA_BUS_FMT_ARGB8888_1X32) {
		dev_dbg(vsp1->dev, "%s: format mismatch\n", __func__);
		return -EPIPE;
	}

	/* Mark the pipeline as streaming and enable the VSP1. This will store
	 * the pipeline pointer in all entities, which the s_stream handlers
	 * will need. We don't start the entities themselves right at this point
	 * as there's no plane configured yet, so we can't start processing
	 * buffers.
	 */
	ret = vsp1_device_get(vsp1);
	if (ret < 0)
		return ret;

	ret = media_entity_pipeline_start(&pipe->output->entity.subdev.entity,
					  &pipe->pipe);
	if (ret < 0) {
		dev_dbg(vsp1->dev, "%s: pipeline start failed\n", __func__);
		vsp1_device_put(vsp1);
		return ret;
	}

	dev_dbg(vsp1->dev, "%s: pipeline enabled\n", __func__);

	return 0;
}
EXPORT_SYMBOL_GPL(vsp1_du_setup_lif);

/**
 * vsp1_du_atomic_begin - Prepare for an atomic update
 * @dev: the VSP device
 */
void vsp1_du_atomic_begin(struct device *dev)
{
	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
	struct vsp1_pipeline *pipe = &vsp1->drm->pipe;

	vsp1->drm->num_inputs = pipe->num_inputs;

	/* Prepare the display list. */
	pipe->dl = vsp1_dl_list_get(pipe->output->dlm);
}
EXPORT_SYMBOL_GPL(vsp1_du_atomic_begin);

/**
 * vsp1_du_atomic_update - Setup one RPF input of the VSP pipeline
 * @dev: the VSP device
 * @rpf_index: index of the RPF to setup (0-based)
 * @cfg: the RPF configuration
 *
 * Configure the VSP to perform image composition through RPF @rpf_index as
 * described by the @cfg configuration. The image to compose is referenced by
 * @cfg.mem and composed using the @cfg.src crop rectangle and the @cfg.dst
 * composition rectangle. The Z-order is configurable with higher @zpos values
 * displayed on top.
 *
 * If the @cfg configuration is NULL, the RPF will be disabled. Calling the
 * function on a disabled RPF is allowed.
 *
 * Image format as stored in memory is expressed as a V4L2 @cfg.pixelformat
 * value. The memory pitch is configurable to allow for padding at end of lines,
 * or simply for images that extend beyond the crop rectangle boundaries. The
 * @cfg.pitch value is expressed in bytes and applies to all planes for
 * multiplanar formats.
 *
 * The source memory buffer is referenced by the DMA address of its planes in
 * the @cfg.mem array. Up to two planes are supported. The second plane DMA
 * address is ignored for formats using a single plane.
 *
 * This function isn't reentrant, the caller needs to serialize calls.
 *
 * Return 0 on success or a negative error code on failure.
 */
int vsp1_du_atomic_update(struct device *dev, unsigned int rpf_index,
			  const struct vsp1_du_atomic_config *cfg)
{
	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
	const struct vsp1_format_info *fmtinfo;
	struct vsp1_rwpf *rpf;

	if (rpf_index >= vsp1->info->rpf_count)
		return -EINVAL;

	rpf = vsp1->rpf[rpf_index];

	if (!cfg) {
		dev_dbg(vsp1->dev, "%s: RPF%u: disable requested\n", __func__,
			rpf_index);

		vsp1->drm->inputs[rpf_index].enabled = false;
		return 0;
	}

	dev_dbg(vsp1->dev,
		"%s: RPF%u: (%u,%u)/%ux%u -> (%u,%u)/%ux%u (%08x), pitch %u dma { %pad, %pad, %pad } zpos %u\n",
		__func__, rpf_index,
		cfg->src.left, cfg->src.top, cfg->src.width, cfg->src.height,
		cfg->dst.left, cfg->dst.top, cfg->dst.width, cfg->dst.height,
		cfg->pixelformat, cfg->pitch, &cfg->mem[0], &cfg->mem[1],
		&cfg->mem[2], cfg->zpos);

	/* Store the format, stride, memory buffer address, crop and compose
	 * rectangles and Z-order position and for the input.
	 */
	fmtinfo = vsp1_get_format_info(cfg->pixelformat);
	if (!fmtinfo) {
		dev_dbg(vsp1->dev, "Unsupport pixel format %08x for RPF\n",
			cfg->pixelformat);
		return -EINVAL;
	}

	rpf->fmtinfo = fmtinfo;
	rpf->format.num_planes = fmtinfo->planes;
	rpf->format.plane_fmt[0].bytesperline = cfg->pitch;
	rpf->format.plane_fmt[1].bytesperline = cfg->pitch;
	rpf->alpha = cfg->alpha;

	rpf->mem.addr[0] = cfg->mem[0];
	rpf->mem.addr[1] = cfg->mem[1];
	rpf->mem.addr[2] = cfg->mem[2];

	vsp1->drm->inputs[rpf_index].crop = cfg->src;
	vsp1->drm->inputs[rpf_index].compose = cfg->dst;
	vsp1->drm->inputs[rpf_index].zpos = cfg->zpos;
	vsp1->drm->inputs[rpf_index].enabled = true;

	return 0;
}
EXPORT_SYMBOL_GPL(vsp1_du_atomic_update);

static int vsp1_du_setup_rpf_pipe(struct vsp1_device *vsp1,
				  struct vsp1_rwpf *rpf, unsigned int bru_input)
{
	struct v4l2_subdev_selection sel;
	struct v4l2_subdev_format format;
	const struct v4l2_rect *crop;
	int ret;

	/* Configure the format on the RPF sink pad and propagate it up to the
	 * BRU sink pad.
	 */
	crop = &vsp1->drm->inputs[rpf->entity.index].crop;

	memset(&format, 0, sizeof(format));
	format.which = V4L2_SUBDEV_FORMAT_ACTIVE;
	format.pad = RWPF_PAD_SINK;
	format.format.width = crop->width + crop->left;
	format.format.height = crop->height + crop->top;
	format.format.code = rpf->fmtinfo->mbus;
	format.format.field = V4L2_FIELD_NONE;

	ret = v4l2_subdev_call(&rpf->entity.subdev, pad, set_fmt, NULL,
			       &format);
	if (ret < 0)
		return ret;

	dev_dbg(vsp1->dev,
		"%s: set format %ux%u (%x) on RPF%u sink\n",
		__func__, format.format.width, format.format.height,
		format.format.code, rpf->entity.index);

	memset(&sel, 0, sizeof(sel));
	sel.which = V4L2_SUBDEV_FORMAT_ACTIVE;
	sel.pad = RWPF_PAD_SINK;
	sel.target = V4L2_SEL_TGT_CROP;
	sel.r = *crop;

	ret = v4l2_subdev_call(&rpf->entity.subdev, pad, set_selection, NULL,
			       &sel);
	if (ret < 0)
		return ret;

	dev_dbg(vsp1->dev,
		"%s: set selection (%u,%u)/%ux%u on RPF%u sink\n",
		__func__, sel.r.left, sel.r.top, sel.r.width, sel.r.height,
		rpf->entity.index);

	/* RPF source, hardcode the format to ARGB8888 to turn on format
	 * conversion if needed.
	 */
	format.pad = RWPF_PAD_SOURCE;

	ret = v4l2_subdev_call(&rpf->entity.subdev, pad, get_fmt, NULL,
			       &format);
	if (ret < 0)
		return ret;

	dev_dbg(vsp1->dev,
		"%s: got format %ux%u (%x) on RPF%u source\n",
		__func__, format.format.width, format.format.height,
		format.format.code, rpf->entity.index);

	format.format.code = MEDIA_BUS_FMT_ARGB8888_1X32;

	ret = v4l2_subdev_call(&rpf->entity.subdev, pad, set_fmt, NULL,
			       &format);
	if (ret < 0)
		return ret;

	/* BRU sink, propagate the format from the RPF source. */
	format.pad = bru_input;

	ret = v4l2_subdev_call(&vsp1->bru->entity.subdev, pad, set_fmt, NULL,
			       &format);
	if (ret < 0)
		return ret;

	dev_dbg(vsp1->dev, "%s: set format %ux%u (%x) on BRU pad %u\n",
		__func__, format.format.width, format.format.height,
		format.format.code, format.pad);

	sel.pad = bru_input;
	sel.target = V4L2_SEL_TGT_COMPOSE;
	sel.r = vsp1->drm->inputs[rpf->entity.index].compose;

	ret = v4l2_subdev_call(&vsp1->bru->entity.subdev, pad, set_selection,
			       NULL, &sel);
	if (ret < 0)
		return ret;

	dev_dbg(vsp1->dev,
		"%s: set selection (%u,%u)/%ux%u on BRU pad %u\n",
		__func__, sel.r.left, sel.r.top, sel.r.width, sel.r.height,
		sel.pad);

	return 0;
}

static unsigned int rpf_zpos(struct vsp1_device *vsp1, struct vsp1_rwpf *rpf)
{
	return vsp1->drm->inputs[rpf->entity.index].zpos;
}

/**
 * vsp1_du_atomic_flush - Commit an atomic update
 * @dev: the VSP device
 */
void vsp1_du_atomic_flush(struct device *dev)
{
	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
	struct vsp1_pipeline *pipe = &vsp1->drm->pipe;
	struct vsp1_rwpf *inputs[VSP1_MAX_RPF] = { NULL, };
	struct vsp1_entity *entity;
	unsigned long flags;
	unsigned int i;
	int ret;

	/* Count the number of enabled inputs and sort them by Z-order. */
	pipe->num_inputs = 0;

	for (i = 0; i < vsp1->info->rpf_count; ++i) {
		struct vsp1_rwpf *rpf = vsp1->rpf[i];
		unsigned int j;

		if (!vsp1->drm->inputs[i].enabled) {
			pipe->inputs[i] = NULL;
			continue;
		}

		pipe->inputs[i] = rpf;

		/* Insert the RPF in the sorted RPFs array. */
		for (j = pipe->num_inputs++; j > 0; --j) {
			if (rpf_zpos(vsp1, inputs[j-1]) <= rpf_zpos(vsp1, rpf))
				break;
			inputs[j] = inputs[j-1];
		}

		inputs[j] = rpf;
	}

	/* Setup the RPF input pipeline for every enabled input. */
	for (i = 0; i < vsp1->info->num_bru_inputs; ++i) {
		struct vsp1_rwpf *rpf = inputs[i];

		if (!rpf) {
			vsp1->bru->inputs[i].rpf = NULL;
			continue;
		}

		vsp1->bru->inputs[i].rpf = rpf;
		rpf->bru_input = i;
		rpf->entity.sink_pad = i;

		dev_dbg(vsp1->dev, "%s: connecting RPF.%u to BRU:%u\n",
			__func__, rpf->entity.index, i);

		ret = vsp1_du_setup_rpf_pipe(vsp1, rpf, i);
		if (ret < 0)
			dev_err(vsp1->dev,
				"%s: failed to setup RPF.%u\n",
				__func__, rpf->entity.index);
	}

	/* Configure all entities in the pipeline. */
	list_for_each_entry(entity, &pipe->entities, list_pipe) {
		/* Disconnect unused RPFs from the pipeline. */
		if (entity->type == VSP1_ENTITY_RPF) {
			struct vsp1_rwpf *rpf = to_rwpf(&entity->subdev);

			if (!pipe->inputs[rpf->entity.index]) {
				vsp1_dl_list_write(pipe->dl, entity->route->reg,
						   VI6_DPR_NODE_UNUSED);
				continue;
			}
		}

		vsp1_entity_route_setup(entity, pipe->dl);

		if (entity->ops->configure) {
			entity->ops->configure(entity, pipe, pipe->dl, true);
			entity->ops->configure(entity, pipe, pipe->dl, false);
		}

		/* The memory buffer address must be applied after configuring
		 * the RPF to make sure the crop offset are computed.
		 */
		if (entity->type == VSP1_ENTITY_RPF)
			vsp1_rwpf_set_memory(to_rwpf(&entity->subdev),
					     pipe->dl);
	}

	vsp1_dl_list_commit(pipe->dl);
	pipe->dl = NULL;

	/* Start or stop the pipeline if needed. */
	if (!vsp1->drm->num_inputs && pipe->num_inputs) {
		vsp1_write(vsp1, VI6_DISP_IRQ_STA, 0);
		vsp1_write(vsp1, VI6_DISP_IRQ_ENB, VI6_DISP_IRQ_ENB_DSTE);
		spin_lock_irqsave(&pipe->irqlock, flags);
		vsp1_pipeline_run(pipe);
		spin_unlock_irqrestore(&pipe->irqlock, flags);
	} else if (vsp1->drm->num_inputs && !pipe->num_inputs) {
		vsp1_write(vsp1, VI6_DISP_IRQ_ENB, 0);
		vsp1_pipeline_stop(pipe);
	}
}
EXPORT_SYMBOL_GPL(vsp1_du_atomic_flush);

/* -----------------------------------------------------------------------------
 * Initialization
 */

int vsp1_drm_create_links(struct vsp1_device *vsp1)
{
	const u32 flags = MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE;
	unsigned int i;
	int ret;

	/* VSPD instances require a BRU to perform composition and a LIF to
	 * output to the DU.
	 */
	if (!vsp1->bru || !vsp1->lif)
		return -ENXIO;

	for (i = 0; i < vsp1->info->rpf_count; ++i) {
		struct vsp1_rwpf *rpf = vsp1->rpf[i];

		ret = media_create_pad_link(&rpf->entity.subdev.entity,
					    RWPF_PAD_SOURCE,
					    &vsp1->bru->entity.subdev.entity,
					    i, flags);
		if (ret < 0)
			return ret;

		rpf->entity.sink = &vsp1->bru->entity.subdev.entity;
		rpf->entity.sink_pad = i;
	}

	ret = media_create_pad_link(&vsp1->bru->entity.subdev.entity,
				    vsp1->bru->entity.source_pad,
				    &vsp1->wpf[0]->entity.subdev.entity,
				    RWPF_PAD_SINK, flags);
	if (ret < 0)
		return ret;

	vsp1->bru->entity.sink = &vsp1->wpf[0]->entity.subdev.entity;
	vsp1->bru->entity.sink_pad = RWPF_PAD_SINK;

	ret = media_create_pad_link(&vsp1->wpf[0]->entity.subdev.entity,
				    RWPF_PAD_SOURCE,
				    &vsp1->lif->entity.subdev.entity,
				    LIF_PAD_SINK, flags);
	if (ret < 0)
		return ret;

	return 0;
}

int vsp1_drm_init(struct vsp1_device *vsp1)
{
	struct vsp1_pipeline *pipe;
	unsigned int i;

	vsp1->drm = devm_kzalloc(vsp1->dev, sizeof(*vsp1->drm), GFP_KERNEL);
	if (!vsp1->drm)
		return -ENOMEM;

	pipe = &vsp1->drm->pipe;

	vsp1_pipeline_init(pipe);

	/* The DRM pipeline is static, add entities manually. */
	for (i = 0; i < vsp1->info->rpf_count; ++i) {
		struct vsp1_rwpf *input = vsp1->rpf[i];

		list_add_tail(&input->entity.list_pipe, &pipe->entities);
	}

	list_add_tail(&vsp1->bru->entity.list_pipe, &pipe->entities);
	list_add_tail(&vsp1->wpf[0]->entity.list_pipe, &pipe->entities);
	list_add_tail(&vsp1->lif->entity.list_pipe, &pipe->entities);

	pipe->bru = &vsp1->bru->entity;
	pipe->lif = &vsp1->lif->entity;
	pipe->output = vsp1->wpf[0];

	return 0;
}

void vsp1_drm_cleanup(struct vsp1_device *vsp1)
{
}
Commit	Line	Data
f3af9572 LP	1	/*
	2	* vsp1_drm.c -- R-Car VSP1 DRM API
	3	*
	4	* Copyright (C) 2015 Renesas Electronics Corporation
	5	*
	6	* Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License as published by
	10	* the Free Software Foundation; either version 2 of the License, or
	11	* (at your option) any later version.
	12	*/
	13
	14	#include <linux/device.h>
	15	#include <linux/slab.h>
f3af9572 LP	16
	17	#include <media/media-entity.h>
	18	#include <media/v4l2-subdev.h>
c1741af7	19	#include <media/vsp1.h>
f3af9572 LP	20
	21	#include "vsp1.h"
	22	#include "vsp1_bru.h"
1517b039	23	#include "vsp1_dl.h"
f3af9572 LP	24	#include "vsp1_drm.h"
	25	#include "vsp1_lif.h"
	26	#include "vsp1_pipe.h"
	27	#include "vsp1_rwpf.h"
	28
c2dd2513 LP	29
	30	/* -----------------------------------------------------------------------------
	31	* Interrupt Handling
	32	*/
	33
ef9621bc	34	void vsp1_drm_display_start(struct vsp1_device *vsp1)
c2dd2513	35	{
ef9621bc LP	36	vsp1_dlm_irq_display_start(vsp1->drm->pipe.output->dlm);
ef9621bc LP	37	}
c2dd2513	38
f3af9572 LP	39	/* -----------------------------------------------------------------------------
	40	* DU Driver API
	41	*/
	42
	43	int vsp1_du_init(struct device *dev)
	44	{
	45	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
	46
	47	if (!vsp1)
	48	return -EPROBE_DEFER;
	49
	50	return 0;
	51	}
	52	EXPORT_SYMBOL_GPL(vsp1_du_init);
	53
	54	/**
	55	* vsp1_du_setup_lif - Setup the output part of the VSP pipeline
	56	* @dev: the VSP device
	57	* @width: output frame width in pixels
	58	* @height: output frame height in pixels
	59	*
	60	* Configure the output part of VSP DRM pipeline for the given frame @width and
	61	* @height. This sets up formats on the BRU source pad, the WPF0 sink and source
	62	* pads, and the LIF sink pad.
	63	*
	64	* As the media bus code on the BRU source pad is conditioned by the
	65	* configuration of the BRU sink 0 pad, we also set up the formats on all BRU
	66	* sinks, even if the configuration will be overwritten later by
	67	* vsp1_du_setup_rpf(). This ensures that the BRU configuration is set to a well
	68	* defined state.
	69	*
	70	* Return 0 on success or a negative error code on failure.
	71	*/
	72	int vsp1_du_setup_lif(struct device *dev, unsigned int width,
	73	unsigned int height)
	74	{
	75	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
	76	struct vsp1_pipeline *pipe = &vsp1->drm->pipe;
	77	struct vsp1_bru *bru = vsp1->bru;
	78	struct v4l2_subdev_format format;
	79	unsigned int i;
	80	int ret;
	81
	82	dev_dbg(vsp1->dev, "%s: configuring LIF with format %ux%u\n",
	83	__func__, width, height);
	84
	85	if (width == 0 \|\| height == 0) {
	86	/* Zero width or height means the CRTC is being disabled, stop
	87	* the pipeline and turn the light off.
	88	*/
	89	ret = vsp1_pipeline_stop(pipe);
	90	if (ret == -ETIMEDOUT)
	91	dev_err(vsp1->dev, "DRM pipeline stop timeout\n");
	92
	93	media_entity_pipeline_stop(&pipe->output->entity.subdev.entity);
	94
	95	for (i = 0; i < bru->entity.source_pad; ++i) {
f5e04e7e	96	vsp1->drm->inputs[i].enabled = false;
f3af9572 LP	97	bru->inputs[i].rpf = NULL;
	98	pipe->inputs[i] = NULL;
	99	}
	100
	101	pipe->num_inputs = 0;
	102
ef9621bc	103	vsp1_dlm_reset(pipe->output->dlm);
f3af9572 LP	104	vsp1_device_put(vsp1);
	105
	106	dev_dbg(vsp1->dev, "%s: pipeline disabled\n", __func__);
	107
	108	return 0;
	109	}
	110
	111	/* Configure the format at the BRU sinks and propagate it through the
	112	* pipeline.
	113	*/
	114	memset(&format, 0, sizeof(format));
	115	format.which = V4L2_SUBDEV_FORMAT_ACTIVE;
	116
	117	for (i = 0; i < bru->entity.source_pad; ++i) {
	118	format.pad = i;
	119
	120	format.format.width = width;
	121	format.format.height = height;
	122	format.format.code = MEDIA_BUS_FMT_ARGB8888_1X32;
	123	format.format.field = V4L2_FIELD_NONE;
	124
	125	ret = v4l2_subdev_call(&bru->entity.subdev, pad,
	126	set_fmt, NULL, &format);
	127	if (ret < 0)
	128	return ret;
	129
	130	dev_dbg(vsp1->dev, "%s: set format %ux%u (%x) on BRU pad %u\n",
	131	__func__, format.format.width, format.format.height,
	132	format.format.code, i);
	133	}
	134
	135	format.pad = bru->entity.source_pad;
	136	format.format.width = width;
	137	format.format.height = height;
	138	format.format.code = MEDIA_BUS_FMT_ARGB8888_1X32;
	139	format.format.field = V4L2_FIELD_NONE;
	140
	141	ret = v4l2_subdev_call(&bru->entity.subdev, pad, set_fmt, NULL,
	142	&format);
	143	if (ret < 0)
	144	return ret;
	145
	146	dev_dbg(vsp1->dev, "%s: set format %ux%u (%x) on BRU pad %u\n",
	147	__func__, format.format.width, format.format.height,
	148	format.format.code, i);
	149
	150	format.pad = RWPF_PAD_SINK;
	151	ret = v4l2_subdev_call(&vsp1->wpf[0]->entity.subdev, pad, set_fmt, NULL,
	152	&format);
	153	if (ret < 0)
	154	return ret;
	155
	156	dev_dbg(vsp1->dev, "%s: set format %ux%u (%x) on WPF0 sink\n",
	157	__func__, format.format.width, format.format.height,
	158	format.format.code);
	159
	160	format.pad = RWPF_PAD_SOURCE;
	161	ret = v4l2_subdev_call(&vsp1->wpf[0]->entity.subdev, pad, get_fmt, NULL,
	162	&format);
	163	if (ret < 0)
	164	return ret;
	165
	166	dev_dbg(vsp1->dev, "%s: got format %ux%u (%x) on WPF0 source\n",
	167	__func__, format.format.width, format.format.height,
168	format.format.code);
169
170	format.pad = LIF_PAD_SINK;
171	ret = v4l2_subdev_call(&vsp1->lif->entity.subdev, pad, set_fmt, NULL,
172	&format);
173	if (ret < 0)
174	return ret;
175
176	dev_dbg(vsp1->dev, "%s: set format %ux%u (%x) on LIF sink\n",
177	__func__, format.format.width, format.format.height,
178	format.format.code);
179
180	/* Verify that the format at the output of the pipeline matches the
181	* requested frame size and media bus code.
182	*/
183	if (format.format.width != width \|\| format.format.height != height \|\|
184	format.format.code != MEDIA_BUS_FMT_ARGB8888_1X32) {
185	dev_dbg(vsp1->dev, "%s: format mismatch\n", __func__);
186	return -EPIPE;
187	}
188
189	/* Mark the pipeline as streaming and enable the VSP1. This will store
190	* the pipeline pointer in all entities, which the s_stream handlers
191	* will need. We don't start the entities themselves right at this point
192	* as there's no plane configured yet, so we can't start processing
193	* buffers.
194	*/
195	ret = vsp1_device_get(vsp1);
196	if (ret < 0)
197	return ret;
198
199	ret = media_entity_pipeline_start(&pipe->output->entity.subdev.entity,
200	&pipe->pipe);
201	if (ret < 0) {
202	dev_dbg(vsp1->dev, "%s: pipeline start failed\n", __func__);
203	vsp1_device_put(vsp1);
204	return ret;
205	}
206
207	dev_dbg(vsp1->dev, "%s: pipeline enabled\n", __func__);
208
209	return 0;
210	}
211	EXPORT_SYMBOL_GPL(vsp1_du_setup_lif);
212
213	/**
7b4baddc LP	214	* vsp1_du_atomic_begin - Prepare for an atomic update
	215	* @dev: the VSP device
	216	*/
	217	void vsp1_du_atomic_begin(struct device *dev)
	218	{
	219	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
	220	struct vsp1_pipeline *pipe = &vsp1->drm->pipe;
7b4baddc LP	221
7b4baddc LP	222	vsp1->drm->num_inputs = pipe->num_inputs;
7b4baddc	223
1517b039	224	/* Prepare the display list. */
ef9621bc	225	pipe->dl = vsp1_dl_list_get(pipe->output->dlm);
7b4baddc LP	226	}
	227	EXPORT_SYMBOL_GPL(vsp1_du_atomic_begin);
	228
	229	/**
	230	* vsp1_du_atomic_update - Setup one RPF input of the VSP pipeline
f3af9572 LP	231	* @dev: the VSP device
f3af9572 LP	232	* @rpf_index: index of the RPF to setup (0-based)
c6b013ab	233	* @cfg: the RPF configuration
f3af9572	234	*
c6b013ab LP	235	* Configure the VSP to perform image composition through RPF @rpf_index as
	236	* described by the @cfg configuration. The image to compose is referenced by
	237	* @cfg.mem and composed using the @cfg.src crop rectangle and the @cfg.dst
f5e04e7e LP	238	* composition rectangle. The Z-order is configurable with higher @zpos values
f5e04e7e LP	239	* displayed on top.
f3af9572	240	*
c6b013ab	241	* If the @cfg configuration is NULL, the RPF will be disabled. Calling the
f3af9572 LP	242	* function on a disabled RPF is allowed.
f3af9572 LP	243	*
c6b013ab LP	244	* Image format as stored in memory is expressed as a V4L2 @cfg.pixelformat
	245	* value. The memory pitch is configurable to allow for padding at end of lines,
	246	* or simply for images that extend beyond the crop rectangle boundaries. The
	247	* @cfg.pitch value is expressed in bytes and applies to all planes for
	248	* multiplanar formats.
f3af9572 LP	249	*
f3af9572 LP	250	* The source memory buffer is referenced by the DMA address of its planes in
c6b013ab LP	251	* the @cfg.mem array. Up to two planes are supported. The second plane DMA
c6b013ab LP	252	* address is ignored for formats using a single plane.
f3af9572 LP	253	*
	254	* This function isn't reentrant, the caller needs to serialize calls.
	255	*
f3af9572 LP	256	* Return 0 on success or a negative error code on failure.
f3af9572 LP	257	*/
c3f34a4b LP	258	int vsp1_du_atomic_update(struct device *dev, unsigned int rpf_index,
c3f34a4b LP	259	const struct vsp1_du_atomic_config *cfg)
f3af9572 LP	260	{
f3af9572 LP	261	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
f3af9572	262	const struct vsp1_format_info *fmtinfo;
f3af9572	263	struct vsp1_rwpf *rpf;
f3af9572	264
5aa2eb3c	265	if (rpf_index >= vsp1->info->rpf_count)
f3af9572 LP	266	return -EINVAL;
	267
	268	rpf = vsp1->rpf[rpf_index];
	269
c6b013ab	270	if (!cfg) {
f3af9572 LP	271	dev_dbg(vsp1->dev, "%s: RPF%u: disable requested\n", __func__,
	272	rpf_index);
	273
f5e04e7e	274	vsp1->drm->inputs[rpf_index].enabled = false;
f3af9572 LP	275	return 0;
	276	}
	277
	278	dev_dbg(vsp1->dev,
bffba473	279	"%s: RPF%u: (%u,%u)/%ux%u -> (%u,%u)/%ux%u (%08x), pitch %u dma { %pad, %pad, %pad } zpos %u\n",
f3af9572	280	__func__, rpf_index,
c6b013ab LP	281	cfg->src.left, cfg->src.top, cfg->src.width, cfg->src.height,
	282	cfg->dst.left, cfg->dst.top, cfg->dst.width, cfg->dst.height,
	283	cfg->pixelformat, cfg->pitch, &cfg->mem[0], &cfg->mem[1],
bffba473	284	&cfg->mem[2], cfg->zpos);
f3af9572	285
f5e04e7e LP	286	/* Store the format, stride, memory buffer address, crop and compose
	287	* rectangles and Z-order position and for the input.
	288	*/
c6b013ab	289	fmtinfo = vsp1_get_format_info(cfg->pixelformat);
f3af9572 LP	290	if (!fmtinfo) {
f3af9572 LP	291	dev_dbg(vsp1->dev, "Unsupport pixel format %08x for RPF\n",
c6b013ab	292	cfg->pixelformat);
f3af9572 LP	293	return -EINVAL;
	294	}
	295
	296	rpf->fmtinfo = fmtinfo;
	297	rpf->format.num_planes = fmtinfo->planes;
c6b013ab LP	298	rpf->format.plane_fmt[0].bytesperline = cfg->pitch;
	299	rpf->format.plane_fmt[1].bytesperline = cfg->pitch;
	300	rpf->alpha = cfg->alpha;
f3af9572	301
c6b013ab LP	302	rpf->mem.addr[0] = cfg->mem[0];
c6b013ab LP	303	rpf->mem.addr[1] = cfg->mem[1];
bffba473	304	rpf->mem.addr[2] = cfg->mem[2];
f5e04e7e	305
c6b013ab LP	306	vsp1->drm->inputs[rpf_index].crop = cfg->src;
	307	vsp1->drm->inputs[rpf_index].compose = cfg->dst;
	308	vsp1->drm->inputs[rpf_index].zpos = cfg->zpos;
f5e04e7e LP	309	vsp1->drm->inputs[rpf_index].enabled = true;
	310
	311	return 0;
	312	}
c3f34a4b	313	EXPORT_SYMBOL_GPL(vsp1_du_atomic_update);
f5e04e7e LP	314
	315	static int vsp1_du_setup_rpf_pipe(struct vsp1_device *vsp1,
	316	struct vsp1_rwpf *rpf, unsigned int bru_input)
	317	{
	318	struct v4l2_subdev_selection sel;
	319	struct v4l2_subdev_format format;
	320	const struct v4l2_rect *crop;
	321	int ret;
	322
f3af9572 LP	323	/* Configure the format on the RPF sink pad and propagate it up to the
	324	* BRU sink pad.
	325	*/
f5e04e7e LP	326	crop = &vsp1->drm->inputs[rpf->entity.index].crop;
f5e04e7e LP	327
f3af9572 LP	328	memset(&format, 0, sizeof(format));
	329	format.which = V4L2_SUBDEV_FORMAT_ACTIVE;
	330	format.pad = RWPF_PAD_SINK;
f5e04e7e LP	331	format.format.width = crop->width + crop->left;
	332	format.format.height = crop->height + crop->top;
	333	format.format.code = rpf->fmtinfo->mbus;
f3af9572 LP	334	format.format.field = V4L2_FIELD_NONE;
	335
	336	ret = v4l2_subdev_call(&rpf->entity.subdev, pad, set_fmt, NULL,
	337	&format);
	338	if (ret < 0)
	339	return ret;
	340
	341	dev_dbg(vsp1->dev,
	342	"%s: set format %ux%u (%x) on RPF%u sink\n",
	343	__func__, format.format.width, format.format.height,
	344	format.format.code, rpf->entity.index);
	345
	346	memset(&sel, 0, sizeof(sel));
	347	sel.which = V4L2_SUBDEV_FORMAT_ACTIVE;
	348	sel.pad = RWPF_PAD_SINK;
	349	sel.target = V4L2_SEL_TGT_CROP;
f5e04e7e	350	sel.r = *crop;
f3af9572 LP	351
	352	ret = v4l2_subdev_call(&rpf->entity.subdev, pad, set_selection, NULL,
	353	&sel);
	354	if (ret < 0)
	355	return ret;
	356
	357	dev_dbg(vsp1->dev,
	358	"%s: set selection (%u,%u)/%ux%u on RPF%u sink\n",
	359	__func__, sel.r.left, sel.r.top, sel.r.width, sel.r.height,
	360	rpf->entity.index);
	361
	362	/* RPF source, hardcode the format to ARGB8888 to turn on format
	363	* conversion if needed.
	364	*/
	365	format.pad = RWPF_PAD_SOURCE;
	366
	367	ret = v4l2_subdev_call(&rpf->entity.subdev, pad, get_fmt, NULL,
	368	&format);
	369	if (ret < 0)
	370	return ret;
	371
	372	dev_dbg(vsp1->dev,
	373	"%s: got format %ux%u (%x) on RPF%u source\n",
	374	__func__, format.format.width, format.format.height,
	375	format.format.code, rpf->entity.index);
	376
	377	format.format.code = MEDIA_BUS_FMT_ARGB8888_1X32;
	378
	379	ret = v4l2_subdev_call(&rpf->entity.subdev, pad, set_fmt, NULL,
	380	&format);
	381	if (ret < 0)
	382	return ret;
	383
	384	/* BRU sink, propagate the format from the RPF source. */
f5e04e7e	385	format.pad = bru_input;
f3af9572 LP	386
	387	ret = v4l2_subdev_call(&vsp1->bru->entity.subdev, pad, set_fmt, NULL,
	388	&format);
	389	if (ret < 0)
	390	return ret;
	391
	392	dev_dbg(vsp1->dev, "%s: set format %ux%u (%x) on BRU pad %u\n",
	393	__func__, format.format.width, format.format.height,
	394	format.format.code, format.pad);
	395
f5e04e7e	396	sel.pad = bru_input;
f3af9572	397	sel.target = V4L2_SEL_TGT_COMPOSE;
f5e04e7e	398	sel.r = vsp1->drm->inputs[rpf->entity.index].compose;
f3af9572 LP	399
	400	ret = v4l2_subdev_call(&vsp1->bru->entity.subdev, pad, set_selection,
	401	NULL, &sel);
	402	if (ret < 0)
	403	return ret;
	404
	405	dev_dbg(vsp1->dev,
	406	"%s: set selection (%u,%u)/%ux%u on BRU pad %u\n",
	407	__func__, sel.r.left, sel.r.top, sel.r.width, sel.r.height,
	408	sel.pad);
	409
7b4baddc LP	410	return 0;
7b4baddc LP	411	}
f5e04e7e LP	412
	413	static unsigned int rpf_zpos(struct vsp1_device vsp1, struct vsp1_rwpf rpf)
	414	{
	415	return vsp1->drm->inputs[rpf->entity.index].zpos;
	416	}
7b4baddc LP	417
	418	/**
	419	* vsp1_du_atomic_flush - Commit an atomic update
	420	* @dev: the VSP device
	421	*/
	422	void vsp1_du_atomic_flush(struct device *dev)
	423	{
	424	struct vsp1_device *vsp1 = dev_get_drvdata(dev);
	425	struct vsp1_pipeline *pipe = &vsp1->drm->pipe;
f5e04e7e	426	struct vsp1_rwpf *inputs[VSP1_MAX_RPF] = { NULL, };
1517b039	427	struct vsp1_entity *entity;
7b4baddc	428	unsigned long flags;
f5e04e7e LP	429	unsigned int i;
	430	int ret;
	431
	432	/* Count the number of enabled inputs and sort them by Z-order. */
	433	pipe->num_inputs = 0;
	434
	435	for (i = 0; i < vsp1->info->rpf_count; ++i) {
	436	struct vsp1_rwpf *rpf = vsp1->rpf[i];
	437	unsigned int j;
	438
	439	if (!vsp1->drm->inputs[i].enabled) {
	440	pipe->inputs[i] = NULL;
	441	continue;
	442	}
	443
	444	pipe->inputs[i] = rpf;
	445
	446	/* Insert the RPF in the sorted RPFs array. */
	447	for (j = pipe->num_inputs++; j > 0; --j) {
	448	if (rpf_zpos(vsp1, inputs[j-1]) <= rpf_zpos(vsp1, rpf))
	449	break;
	450	inputs[j] = inputs[j-1];
	451	}
	452
	453	inputs[j] = rpf;
	454	}
	455
	456	/* Setup the RPF input pipeline for every enabled input. */
	457	for (i = 0; i < vsp1->info->num_bru_inputs; ++i) {
	458	struct vsp1_rwpf *rpf = inputs[i];
	459
	460	if (!rpf) {
	461	vsp1->bru->inputs[i].rpf = NULL;
	462	continue;
	463	}
	464
	465	vsp1->bru->inputs[i].rpf = rpf;
	466	rpf->bru_input = i;
	467	rpf->entity.sink_pad = i;
	468
	469	dev_dbg(vsp1->dev, "%s: connecting RPF.%u to BRU:%u\n",
	470	__func__, rpf->entity.index, i);
	471
	472	ret = vsp1_du_setup_rpf_pipe(vsp1, rpf, i);
	473	if (ret < 0)
	474	dev_err(vsp1->dev,
	475	"%s: failed to setup RPF.%u\n",
	476	__func__, rpf->entity.index);
	477	}
7b4baddc	478
f5e04e7e	479	/* Configure all entities in the pipeline. */
1517b039 TS	480	list_for_each_entry(entity, &pipe->entities, list_pipe) {
	481	/* Disconnect unused RPFs from the pipeline. */
	482	if (entity->type == VSP1_ENTITY_RPF) {
	483	struct vsp1_rwpf *rpf = to_rwpf(&entity->subdev);
	484
	485	if (!pipe->inputs[rpf->entity.index]) {
5e8dbbf3 LP	486	vsp1_dl_list_write(pipe->dl, entity->route->reg,
5e8dbbf3 LP	487	VI6_DPR_NODE_UNUSED);
1517b039 TS	488	continue;
	489	}
	490	}
	491
5e8dbbf3	492	vsp1_entity_route_setup(entity, pipe->dl);
1517b039	493
fc845e52 LP	494	if (entity->ops->configure) {
	495	entity->ops->configure(entity, pipe, pipe->dl, true);
	496	entity->ops->configure(entity, pipe, pipe->dl, false);
	497	}
351bbf99	498
f5e04e7e LP	499	/* The memory buffer address must be applied after configuring
	500	* the RPF to make sure the crop offset are computed.
	501	*/
351bbf99	502	if (entity->type == VSP1_ENTITY_RPF)
5e8dbbf3 LP	503	vsp1_rwpf_set_memory(to_rwpf(&entity->subdev),
5e8dbbf3 LP	504	pipe->dl);
1517b039 TS	505	}
1517b039 TS	506
c2dd2513 LP	507	vsp1_dl_list_commit(pipe->dl);
c2dd2513 LP	508	pipe->dl = NULL;
7b4baddc	509
351bbf99	510	/* Start or stop the pipeline if needed. */
1517b039 TS	511	if (!vsp1->drm->num_inputs && pipe->num_inputs) {
	512	vsp1_write(vsp1, VI6_DISP_IRQ_STA, 0);
	513	vsp1_write(vsp1, VI6_DISP_IRQ_ENB, VI6_DISP_IRQ_ENB_DSTE);
f5e04e7e	514	spin_lock_irqsave(&pipe->irqlock, flags);
1517b039	515	vsp1_pipeline_run(pipe);
f5e04e7e	516	spin_unlock_irqrestore(&pipe->irqlock, flags);
1517b039	517	} else if (vsp1->drm->num_inputs && !pipe->num_inputs) {
1517b039	518	vsp1_write(vsp1, VI6_DISP_IRQ_ENB, 0);
7b4baddc	519	vsp1_pipeline_stop(pipe);
1517b039	520	}
f3af9572	521	}
7b4baddc	522	EXPORT_SYMBOL_GPL(vsp1_du_atomic_flush);
f3af9572 LP	523
	524	/* -----------------------------------------------------------------------------
	525	* Initialization
	526	*/
	527
	528	int vsp1_drm_create_links(struct vsp1_device *vsp1)
	529	{
	530	const u32 flags = MEDIA_LNK_FL_ENABLED \| MEDIA_LNK_FL_IMMUTABLE;
	531	unsigned int i;
	532	int ret;
	533
	534	/* VSPD instances require a BRU to perform composition and a LIF to
	535	* output to the DU.
	536	*/
	537	if (!vsp1->bru \|\| !vsp1->lif)
	538	return -ENXIO;
	539
5aa2eb3c	540	for (i = 0; i < vsp1->info->rpf_count; ++i) {
f3af9572 LP	541	struct vsp1_rwpf *rpf = vsp1->rpf[i];
	542
	543	ret = media_create_pad_link(&rpf->entity.subdev.entity,
	544	RWPF_PAD_SOURCE,
	545	&vsp1->bru->entity.subdev.entity,
	546	i, flags);
	547	if (ret < 0)
	548	return ret;
	549
	550	rpf->entity.sink = &vsp1->bru->entity.subdev.entity;
	551	rpf->entity.sink_pad = i;
	552	}
	553
	554	ret = media_create_pad_link(&vsp1->bru->entity.subdev.entity,
	555	vsp1->bru->entity.source_pad,
	556	&vsp1->wpf[0]->entity.subdev.entity,
	557	RWPF_PAD_SINK, flags);
	558	if (ret < 0)
	559	return ret;
	560
	561	vsp1->bru->entity.sink = &vsp1->wpf[0]->entity.subdev.entity;
	562	vsp1->bru->entity.sink_pad = RWPF_PAD_SINK;
	563
	564	ret = media_create_pad_link(&vsp1->wpf[0]->entity.subdev.entity,
	565	RWPF_PAD_SOURCE,
	566	&vsp1->lif->entity.subdev.entity,
	567	LIF_PAD_SINK, flags);
	568	if (ret < 0)
	569	return ret;
	570
	571	return 0;
	572	}
	573
	574	int vsp1_drm_init(struct vsp1_device *vsp1)
	575	{
	576	struct vsp1_pipeline *pipe;
	577	unsigned int i;
	578
	579	vsp1->drm = devm_kzalloc(vsp1->dev, sizeof(*vsp1->drm), GFP_KERNEL);
	580	if (!vsp1->drm)
	581	return -ENOMEM;
	582
	583	pipe = &vsp1->drm->pipe;
	584
	585	vsp1_pipeline_init(pipe);
f3af9572 LP	586
f3af9572 LP	587	/* The DRM pipeline is static, add entities manually. */
5aa2eb3c	588	for (i = 0; i < vsp1->info->rpf_count; ++i) {
f3af9572 LP	589	struct vsp1_rwpf *input = vsp1->rpf[i];
	590
	591	list_add_tail(&input->entity.list_pipe, &pipe->entities);
	592	}
	593
	594	list_add_tail(&vsp1->bru->entity.list_pipe, &pipe->entities);
	595	list_add_tail(&vsp1->wpf[0]->entity.list_pipe, &pipe->entities);
	596	list_add_tail(&vsp1->lif->entity.list_pipe, &pipe->entities);
	597
	598	pipe->bru = &vsp1->bru->entity;
	599	pipe->lif = &vsp1->lif->entity;
	600	pipe->output = vsp1->wpf[0];
	601
	602	return 0;
	603	}
1517b039 TS	604
	605	void vsp1_drm_cleanup(struct vsp1_device *vsp1)
	606	{
1517b039	607	}