diff mbox series

[v3,09/10] media: hantro: Support VP9 on the G2 core

Message ID 20210805144246.11998-10-andrzej.p@collabora.com
State Accepted
Commit e2da465455ce48061f726f3a1aad2a3a5a6f547f
Headers show
Series VP9 codec V4L2 control interface | expand

Commit Message

Andrzej Pietrasiewicz Aug. 5, 2021, 2:42 p.m. UTC
VeriSilicon Hantro G2 core supports VP9 codec.

Signed-off-by: Andrzej Pietrasiewicz <andrzej.p@collabora.com>
---
 drivers/staging/media/hantro/Kconfig          |   1 +
 drivers/staging/media/hantro/Makefile         |   6 +-
 drivers/staging/media/hantro/hantro.h         |  26 +
 drivers/staging/media/hantro/hantro_drv.c     |  18 +-
 drivers/staging/media/hantro/hantro_g2_regs.h |  97 ++
 .../staging/media/hantro/hantro_g2_vp9_dec.c  | 978 ++++++++++++++++++
 drivers/staging/media/hantro/hantro_hw.h      |  67 ++
 drivers/staging/media/hantro/hantro_v4l2.c    |   6 +
 drivers/staging/media/hantro/hantro_vp9.c     | 240 +++++
 drivers/staging/media/hantro/hantro_vp9.h     | 103 ++
 drivers/staging/media/hantro/imx8m_vpu_hw.c   |  22 +-
 11 files changed, 1560 insertions(+), 4 deletions(-)
 create mode 100644 drivers/staging/media/hantro/hantro_g2_vp9_dec.c
 create mode 100644 drivers/staging/media/hantro/hantro_vp9.c
 create mode 100644 drivers/staging/media/hantro/hantro_vp9.h

Comments

Jernej Škrabec Aug. 9, 2021, 5:07 p.m. UTC | #1
Hi Andrzej!

Dne četrtek, 05. avgust 2021 ob 16:42:45 CEST je Andrzej Pietrasiewicz 
napisal(a):
> VeriSilicon Hantro G2 core supports VP9 codec.

> 

> Signed-off-by: Andrzej Pietrasiewicz <andrzej.p@collabora.com>

> ---

>  drivers/staging/media/hantro/Kconfig          |   1 +

>  drivers/staging/media/hantro/Makefile         |   6 +-

>  drivers/staging/media/hantro/hantro.h         |  26 +

>  drivers/staging/media/hantro/hantro_drv.c     |  18 +-

>  drivers/staging/media/hantro/hantro_g2_regs.h |  97 ++

>  .../staging/media/hantro/hantro_g2_vp9_dec.c  | 978 ++++++++++++++++++

>  drivers/staging/media/hantro/hantro_hw.h      |  67 ++

>  drivers/staging/media/hantro/hantro_v4l2.c    |   6 +

>  drivers/staging/media/hantro/hantro_vp9.c     | 240 +++++

>  drivers/staging/media/hantro/hantro_vp9.h     | 103 ++

>  drivers/staging/media/hantro/imx8m_vpu_hw.c   |  22 +-

>  11 files changed, 1560 insertions(+), 4 deletions(-)

>  create mode 100644 drivers/staging/media/hantro/hantro_g2_vp9_dec.c

>  create mode 100644 drivers/staging/media/hantro/hantro_vp9.c

>  create mode 100644 drivers/staging/media/hantro/hantro_vp9.h


<snip>

> diff --git a/drivers/staging/media/hantro/hantro_g2_vp9_dec.c b/drivers/

staging/media/hantro/hantro_g2_vp9_dec.c
> new file mode 100644

> index 000000000000..45a7be4a43fa

> --- /dev/null

> +++ b/drivers/staging/media/hantro/hantro_g2_vp9_dec.c

> @@ -0,0 +1,978 @@

> +// SPDX-License-Identifier: GPL-2.0

> +/*

> + * Hantro VP9 codec driver

> + *

> + * Copyright (C) 2021 Collabora Ltd.

> + */

> +#include "media/videobuf2-core.h"

> +#include "media/videobuf2-dma-contig.h"

> +#include "media/videobuf2-v4l2.h"

> +#include <linux/kernel.h>

> +#include <linux/vmalloc.h>

> +#include <media/v4l2-mem2mem.h>

> +#include <media/v4l2-vp9.h>

> +

> +#include "hantro.h"

> +#include "hantro_vp9.h"

> +#include "hantro_g2_regs.h"

> +

> +#define G2_ALIGN 16

> +

> +enum hantro_ref_frames {

> +	INTRA_FRAME = 0,

> +	LAST_FRAME = 1,

> +	GOLDEN_FRAME = 2,

> +	ALTREF_FRAME = 3,

> +	MAX_REF_FRAMES = 4

> +};

> +

> +static int start_prepare_run(struct hantro_ctx *ctx, const struct 

v4l2_ctrl_vp9_frame **dec_params)
> +{

> +	const struct v4l2_ctrl_vp9_compressed_hdr_probs *prob_updates;

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +	struct v4l2_ctrl *ctrl;

> +	unsigned int fctx_idx;

> +

> +	/* v4l2-specific stuff */

> +	hantro_start_prepare_run(ctx);

> +

> +	ctrl = v4l2_ctrl_find(&ctx->ctrl_handler, 

V4L2_CID_STATELESS_VP9_FRAME);
> +	if (WARN_ON(!ctrl))

> +		return -EINVAL;

> +	*dec_params = ctrl->p_cur.p;

> +

> +	ctrl = v4l2_ctrl_find(&ctx->ctrl_handler, 

V4L2_CID_STATELESS_VP9_COMPRESSED_HDR_PROBS);
> +	if (WARN_ON(!ctrl))

> +		return -EINVAL;

> +	prob_updates = ctrl->p_cur.p;

> +

> +	/*

> +	 * vp9 stuff

> +	 *

> +	 * by this point the userspace has done all parts of 6.2 

uncompressed_header()
> +	 * except this fragment:

> +	 * if ( FrameIsIntra || error_resilient_mode ) {

> +	 *	setup_past_independence ( )

> +	 *	if ( frame_type == KEY_FRAME || error_resilient_mode == 

1 ||
> +	 *	     reset_frame_context == 3 ) {

> +	 *		for ( i = 0; i < 4; i ++ ) {

> +	 *			save_probs( i )

> +	 *		}

> +	 *	} else if ( reset_frame_context == 2 ) {

> +	 *		save_probs( frame_context_idx )

> +	 *	}

> +	 *	frame_context_idx = 0

> +	 * }

> +	 */

> +	fctx_idx = v4l2_vp9_reset_frame_ctx(*dec_params, vp9_ctx-

>frame_context);

> +	vp9_ctx->cur.frame_context_idx = fctx_idx;

> +

> +	/* 6.1 frame(sz): load_probs() and load_probs2() */

> +	vp9_ctx->probability_tables = vp9_ctx->frame_context[fctx_idx];

> +

> +	/*

> +	 * The userspace has also performed 6.3 compressed_header(), but 

handling the
> +	 * probs in a special way. All probs which need updating, except 

MV-related,
> +	 * have been read from the bitstream and translated through 

inv_map_table[],
> +	 * but no 6.3.6 inv_recenter_nonneg(v, m) has been performed. The 

values passed
> +	 * by userspace are either translated values (there are no 0 values 

in
> +	 * inv_map_table[]), or zero to indicate no update. All MV-related 

probs which need
> +	 * updating have been read from the bitstream and (mv_prob << 1) | 

1 has been
> +	 * performed. The values passed by userspace are either new values

> +	 * to replace old ones (the above mentioned shift and bitwise or 

never result in
> +	 * a zero) or zero to indicate no update.

> +	 * fw_update_probs() performs actual probs updates or leaves probs 

as-is
> +	 * for values for which a zero was passed from userspace.

> +	 */

> +	v4l2_vp9_fw_update_probs(&vp9_ctx->probability_tables, 

prob_updates, *dec_params);
> +

> +	return 0;

> +}

> +

> +static size_t chroma_offset(const struct hantro_ctx *ctx,

> +			    const struct v4l2_ctrl_vp9_frame 

*dec_params)
> +{

> +	int bytes_per_pixel = dec_params->bit_depth == 8 ? 1 : 2;

> +

> +	return ctx->src_fmt.width * ctx->src_fmt.height * bytes_per_pixel;

> +}

> +

> +static size_t mv_offset(const struct hantro_ctx *ctx,

> +			const struct v4l2_ctrl_vp9_frame *dec_params)

> +{

> +	size_t cr_offset = chroma_offset(ctx, dec_params);

> +

> +	return ALIGN((cr_offset * 3) / 2, G2_ALIGN);

> +}

> +

> +static struct hantro_decoded_buffer *

> +get_ref_buf(struct hantro_ctx *ctx, struct vb2_v4l2_buffer *dst, u64 

timestamp)
> +{

> +	struct v4l2_m2m_ctx *m2m_ctx = ctx->fh.m2m_ctx;

> +	struct vb2_queue *cap_q = &m2m_ctx->cap_q_ctx.q;

> +	int buf_idx;

> +

> +	/*

> +	 * If a ref is unused or invalid, address of current destination

> +	 * buffer is returned.

> +	 */

> +	buf_idx = vb2_find_timestamp(cap_q, timestamp, 0);

> +	if (buf_idx < 0)

> +		return vb2_to_hantro_decoded_buf(&dst->vb2_buf);

> +

> +	return vb2_to_hantro_decoded_buf(vb2_get_buffer(cap_q, buf_idx));

> +}

> +

> +static void update_dec_buf_info(struct hantro_decoded_buffer *buf,

> +				const struct v4l2_ctrl_vp9_frame 

*dec_params)
> +{

> +	buf->vp9.width = dec_params->frame_width_minus_1 + 1;

> +	buf->vp9.height = dec_params->frame_height_minus_1 + 1;

> +	buf->vp9.bit_depth = dec_params->bit_depth;

> +}

> +

> +static void update_ctx_cur_info(struct hantro_vp9_dec_hw_ctx *vp9_ctx,

> +				struct hantro_decoded_buffer *buf,

> +				const struct v4l2_ctrl_vp9_frame 

*dec_params)
> +{

> +	vp9_ctx->cur.valid = true;

> +	vp9_ctx->cur.reference_mode = dec_params->reference_mode;

> +	vp9_ctx->cur.tx_mode = dec_params->tx_mode;

> +	vp9_ctx->cur.interpolation_filter = dec_params->interpolation_filter;

> +	vp9_ctx->cur.flags = dec_params->flags;

> +	vp9_ctx->cur.timestamp = buf->base.vb.vb2_buf.timestamp;

> +}

> +

> +static void config_output(struct hantro_ctx *ctx,

> +			  struct hantro_decoded_buffer *dst,

> +			  const struct v4l2_ctrl_vp9_frame 

*dec_params)
> +{

> +	dma_addr_t luma_addr, chroma_addr, mv_addr;

> +

> +	hantro_reg_write(ctx->dev, &g2_out_dis, 0);

> +	hantro_reg_write(ctx->dev, &g2_output_format, 0);

> +

> +	luma_addr = vb2_dma_contig_plane_dma_addr(&dst->base.vb.vb2_buf, 

0);
> +	hantro_write_addr(ctx->dev, G2_ADDR_DST, luma_addr);

> +

> +	chroma_addr = luma_addr + chroma_offset(ctx, dec_params);

> +	hantro_write_addr(ctx->dev, G2_ADDR_DST_CHR, chroma_addr);

> +

> +	mv_addr = luma_addr + mv_offset(ctx, dec_params);

> +	hantro_write_addr(ctx->dev, G2_ADDR_DST_MV, mv_addr);

> +}

> +

> +struct hantro_vp9_ref_reg {

> +	const struct hantro_reg width;

> +	const struct hantro_reg height;

> +	const struct hantro_reg hor_scale;

> +	const struct hantro_reg ver_scale;

> +	u32 y_base;

> +	u32 c_base;

> +};

> +

> +static void config_ref(struct hantro_ctx *ctx,

> +		       struct hantro_decoded_buffer *dst,

> +		       const struct hantro_vp9_ref_reg *ref_reg,

> +		       const struct v4l2_ctrl_vp9_frame *dec_params,

> +		       u64 ref_ts)

> +{

> +	struct hantro_decoded_buffer *buf;

> +	dma_addr_t luma_addr, chroma_addr;

> +	u32 refw, refh;

> +

> +	buf = get_ref_buf(ctx, &dst->base.vb, ref_ts);

> +	refw = buf->vp9.width;

> +	refh = buf->vp9.height;

> +

> +	hantro_reg_write(ctx->dev, &ref_reg->width, refw);

> +	hantro_reg_write(ctx->dev, &ref_reg->height, refh);

> +

> +	hantro_reg_write(ctx->dev, &ref_reg->hor_scale, (refw << 14) / dst-

>vp9.width);

> +	hantro_reg_write(ctx->dev, &ref_reg->ver_scale, (refh << 14) / dst-

>vp9.height);

> +

> +	luma_addr = vb2_dma_contig_plane_dma_addr(&buf->base.vb.vb2_buf, 

0);
> +	hantro_write_addr(ctx->dev, ref_reg->y_base, luma_addr);

> +

> +	chroma_addr = luma_addr + chroma_offset(ctx, dec_params);

> +	hantro_write_addr(ctx->dev, ref_reg->c_base, chroma_addr);

> +}

> +

> +static void config_ref_registers(struct hantro_ctx *ctx,

> +				 const struct v4l2_ctrl_vp9_frame 

*dec_params,
> +				 struct hantro_decoded_buffer *dst,

> +				 struct hantro_decoded_buffer 

*mv_ref)
> +{

> +	static const struct hantro_vp9_ref_reg ref_regs[] = {

> +		{

> +			/* Last */

> +			.width = vp9_lref_width,

> +			.height = vp9_lref_height,

> +			.hor_scale = vp9_lref_hor_scale,

> +			.ver_scale = vp9_lref_ver_scale,

> +			.y_base = G2_REG_ADDR_REF(0),

> +			.c_base = G2_REG_CHR_REF(0),

> +		}, {

> +			/* Golden */

> +			.width = vp9_gref_width,

> +			.height = vp9_gref_height,

> +			.hor_scale = vp9_gref_hor_scale,

> +			.ver_scale = vp9_gref_ver_scale,

> +			.y_base = G2_REG_ADDR_REF(4),

> +			.c_base = G2_REG_CHR_REF(4),

> +		}, {

> +			/* Altref */

> +			.width = vp9_aref_width,

> +			.height = vp9_aref_height,

> +			.hor_scale = vp9_aref_hor_scale,

> +			.ver_scale = vp9_aref_ver_scale,

> +			.y_base = G2_REG_ADDR_REF(5),

> +			.c_base = G2_REG_CHR_REF(5),

> +		},

> +	};

> +	dma_addr_t mv_addr;

> +

> +	config_ref(ctx, dst, &ref_regs[0], dec_params, dec_params-

>last_frame_ts);

> +	config_ref(ctx, dst, &ref_regs[1], dec_params, dec_params-

>golden_frame_ts);

> +	config_ref(ctx, dst, &ref_regs[2], dec_params, dec_params-

>alt_frame_ts);

> +

> +	mv_addr = vb2_dma_contig_plane_dma_addr(&mv_ref->base.vb.vb2_buf, 

0) +
> +		  mv_offset(ctx, dec_params);

> +	hantro_write_addr(ctx->dev, G2_REG_DMV_REF(0), mv_addr);

> +

> +	hantro_reg_write(ctx->dev, &vp9_last_sign_bias,

> +			 dec_params->ref_frame_sign_bias & 

V4L2_VP9_SIGN_BIAS_LAST ? 1 : 0);
> +

> +	hantro_reg_write(ctx->dev, &vp9_gref_sign_bias,

> +			 dec_params->ref_frame_sign_bias & 

V4L2_VP9_SIGN_BIAS_GOLDEN ? 1 : 0);
> +

> +	hantro_reg_write(ctx->dev, &vp9_aref_sign_bias,

> +			 dec_params->ref_frame_sign_bias & 

V4L2_VP9_SIGN_BIAS_ALT ? 1 : 0);

Not sure if I'm missing something, but V4L2_VP9_SIGN_BIAS_LAST, 
V4L2_VP9_SIGN_BIAS_GOLDEN and V4L2_VP9_SIGN_BIAS_ALT are defined in ordinary 
enum in patch 5, without any value, so they would have values 0, 1 and 2.

I guess you actually want (1 << 0), (1 << 1) and (1 << 2) in patch 5. Second 
and third flag still work by chance and first flag is always applied.

Best regards,
Jernej


> +}

> +

> +static void recompute_tile_info(unsigned short *tile_info, unsigned int 

tiles, unsigned int sbs)
> +{

> +	int i;

> +	unsigned int accumulated = 0;

> +	unsigned int next_accumulated;

> +

> +	for (i = 1; i <= tiles; ++i) {

> +		next_accumulated = i * sbs / tiles;

> +		*tile_info++ = next_accumulated - accumulated;

> +		accumulated = next_accumulated;

> +	}

> +}

> +

> +static void

> +recompute_tile_rc_info(struct hantro_ctx *ctx,

> +		       unsigned int tile_r, unsigned int tile_c,

> +		       unsigned int sbs_r, unsigned int sbs_c)

> +{

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +

> +	recompute_tile_info(vp9_ctx->tile_r_info, tile_r, sbs_r);

> +	recompute_tile_info(vp9_ctx->tile_c_info, tile_c, sbs_c);

> +

> +	vp9_ctx->last_tile_r = tile_r;

> +	vp9_ctx->last_tile_c = tile_c;

> +	vp9_ctx->last_sbs_r = sbs_r;

> +	vp9_ctx->last_sbs_c = sbs_c;

> +}

> +

> +static inline unsigned int first_tile_row(unsigned int tile_r, unsigned int 

sbs_r)
> +{

> +	if (tile_r == sbs_r + 1)

> +		return 1;

> +

> +	if (tile_r == sbs_r + 2)

> +		return 2;

> +

> +	return 0;

> +}

> +

> +static void

> +fill_tile_info(struct hantro_ctx *ctx,

> +	       unsigned int tile_r, unsigned int tile_c,

> +	       unsigned int sbs_r, unsigned int sbs_c,

> +	       unsigned short *tile_mem)

> +{

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +	unsigned int i, j;

> +	bool first = true;

> +

> +	for (i = first_tile_row(tile_r, sbs_r); i < tile_r; ++i) {

> +		unsigned short r_info = vp9_ctx->tile_r_info[i];

> +

> +		if (first) {

> +			if (i > 0)

> +				r_info += vp9_ctx->tile_r_info[0];

> +			if (i == 2)

> +				r_info += vp9_ctx->tile_r_info[1];

> +			first = false;

> +		}

> +		for (j = 0; j < tile_c; ++j) {

> +			*tile_mem++ = vp9_ctx->tile_c_info[j];

> +			*tile_mem++ = r_info;

> +		}

> +	}

> +}

> +

> +static void

> +config_tiles(struct hantro_ctx *ctx,

> +	     const struct v4l2_ctrl_vp9_frame *dec_params,

> +	     struct hantro_decoded_buffer *dst)

> +{

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +	struct hantro_aux_buf *misc = &vp9_ctx->misc;

> +	struct hantro_aux_buf *tile_edge = &vp9_ctx->tile_edge;

> +	dma_addr_t addr;

> +	unsigned short *tile_mem;

> +

> +	addr = misc->dma + vp9_ctx->tile_info_offset;

> +	hantro_write_addr(ctx->dev, G2_ADDR_TILE_SIZE, addr);

> +

> +	tile_mem = misc->cpu + vp9_ctx->tile_info_offset;

> +	if (dec_params->tile_cols_log2 || dec_params->tile_rows_log2) {

> +		unsigned int tile_r = (1 << dec_params->tile_rows_log2);

> +		unsigned int tile_c = (1 << dec_params->tile_cols_log2);

> +		unsigned int sbs_r = hantro_vp9_num_sbs(dst-

>vp9.height);

> +		unsigned int sbs_c = hantro_vp9_num_sbs(dst->vp9.width);

> +

> +		if (tile_r != vp9_ctx->last_tile_r || tile_c != vp9_ctx-

>last_tile_c ||

> +		    sbs_r != vp9_ctx->last_sbs_r || sbs_c != vp9_ctx-

>last_sbs_c)

> +			recompute_tile_rc_info(ctx, tile_r, tile_c, 

sbs_r, sbs_c);
> +

> +		fill_tile_info(ctx, tile_r, tile_c, sbs_r, sbs_c, 

tile_mem);
> +

> +		hantro_reg_write(ctx->dev, &g2_tile_e, 1);

> +		hantro_reg_write(ctx->dev, &g2_num_tile_cols, tile_c);

> +		hantro_reg_write(ctx->dev, &g2_num_tile_rows, tile_r);

> +

> +		addr = tile_edge->dma;

> +		hantro_write_addr(ctx->dev, G2_TILE_FILTER, addr);

> +

> +		addr = tile_edge->dma + vp9_ctx->bsd_ctrl_offset;

> +		hantro_write_addr(ctx->dev, G2_TILE_BSD, addr);

> +	} else {

> +		tile_mem[0] = hantro_vp9_num_sbs(dst->vp9.width);

> +		tile_mem[1] = hantro_vp9_num_sbs(dst->vp9.height);

> +

> +		hantro_reg_write(ctx->dev, &g2_tile_e, 0);

> +		hantro_reg_write(ctx->dev, &g2_num_tile_cols, 1);

> +		hantro_reg_write(ctx->dev, &g2_num_tile_rows, 1);

> +	}

> +}

> +

> +static void

> +update_feat_and_flag(struct hantro_vp9_dec_hw_ctx *vp9_ctx,

> +		     const struct v4l2_vp9_segmentation *seg,

> +		     enum v4l2_vp9_segment_feature feature,

> +		     unsigned int segid)

> +{

> +	u8 mask = V4L2_VP9_SEGMENT_FEATURE_ENABLED(feature);

> +

> +	vp9_ctx->feature_data[segid][feature] = seg->feature_data[segid]

[feature];
> +	vp9_ctx->feature_enabled[segid] &= ~mask;

> +	vp9_ctx->feature_enabled[segid] |= (seg->feature_enabled[segid] & 

mask);
> +}

> +

> +static inline s16 clip3(s16 x, s16 y, s16 z)

> +{

> +	return (z < x) ? x : (z > y) ? y : z;

> +}

> +

> +static s16 feat_val_clip3(s16 feat_val, s16 feature_data, bool absolute, u8 

clip)
> +{

> +	if (absolute)

> +		return feature_data;

> +

> +	return clip3(0, 255, feat_val + feature_data);

> +}

> +

> +static void config_segment(struct hantro_ctx *ctx, const struct 

v4l2_ctrl_vp9_frame *dec_params)
> +{

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +	const struct v4l2_vp9_segmentation *seg;

> +	s16 feat_val;

> +	unsigned char feat_id;

> +	unsigned int segid;

> +	bool segment_enabled, absolute, update_data;

> +

> +	static const struct hantro_reg seg_regs[8][V4L2_VP9_SEG_LVL_MAX] = 

{
> +		{ vp9_quant_seg0, vp9_filt_level_seg0, vp9_refpic_seg0, 

vp9_skip_seg0 },
> +		{ vp9_quant_seg1, vp9_filt_level_seg1, vp9_refpic_seg1, 

vp9_skip_seg1 },
> +		{ vp9_quant_seg2, vp9_filt_level_seg2, vp9_refpic_seg2, 

vp9_skip_seg2 },
> +		{ vp9_quant_seg3, vp9_filt_level_seg3, vp9_refpic_seg3, 

vp9_skip_seg3 },
> +		{ vp9_quant_seg4, vp9_filt_level_seg4, vp9_refpic_seg4, 

vp9_skip_seg4 },
> +		{ vp9_quant_seg5, vp9_filt_level_seg5, vp9_refpic_seg5, 

vp9_skip_seg5 },
> +		{ vp9_quant_seg6, vp9_filt_level_seg6, vp9_refpic_seg6, 

vp9_skip_seg6 },
> +		{ vp9_quant_seg7, vp9_filt_level_seg7, vp9_refpic_seg7, 

vp9_skip_seg7 },
> +	};

> +

> +	segment_enabled = !!(dec_params->seg.flags & 

V4L2_VP9_SEGMENTATION_FLAG_ENABLED);
> +	hantro_reg_write(ctx->dev, &vp9_segment_e, segment_enabled);

> +	hantro_reg_write(ctx->dev, &vp9_segment_upd_e,

> +			 !!(dec_params->seg.flags & 

V4L2_VP9_SEGMENTATION_FLAG_UPDATE_MAP));
> +	hantro_reg_write(ctx->dev, &vp9_segment_temp_upd_e,

> +			 !!(dec_params->seg.flags & 

V4L2_VP9_SEGMENTATION_FLAG_TEMPORAL_UPDATE));
> +

> +	seg = &dec_params->seg;

> +	absolute = !!(seg->flags & 

V4L2_VP9_SEGMENTATION_FLAG_ABS_OR_DELTA_UPDATE);
> +	update_data = !!(seg->flags & 

V4L2_VP9_SEGMENTATION_FLAG_UPDATE_DATA);
> +

> +	for (segid = 0; segid < 8; ++segid) {

> +		/* Quantizer segment feature */

> +		feat_id = V4L2_VP9_SEG_LVL_ALT_Q;

> +		feat_val = dec_params->quant.base_q_idx;

> +		if (segment_enabled) {

> +			if (update_data)

> +				update_feat_and_flag(vp9_ctx, seg, 

feat_id, segid);
> +			if (v4l2_vp9_seg_feat_enabled(vp9_ctx-

>feature_enabled, feat_id, segid))

> +				feat_val = 

feat_val_clip3(feat_val,
> +							  

vp9_ctx->feature_data[segid][feat_id],
> +							  

absolute, 255);
> +		}

> +		hantro_reg_write(ctx->dev, &seg_regs[segid][feat_id], 

feat_val);
> +

> +		/* Loop filter segment feature */

> +		feat_id = V4L2_VP9_SEG_LVL_ALT_L;

> +		feat_val = dec_params->lf.level;

> +		if (segment_enabled) {

> +			if (update_data)

> +				update_feat_and_flag(vp9_ctx, seg, 

feat_id, segid);
> +			if (v4l2_vp9_seg_feat_enabled(vp9_ctx-

>feature_enabled, feat_id, segid))

> +				feat_val = 

feat_val_clip3(feat_val,
> +							  

vp9_ctx->feature_data[segid][feat_id],
> +							  

absolute, 63);
> +		}

> +		hantro_reg_write(ctx->dev, &seg_regs[segid][feat_id], 

feat_val);
> +

> +		/* Reference frame segment feature */

> +		feat_id = V4L2_VP9_SEG_LVL_REF_FRAME;

> +		feat_val = 0;

> +		if (segment_enabled) {

> +			if (update_data)

> +				update_feat_and_flag(vp9_ctx, seg, 

feat_id, segid);
> +			if (!(dec_params->flags & 

V4L2_VP9_FRAME_FLAG_KEY_FRAME) &&
> +			    v4l2_vp9_seg_feat_enabled(vp9_ctx-

>feature_enabled, feat_id, segid))

> +				feat_val = vp9_ctx-

>feature_data[segid][feat_id] + 1;

> +		}

> +		hantro_reg_write(ctx->dev, &seg_regs[segid][feat_id], 

feat_val);
> +

> +		/* Skip segment feature */

> +		feat_id = V4L2_VP9_SEG_LVL_SKIP;

> +		feat_val = 0;

> +		if (segment_enabled) {

> +			if (update_data)

> +				update_feat_and_flag(vp9_ctx, seg, 

feat_id, segid);
> +			feat_val = v4l2_vp9_seg_feat_enabled(vp9_ctx-

>feature_enabled,

> +							     

feat_id, segid) ? 1 : 0;
> +		}

> +		hantro_reg_write(ctx->dev, &seg_regs[segid][feat_id], 

feat_val);
> +	}

> +}

> +

> +static void config_loop_filter(struct hantro_ctx *ctx, const struct 

v4l2_ctrl_vp9_frame *dec_params)
> +{

> +	bool d = dec_params->lf.flags & 

V4L2_VP9_LOOP_FILTER_FLAG_DELTA_ENABLED;
> +

> +	hantro_reg_write(ctx->dev, &vp9_filt_level, dec_params->lf.level);

> +	hantro_reg_write(ctx->dev, &g2_out_filtering_dis, dec_params-

>lf.level == 0);

> +	hantro_reg_write(ctx->dev, &vp9_filt_sharpness, dec_params-

>lf.sharpness);

> +

> +	hantro_reg_write(ctx->dev, &vp9_filt_ref_adj_0, d ? dec_params-

>lf.ref_deltas[0] : 0);

> +	hantro_reg_write(ctx->dev, &vp9_filt_ref_adj_1, d ? dec_params-

>lf.ref_deltas[1] : 0);

> +	hantro_reg_write(ctx->dev, &vp9_filt_ref_adj_2, d ? dec_params-

>lf.ref_deltas[2] : 0);

> +	hantro_reg_write(ctx->dev, &vp9_filt_ref_adj_3, d ? dec_params-

>lf.ref_deltas[3] : 0);

> +	hantro_reg_write(ctx->dev, &vp9_filt_mb_adj_0, d ? dec_params-

>lf.mode_deltas[0] : 0);

> +	hantro_reg_write(ctx->dev, &vp9_filt_mb_adj_1, d ? dec_params-

>lf.mode_deltas[1] : 0);

> +}

> +

> +static void config_picture_dimensions(struct hantro_ctx *ctx, struct 

hantro_decoded_buffer *dst)
> +{

> +	u32 pic_w_4x4, pic_h_4x4;

> +

> +	hantro_reg_write(ctx->dev, &g2_pic_width_in_cbs, (dst->vp9.width + 

7) / 8);
> +	hantro_reg_write(ctx->dev, &g2_pic_height_in_cbs, (dst->vp9.height 

+ 7) / 8);
> +	pic_w_4x4 = roundup(dst->vp9.width, 8) >> 2;

> +	pic_h_4x4 = roundup(dst->vp9.height, 8) >> 2;

> +	hantro_reg_write(ctx->dev, &g2_pic_width_4x4, pic_w_4x4);

> +	hantro_reg_write(ctx->dev, &g2_pic_height_4x4, pic_h_4x4);

> +}

> +

> +static void

> +config_bit_depth(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame 

*dec_params)
> +{

> +	hantro_reg_write(ctx->dev, &g2_bit_depth_y_minus8, dec_params-

>bit_depth - 8);

> +	hantro_reg_write(ctx->dev, &g2_bit_depth_c_minus8, dec_params-

>bit_depth - 8);

> +}

> +

> +static inline bool is_lossless(const struct v4l2_vp9_quantization *quant)

> +{

> +	return quant->base_q_idx == 0 && quant->delta_q_uv_ac == 0 &&

> +	       quant->delta_q_uv_dc == 0 && quant->delta_q_y_dc == 0;

> +}

> +

> +static void

> +config_quant(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame 

*dec_params)
> +{

> +	hantro_reg_write(ctx->dev, &vp9_qp_delta_y_dc, dec_params-

>quant.delta_q_y_dc);

> +	hantro_reg_write(ctx->dev, &vp9_qp_delta_ch_dc, dec_params-

>quant.delta_q_uv_dc);

> +	hantro_reg_write(ctx->dev, &vp9_qp_delta_ch_ac, dec_params-

>quant.delta_q_uv_ac);

> +	hantro_reg_write(ctx->dev, &vp9_lossless_e, 

is_lossless(&dec_params->quant));
> +}

> +

> +static u32

> +hantro_interp_filter_from_v4l2(enum v4l2_vp9_interpolation_filter 

interpolation_filter)
> +{

> +	switch (interpolation_filter) {

> +	case V4L2_VP9_INTERP_FILTER_EIGHTTAP:

> +		return 0x1;

> +	case V4L2_VP9_INTERP_FILTER_EIGHTTAP_SMOOTH:

> +		return 0;

> +	case V4L2_VP9_INTERP_FILTER_EIGHTTAP_SHARP:

> +		return 0x2;

> +	case V4L2_VP9_INTERP_FILTER_BILINEAR:

> +		return 0x3;

> +	case V4L2_VP9_INTERP_FILTER_SWITCHABLE:

> +		return 0x4;

> +	}

> +

> +	return 0;

> +}

> +

> +static void

> +config_others(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame 

*dec_params,
> +	      bool intra_only, bool resolution_change)

> +{

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +

> +	hantro_reg_write(ctx->dev, &g2_idr_pic_e, intra_only);

> +

> +	hantro_reg_write(ctx->dev, &vp9_transform_mode, dec_params-

>tx_mode);

> +

> +	hantro_reg_write(ctx->dev, &vp9_mcomp_filt_type, intra_only ?

> +		0 : hantro_interp_filter_from_v4l2(dec_params-

>interpolation_filter));

> +

> +	hantro_reg_write(ctx->dev, &vp9_high_prec_mv_e,

> +			 !!(dec_params->flags & 

V4L2_VP9_FRAME_FLAG_ALLOW_HIGH_PREC_MV));
> +

> +	hantro_reg_write(ctx->dev, &vp9_comp_pred_mode, dec_params-

>reference_mode);

> +

> +	hantro_reg_write(ctx->dev, &g2_tempor_mvp_e,

> +			 !(dec_params->flags & 

V4L2_VP9_FRAME_FLAG_ERROR_RESILIENT) &&
> +			 !(dec_params->flags & 

V4L2_VP9_FRAME_FLAG_KEY_FRAME) &&
> +			 !(vp9_ctx->last.flags & 

V4L2_VP9_FRAME_FLAG_KEY_FRAME) &&
> +			 !(dec_params->flags & 

V4L2_VP9_FRAME_FLAG_INTRA_ONLY) &&
> +			 !resolution_change &&

> +			 vp9_ctx->last.flags & 

V4L2_VP9_FRAME_FLAG_SHOW_FRAME
> +	);

> +

> +	hantro_reg_write(ctx->dev, &g2_write_mvs_e,

> +			 !(dec_params->flags & 

V4L2_VP9_FRAME_FLAG_KEY_FRAME));
> +}

> +

> +static void

> +config_compound_reference(struct hantro_ctx *ctx,

> +			  const struct v4l2_ctrl_vp9_frame 

*dec_params)
> +{

> +	u32 comp_fixed_ref, comp_var_ref[2];

> +	bool last_ref_frame_sign_bias;

> +	bool golden_ref_frame_sign_bias;

> +	bool alt_ref_frame_sign_bias;

> +	bool comp_ref_allowed = 0;

> +

> +	comp_fixed_ref = 0;

> +	comp_var_ref[0] = 0;

> +	comp_var_ref[1] = 0;

> +

> +	last_ref_frame_sign_bias = dec_params->ref_frame_sign_bias & 

V4L2_VP9_SIGN_BIAS_LAST;
> +	golden_ref_frame_sign_bias = dec_params->ref_frame_sign_bias & 

V4L2_VP9_SIGN_BIAS_GOLDEN;
> +	alt_ref_frame_sign_bias = dec_params->ref_frame_sign_bias & 

V4L2_VP9_SIGN_BIAS_ALT;
> +

> +	/* 6.3.12 Frame reference mode syntax */

> +	comp_ref_allowed |= golden_ref_frame_sign_bias != 

last_ref_frame_sign_bias;
> +	comp_ref_allowed |= alt_ref_frame_sign_bias != 

last_ref_frame_sign_bias;
> +

> +	if (comp_ref_allowed) {

> +		if (last_ref_frame_sign_bias ==

> +		    golden_ref_frame_sign_bias) {

> +			comp_fixed_ref = ALTREF_FRAME;

> +			comp_var_ref[0] = LAST_FRAME;

> +			comp_var_ref[1] = GOLDEN_FRAME;

> +		} else if (last_ref_frame_sign_bias ==

> +			   alt_ref_frame_sign_bias) {

> +			comp_fixed_ref = GOLDEN_FRAME;

> +			comp_var_ref[0] = LAST_FRAME;

> +			comp_var_ref[1] = ALTREF_FRAME;

> +		} else {

> +			comp_fixed_ref = LAST_FRAME;

> +			comp_var_ref[0] = GOLDEN_FRAME;

> +			comp_var_ref[1] = ALTREF_FRAME;

> +		}

> +	}

> +

> +	hantro_reg_write(ctx->dev, &vp9_comp_pred_fixed_ref, comp_fixed_ref);

> +	hantro_reg_write(ctx->dev, &vp9_comp_pred_var_ref0, 

comp_var_ref[0]);
> +	hantro_reg_write(ctx->dev, &vp9_comp_pred_var_ref1, 

comp_var_ref[1]);
> +}

> +

> +#define INNER_LOOP \

> +do {								

	\
> +	for (m = 0; m < ARRAY_SIZE(adaptive->coef[0][0][0][0]); ++m) {	\

> +		memcpy(adaptive->coef[i][j][k][l][m],			

\
> +		       probs->coef[i][j][k][l][m],			

\
> +		       sizeof(probs->coef[i][j][k][l][m]));		

\
> +								

	\
> +		adaptive->coef[i][j][k][l][m][3] = 0;			

\
> +	}							

	\
> +} while (0)

> +

> +static void config_probs(struct hantro_ctx *ctx, const struct 

v4l2_ctrl_vp9_frame *dec_params)
> +{

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +	struct hantro_aux_buf *misc = &vp9_ctx->misc;

> +	struct hantro_g2_all_probs *all_probs = misc->cpu;

> +	struct hantro_g2_probs *adaptive;

> +	struct hantro_g2_mv_probs *mv;

> +	const struct v4l2_vp9_segmentation *seg = &dec_params->seg;

> +	const struct v4l2_vp9_frame_context *probs = &vp9_ctx-

>probability_tables;

> +	int i, j, k, l, m;

> +

> +	for (i = 0; i < ARRAY_SIZE(all_probs->kf_y_mode_prob); ++i)

> +		for (j = 0; j < ARRAY_SIZE(all_probs-

>kf_y_mode_prob[0]); ++j) {

> +			memcpy(all_probs->kf_y_mode_prob[i][j],

> +			       v4l2_vp9_kf_y_mode_prob[i][j],

> +			       ARRAY_SIZE(all_probs-

>kf_y_mode_prob[i][j]));

> +

> +			all_probs->kf_y_mode_prob_tail[i][j][0] =

> +				v4l2_vp9_kf_y_mode_prob[i][j][8];

> +		}

> +

> +	memcpy(all_probs->mb_segment_tree_probs, seg->tree_probs,

> +	       sizeof(all_probs->mb_segment_tree_probs));

> +

> +	memcpy(all_probs->segment_pred_probs, seg->pred_probs,

> +	       sizeof(all_probs->segment_pred_probs));

> +

> +	for (i = 0; i < ARRAY_SIZE(all_probs->kf_uv_mode_prob); ++i) {

> +		memcpy(all_probs->kf_uv_mode_prob[i], 

v4l2_vp9_kf_uv_mode_prob[i],
> +		       ARRAY_SIZE(all_probs->kf_uv_mode_prob[i]));

> +

> +		all_probs->kf_uv_mode_prob_tail[i][0] = 

v4l2_vp9_kf_uv_mode_prob[i][8];
> +	}

> +

> +	adaptive = &all_probs->probs;

> +

> +	for (i = 0; i < ARRAY_SIZE(adaptive->inter_mode); ++i) {

> +		memcpy(adaptive->inter_mode[i], probs->inter_mode[i],

> +		       sizeof(probs->inter_mode));

> +

> +		adaptive->inter_mode[i][3] = 0;

> +	}

> +

> +	memcpy(adaptive->is_inter, probs->is_inter, sizeof(adaptive-

>is_inter));

> +

> +	for (i = 0; i < ARRAY_SIZE(adaptive->uv_mode); ++i) {

> +		memcpy(adaptive->uv_mode[i], probs->uv_mode[i],

> +		       sizeof(adaptive->uv_mode[i]));

> +		adaptive->uv_mode_tail[i][0] = probs->uv_mode[i][8];

> +	}

> +

> +	memcpy(adaptive->tx8, probs->tx8, sizeof(adaptive->tx8));

> +	memcpy(adaptive->tx16, probs->tx16, sizeof(adaptive->tx16));

> +	memcpy(adaptive->tx32, probs->tx32, sizeof(adaptive->tx32));

> +

> +	for (i = 0; i < ARRAY_SIZE(adaptive->y_mode); ++i) {

> +		memcpy(adaptive->y_mode[i], probs->y_mode[i],

> +		       ARRAY_SIZE(adaptive->y_mode[i]));

> +

> +		adaptive->y_mode_tail[i][0] = probs->y_mode[i][8];

> +	}

> +

> +	for (i = 0; i < ARRAY_SIZE(adaptive->partition[0]); ++i) {

> +		memcpy(adaptive->partition[0][i], 

v4l2_vp9_kf_partition_probs[i],
> +		       sizeof(v4l2_vp9_kf_partition_probs[i]));

> +

> +		adaptive->partition[0][i][3] = 0;

> +	}

> +

> +	for (i = 0; i < ARRAY_SIZE(adaptive->partition[1]); ++i) {

> +		memcpy(adaptive->partition[1][i], probs->partition[i],

> +		       sizeof(probs->partition[i]));

> +

> +		adaptive->partition[1][i][3] = 0;

> +	}

> +

> +	memcpy(adaptive->interp_filter, probs->interp_filter,

> +	       sizeof(adaptive->interp_filter));

> +

> +	memcpy(adaptive->comp_mode, probs->comp_mode, sizeof(adaptive-

>comp_mode));

> +

> +	memcpy(adaptive->skip, probs->skip, sizeof(adaptive->skip));

> +

> +	mv = &adaptive->mv;

> +

> +	memcpy(mv->joint, probs->mv.joint, sizeof(mv->joint));

> +	memcpy(mv->sign, probs->mv.sign, sizeof(mv->sign));

> +	memcpy(mv->class0_bit, probs->mv.class0_bit, sizeof(mv-

>class0_bit));

> +	memcpy(mv->fr, probs->mv.fr, sizeof(mv->fr));

> +	memcpy(mv->class0_hp, probs->mv.class0_hp, sizeof(mv->class0_hp));

> +	memcpy(mv->hp, probs->mv.hp, sizeof(mv->hp));

> +	memcpy(mv->classes, probs->mv.classes, sizeof(mv->classes));

> +	memcpy(mv->class0_fr, probs->mv.class0_fr, sizeof(mv->class0_fr));

> +	memcpy(mv->bits, probs->mv.bits, sizeof(mv->bits));

> +

> +	memcpy(adaptive->single_ref, probs->single_ref, sizeof(adaptive-

>single_ref));

> +

> +	memcpy(adaptive->comp_ref, probs->comp_ref, sizeof(adaptive-

>comp_ref));

> +

> +	for (i = 0; i < ARRAY_SIZE(adaptive->coef); ++i)

> +		for (j = 0; j < ARRAY_SIZE(adaptive->coef[0]); ++j)

> +			for (k = 0; k < ARRAY_SIZE(adaptive->coef[0]

[0]); ++k)
> +				for (l = 0; l < 

ARRAY_SIZE(adaptive->coef[0][0][0]); ++l)
> +					INNER_LOOP;

> +

> +	hantro_write_addr(ctx->dev, VP9_ADDR_PROBS, misc->dma);

> +}

> +

> +static void config_counts(struct hantro_ctx *ctx)

> +{

> +	struct hantro_vp9_dec_hw_ctx *vp9_dec = &ctx->vp9_dec;

> +	struct hantro_aux_buf *misc = &vp9_dec->misc;

> +	dma_addr_t addr = misc->dma + vp9_dec->ctx_counters_offset;

> +

> +	hantro_write_addr(ctx->dev, VP9_ADDR_CTR, addr);

> +}

> +

> +static void config_seg_map(struct hantro_ctx *ctx,

> +			   const struct v4l2_ctrl_vp9_frame 

*dec_params,
> +			   bool intra_only, bool update_map)

> +{

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +	struct hantro_aux_buf *segment_map = &vp9_ctx->segment_map;

> +	dma_addr_t addr;

> +

> +	if (intra_only ||

> +	    (dec_params->flags & V4L2_VP9_FRAME_FLAG_ERROR_RESILIENT)) {

> +		memset(segment_map->cpu, 0, segment_map->size);

> +		memset(vp9_ctx->feature_data, 0, sizeof(vp9_ctx-

>feature_data));

> +		memset(vp9_ctx->feature_enabled, 0, sizeof(vp9_ctx-

>feature_enabled));

> +	}

> +

> +	addr = segment_map->dma + vp9_ctx->active_segment * vp9_ctx-

>segment_map_size;

> +	hantro_write_addr(ctx->dev, VP9_ADDR_SEGMENT_READ, addr);

> +

> +	addr = segment_map->dma + (1 - vp9_ctx->active_segment) * vp9_ctx-

>segment_map_size;

> +	hantro_write_addr(ctx->dev, VP9_ADDR_SEGMENT_WRITE, addr);

> +

> +	if (update_map)

> +		vp9_ctx->active_segment = 1 - vp9_ctx->active_segment;

> +}

> +

> +static void

> +config_source(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame 

*dec_params,
> +	      struct vb2_v4l2_buffer *vb2_src)

> +{

> +	dma_addr_t stream_base, tmp_addr;

> +	unsigned int headres_size;

> +	u32 src_len, start_bit, src_buf_len;

> +

> +	headres_size = dec_params->uncompressed_header_size

> +		     + dec_params->compressed_header_size;

> +

> +	stream_base = vb2_dma_contig_plane_dma_addr(&vb2_src->vb2_buf, 0);

> +	hantro_write_addr(ctx->dev, G2_ADDR_STR, stream_base);

> +

> +	tmp_addr = stream_base + headres_size;

> +	start_bit = (tmp_addr & 0xf) * 8;

> +	hantro_reg_write(ctx->dev, &g2_start_bit, start_bit);

> +

> +	src_len = vb2_get_plane_payload(&vb2_src->vb2_buf, 0);

> +	src_len += start_bit / 8 - headres_size;

> +	hantro_reg_write(ctx->dev, &g2_stream_len, src_len);

> +

> +	tmp_addr &= ~0xf;

> +	hantro_reg_write(ctx->dev, &g2_strm_start_offset, tmp_addr - 

stream_base);
> +	src_buf_len = vb2_plane_size(&vb2_src->vb2_buf, 0);

> +	hantro_reg_write(ctx->dev, &g2_strm_buffer_len, src_buf_len);

> +}

> +

> +static void

> +config_registers(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame 

*dec_params,
> +		 struct vb2_v4l2_buffer *vb2_src, struct vb2_v4l2_buffer 

*vb2_dst)
> +{

> +	struct hantro_decoded_buffer *dst, *last, *mv_ref;

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +	const struct v4l2_vp9_segmentation *seg;

> +	bool intra_only, resolution_change;

> +

> +	/* vp9 stuff */

> +	dst = vb2_to_hantro_decoded_buf(&vb2_dst->vb2_buf);

> +

> +	if (vp9_ctx->last.valid)

> +		last = get_ref_buf(ctx, &dst->base.vb, vp9_ctx-

>last.timestamp);

> +	else

> +		last = dst;

> +

> +	update_dec_buf_info(dst, dec_params);

> +	update_ctx_cur_info(vp9_ctx, dst, dec_params);

> +	seg = &dec_params->seg;

> +

> +	intra_only = !!(dec_params->flags &

> +			(V4L2_VP9_FRAME_FLAG_KEY_FRAME |

> +			V4L2_VP9_FRAME_FLAG_INTRA_ONLY));

> +

> +	if (!intra_only &&

> +	    !(dec_params->flags & V4L2_VP9_FRAME_FLAG_ERROR_RESILIENT) &&

> +	    vp9_ctx->last.valid)

> +		mv_ref = last;

> +	else

> +		mv_ref = dst;

> +

> +	resolution_change = dst->vp9.width != last->vp9.width ||

> +			    dst->vp9.height != last->vp9.height;

> +

> +	/* configure basic registers */

> +	hantro_reg_write(ctx->dev, &g2_mode, VP9_DEC_MODE);

> +	hantro_reg_write(ctx->dev, &g2_strm_swap, 0xf);

> +	hantro_reg_write(ctx->dev, &g2_dirmv_swap, 0xf);

> +	hantro_reg_write(ctx->dev, &g2_compress_swap, 0xf);

> +	hantro_reg_write(ctx->dev, &g2_buswidth, BUS_WIDTH_128);

> +	hantro_reg_write(ctx->dev, &g2_max_burst, 16);

> +	hantro_reg_write(ctx->dev, &g2_apf_threshold, 8);

> +	hantro_reg_write(ctx->dev, &g2_ref_compress_bypass, 1);

> +	hantro_reg_write(ctx->dev, &g2_clk_gate_e, 1);

> +	hantro_reg_write(ctx->dev, &g2_max_cb_size, 6);

> +	hantro_reg_write(ctx->dev, &g2_min_cb_size, 3);

> +

> +	config_output(ctx, dst, dec_params);

> +

> +	if (!intra_only)

> +		config_ref_registers(ctx, dec_params, dst, mv_ref);

> +

> +	config_tiles(ctx, dec_params, dst);

> +	config_segment(ctx, dec_params);

> +	config_loop_filter(ctx, dec_params);

> +	config_picture_dimensions(ctx, dst);

> +	config_bit_depth(ctx, dec_params);

> +	config_quant(ctx, dec_params);

> +	config_others(ctx, dec_params, intra_only, resolution_change);

> +	config_compound_reference(ctx, dec_params);

> +	config_probs(ctx, dec_params);

> +	config_counts(ctx);

> +	config_seg_map(ctx, dec_params, intra_only,

> +		       seg->flags & 

V4L2_VP9_SEGMENTATION_FLAG_UPDATE_MAP);
> +	config_source(ctx, dec_params, vb2_src);

> +}

> +

> +int hantro_g2_vp9_dec_run(struct hantro_ctx *ctx)

> +{

> +	const struct v4l2_ctrl_vp9_frame *decode_params;

> +	struct vb2_v4l2_buffer *src;

> +	struct vb2_v4l2_buffer *dst;

> +	int ret;

> +

> +	hantro_g2_check_idle(ctx->dev);

> +

> +	ret = start_prepare_run(ctx, &decode_params);

> +	if (ret) {

> +		hantro_end_prepare_run(ctx);

> +		return ret;

> +	}

> +

> +	src = hantro_get_src_buf(ctx);

> +	dst = hantro_get_dst_buf(ctx);

> +

> +	config_registers(ctx, decode_params, src, dst);

> +

> +	hantro_end_prepare_run(ctx);

> +

> +	vdpu_write(ctx->dev, G2_REG_INTERRUPT_DEC_E, G2_REG_INTERRUPT);

> +

> +	return 0;

> +}

> +

> +#define copy_tx_and_skip(p1, p2)				\

> +do {								

\
> +	memcpy((p1)->tx8, (p2)->tx8, sizeof((p1)->tx8));	\

> +	memcpy((p1)->tx16, (p2)->tx16, sizeof((p1)->tx16));	\

> +	memcpy((p1)->tx32, (p2)->tx32, sizeof((p1)->tx32));	\

> +	memcpy((p1)->skip, (p2)->skip, sizeof((p1)->skip));	\

> +} while (0)

> +

> +void hantro_g2_vp9_dec_done(struct hantro_ctx *ctx)

> +{

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +	unsigned int fctx_idx;

> +

> +	if (!(vp9_ctx->cur.flags & V4L2_VP9_FRAME_FLAG_REFRESH_FRAME_CTX))

> +		goto out_update_last;

> +

> +	fctx_idx = vp9_ctx->cur.frame_context_idx;

> +

> +	if (!(vp9_ctx->cur.flags & V4L2_VP9_FRAME_FLAG_PARALLEL_DEC_MODE)) {

> +		/* error_resilient_mode == 0 && 

frame_parallel_decoding_mode == 0 */
> +		struct v4l2_vp9_frame_context *probs = &vp9_ctx-

>probability_tables;

> +		bool frame_is_intra = vp9_ctx->cur.flags &

> +		    (V4L2_VP9_FRAME_FLAG_KEY_FRAME | 

V4L2_VP9_FRAME_FLAG_INTRA_ONLY);
> +		struct tx_and_skip {

> +			u8 tx8[2][1];

> +			u8 tx16[2][2];

> +			u8 tx32[2][3];

> +			u8 skip[3];

> +		} _tx_skip, *tx_skip = &_tx_skip;

> +		struct v4l2_vp9_frame_symbol_counts *counts;

> +		struct symbol_counts *hantro_cnts;

> +		u32 tx16p[2][4];

> +		int i;

> +

> +		/* buffer the forward-updated TX and skip probs */

> +		if (frame_is_intra)

> +			copy_tx_and_skip(tx_skip, probs);

> +

> +		/* 6.1.2 refresh_probs(): load_probs() and load_probs2() 

*/
> +		*probs = vp9_ctx->frame_context[fctx_idx];

> +

> +		/* if FrameIsIntra then undo the effect of load_probs2() 

*/
> +		if (frame_is_intra)

> +			copy_tx_and_skip(probs, tx_skip);

> +

> +		counts = &vp9_ctx->cnts;

> +		hantro_cnts = vp9_ctx->misc.cpu + vp9_ctx-

>ctx_counters_offset;

> +		for (i = 0; i < ARRAY_SIZE(tx16p); ++i) {

> +			memcpy(tx16p[i],

> +			       hantro_cnts->tx16x16_count[i],

> +			       sizeof(hantro_cnts-

>tx16x16_count[0]));

> +			tx16p[i][3] = 0;

> +		}

> +		counts->tx16p = &tx16p;

> +

> +		v4l2_vp9_adapt_coef_probs(probs, counts,

> +					  !vp9_ctx->last.valid 

||
> +					  vp9_ctx->last.flags & 

V4L2_VP9_FRAME_FLAG_KEY_FRAME,
> +					  frame_is_intra);

> +

> +		if (!frame_is_intra) {

> +			/* load_probs2() already done */

> +			u32 mv_mode[7][4];

> +

> +			for (i = 0; i < ARRAY_SIZE(mv_mode); ++i) {

> +				mv_mode[i][0] = hantro_cnts-

>inter_mode_counts[i][1][0];

> +				mv_mode[i][1] = hantro_cnts-

>inter_mode_counts[i][2][0];

> +				mv_mode[i][2] = hantro_cnts-

>inter_mode_counts[i][0][0];

> +				mv_mode[i][3] = hantro_cnts-

>inter_mode_counts[i][2][1];

> +			}

> +			counts->mv_mode = &mv_mode;

> +			v4l2_vp9_adapt_noncoef_probs(&vp9_ctx-

>probability_tables, counts,

> +						     

vp9_ctx->cur.reference_mode,
> +						     

vp9_ctx->cur.interpolation_filter,
> +						     

vp9_ctx->cur.tx_mode, vp9_ctx->cur.flags);
> +		}

> +	}

> +

> +	vp9_ctx->frame_context[fctx_idx] = vp9_ctx->probability_tables;

> +

> +out_update_last:

> +	vp9_ctx->last = vp9_ctx->cur;

> +}

> diff --git a/drivers/staging/media/hantro/hantro_hw.h b/drivers/staging/

media/hantro/hantro_hw.h
> index 42b3f3961f75..2961d399fd60 100644

> --- a/drivers/staging/media/hantro/hantro_hw.h

> +++ b/drivers/staging/media/hantro/hantro_hw.h

> @@ -12,6 +12,7 @@

>  #include <linux/interrupt.h>

>  #include <linux/v4l2-controls.h>

>  #include <media/v4l2-ctrls.h>

> +#include <media/v4l2-vp9.h>

>  #include <media/videobuf2-core.h>

>  

>  #define DEC_8190_ALIGN_MASK	0x07U

> @@ -161,6 +162,50 @@ struct hantro_vp8_dec_hw_ctx {

>  	struct hantro_aux_buf prob_tbl;

>  };

>  

> +struct hantro_vp9_frame_info {

> +	u32 valid : 1;

> +	u32 frame_context_idx : 2;

> +	u32 reference_mode : 2;

> +	u32 tx_mode : 3;

> +	u32 interpolation_filter : 3;

> +	u32 flags;

> +	u64 timestamp;

> +};

> +

> +#define MAX_SB_COLS	64

> +#define MAX_SB_ROWS	34

> +

> +/**

> + * struct hantro_vp9_dec_hw_ctx

> + *

> + */

> +struct hantro_vp9_dec_hw_ctx {

> +	struct hantro_aux_buf tile_edge;

> +	struct hantro_aux_buf segment_map;

> +	struct hantro_aux_buf misc;

> +	struct v4l2_vp9_frame_symbol_counts cnts;

> +	struct v4l2_vp9_frame_context probability_tables;

> +	struct v4l2_vp9_frame_context frame_context[4];

> +	struct hantro_vp9_frame_info cur;

> +	struct hantro_vp9_frame_info last;

> +

> +	unsigned int bsd_ctrl_offset;

> +	unsigned int segment_map_size;

> +	unsigned int ctx_counters_offset;

> +	unsigned int tile_info_offset;

> +

> +	unsigned short tile_r_info[MAX_SB_ROWS];

> +	unsigned short tile_c_info[MAX_SB_COLS];

> +	unsigned int last_tile_r;

> +	unsigned int last_tile_c;

> +	unsigned int last_sbs_r;

> +	unsigned int last_sbs_c;

> +

> +	unsigned int active_segment;

> +	u8 feature_enabled[8];

> +	s16 feature_data[8][4];

> +};

> +

>  /**

>   * struct hantro_postproc_ctx

>   *

> @@ -267,6 +312,24 @@ void hantro_hevc_ref_remove_unused(struct hantro_ctx 

*ctx);
>  size_t hantro_hevc_chroma_offset(const struct v4l2_ctrl_hevc_sps *sps);

>  size_t hantro_hevc_motion_vectors_offset(const struct v4l2_ctrl_hevc_sps 

*sps);
>  

> +static inline unsigned short hantro_vp9_num_sbs(unsigned short dimension)

> +{

> +	return (dimension + 63) / 64;

> +}

> +

> +static inline size_t

> +hantro_vp9_mv_size(unsigned int width, unsigned int height)

> +{

> +	int num_ctbs;

> +

> +	/*

> +	 * There can be up to (CTBs x 64) number of blocks,

> +	 * and the motion vector for each block needs 16 bytes.

> +	 */

> +	num_ctbs = hantro_vp9_num_sbs(width) * hantro_vp9_num_sbs(height);

> +	return (num_ctbs * 64) * 16;

> +}

> +

>  static inline size_t

>  hantro_h264_mv_size(unsigned int width, unsigned int height)

>  {

> @@ -308,6 +371,10 @@ void hantro_vp8_dec_exit(struct hantro_ctx *ctx);

>  void hantro_vp8_prob_update(struct hantro_ctx *ctx,

>  			    const struct v4l2_ctrl_vp8_frame *hdr);

>  

> +int hantro_g2_vp9_dec_run(struct hantro_ctx *ctx);

> +void hantro_g2_vp9_dec_done(struct hantro_ctx *ctx);

> +int hantro_vp9_dec_init(struct hantro_ctx *ctx);

> +void hantro_vp9_dec_exit(struct hantro_ctx *ctx);

>  void hantro_g2_check_idle(struct hantro_dev *vpu);

>  

>  #endif /* HANTRO_HW_H_ */

> diff --git a/drivers/staging/media/hantro/hantro_v4l2.c b/drivers/staging/

media/hantro/hantro_v4l2.c
> index d1f060c55fed..e4b0645ba6fc 100644

> --- a/drivers/staging/media/hantro/hantro_v4l2.c

> +++ b/drivers/staging/media/hantro/hantro_v4l2.c

> @@ -299,6 +299,11 @@ static int hantro_try_fmt(const struct hantro_ctx *ctx,

>  			pix_mp->plane_fmt[0].sizeimage +=

>  				hantro_h264_mv_size(pix_mp-

>width,

>  						    pix_mp-

>height);

> +		else if (ctx->vpu_src_fmt->fourcc == 

V4L2_PIX_FMT_VP9_FRAME &&
> +			 !hantro_needs_postproc(ctx, fmt))

> +			pix_mp->plane_fmt[0].sizeimage +=

> +				hantro_vp9_mv_size(pix_mp->width,

> +						   pix_mp-

>height);

>  	} else if (!pix_mp->plane_fmt[0].sizeimage) {

>  		/*

>  		 * For coded formats the application can specify

> @@ -407,6 +412,7 @@ hantro_update_requires_request(struct hantro_ctx *ctx, 

u32 fourcc)
>  	case V4L2_PIX_FMT_VP8_FRAME:

>  	case V4L2_PIX_FMT_H264_SLICE:

>  	case V4L2_PIX_FMT_HEVC_SLICE:

> +	case V4L2_PIX_FMT_VP9_FRAME:

>  		ctx->fh.m2m_ctx->out_q_ctx.q.requires_requests = true;

>  		break;

>  	default:

> diff --git a/drivers/staging/media/hantro/hantro_vp9.c b/drivers/staging/

media/hantro/hantro_vp9.c
> new file mode 100644

> index 000000000000..566cd376c097

> --- /dev/null

> +++ b/drivers/staging/media/hantro/hantro_vp9.c

> @@ -0,0 +1,240 @@

> +// SPDX-License-Identifier: GPL-2.0

> +/*

> + * Hantro VP9 codec driver

> + *

> + * Copyright (C) 2021 Collabora Ltd.

> + */

> +

> +#include <linux/types.h>

> +#include <media/v4l2-mem2mem.h>

> +

> +#include "hantro.h"

> +#include "hantro_hw.h"

> +#include "hantro_vp9.h"

> +

> +#define POW2(x) (1 << (x))

> +

> +#define MAX_LOG2_TILE_COLUMNS 6

> +#define MAX_NUM_TILE_COLS POW2(MAX_LOG2_TILE_COLUMNS)

> +#define MAX_TILE_COLS 20

> +#define MAX_TILE_ROWS 22

> +

> +static size_t hantro_vp9_tile_filter_size(unsigned int height)

> +{

> +	u32 h, height32, size;

> +

> +	h = roundup(height, 8);

> +

> +	height32 = roundup(h, 64);

> +	size = 24 * height32 * (MAX_NUM_TILE_COLS - 1); /* luma: 8, chroma: 

8 + 8 */
> +

> +	return size;

> +}

> +

> +static size_t hantro_vp9_bsd_control_size(unsigned int height)

> +{

> +	u32 h, height32;

> +

> +	h = roundup(height, 8);

> +	height32 = roundup(h, 64);

> +

> +	return 16 * (height32 / 4) * (MAX_NUM_TILE_COLS - 1);

> +}

> +

> +static size_t hantro_vp9_segment_map_size(unsigned int width, unsigned int 

height)
> +{

> +	u32 w, h;

> +	int num_ctbs;

> +

> +	w = roundup(width, 8);

> +	h = roundup(height, 8);

> +	num_ctbs = ((w + 63) / 64) * ((h + 63) / 64);

> +

> +	return num_ctbs * 32;

> +}

> +

> +static inline size_t hantro_vp9_prob_tab_size(void)

> +{

> +	return roundup(sizeof(struct hantro_g2_all_probs), 16);

> +}

> +

> +static inline size_t hantro_vp9_count_tab_size(void)

> +{

> +	return roundup(sizeof(struct symbol_counts), 16);

> +}

> +

> +static inline size_t hantro_vp9_tile_info_size(void)

> +{

> +	return roundup((MAX_TILE_COLS * MAX_TILE_ROWS * 4 * sizeof(u16) + 

15 + 16) & ~0xf, 16);
> +}

> +

> +static void *get_coeffs_arr(struct symbol_counts *cnts, int i, int j, int k, 

int l, int m)
> +{

> +	if (i == 0)

> +		return &cnts->count_coeffs[j][k][l][m];

> +

> +	if (i == 1)

> +		return &cnts->count_coeffs8x8[j][k][l][m];

> +

> +	if (i == 2)

> +		return &cnts->count_coeffs16x16[j][k][l][m];

> +

> +	if (i == 3)

> +		return &cnts->count_coeffs32x32[j][k][l][m];

> +

> +	return NULL;

> +}

> +

> +static void *get_eobs1(struct symbol_counts *cnts, int i, int j, int k, int 

l, int m)
> +{

> +	if (i == 0)

> +		return &cnts->count_coeffs[j][k][l][m][3];

> +

> +	if (i == 1)

> +		return &cnts->count_coeffs8x8[j][k][l][m][3];

> +

> +	if (i == 2)

> +		return &cnts->count_coeffs16x16[j][k][l][m][3];

> +

> +	if (i == 3)

> +		return &cnts->count_coeffs32x32[j][k][l][m][3];

> +

> +	return NULL;

> +}

> +

> +#define INNER_LOOP \

> +	do {							

			\
> +		for (m = 0; m < ARRAY_SIZE(vp9_ctx->cnts.coeff[i][0][0]

[0]); ++m) {	\
> +			vp9_ctx->cnts.coeff[i][j][k][l][m] =		

		\
> +				get_coeffs_arr(cnts, i, j, k, l, 

m);			\
> +			vp9_ctx->cnts.eob[i][j][k][l][m][0] =		

		\
> +				&cnts->count_eobs[i][j][k][l][m];	

		\
> +			vp9_ctx->cnts.eob[i][j][k][l][m][1] =		

		\
> +				get_eobs1(cnts, i, j, k, l, m);	

			\
> +		}						

			\
> +	} while (0)

> +

> +static void init_v4l2_vp9_count_tbl(struct hantro_ctx *ctx)

> +{

> +	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;

> +	struct symbol_counts *cnts = vp9_ctx->misc.cpu + vp9_ctx-

>ctx_counters_offset;

> +	int i, j, k, l, m;

> +

> +	vp9_ctx->cnts.partition = &cnts->partition_counts;

> +	vp9_ctx->cnts.skip = &cnts->mbskip_count;

> +	vp9_ctx->cnts.intra_inter = &cnts->intra_inter_count;

> +	vp9_ctx->cnts.tx32p = &cnts->tx32x32_count;

> +	/*

> +	 * g2 hardware uses tx16x16_count[2][3], while the api

> +	 * expects tx16p[2][4], so this must be explicitly copied

> +	 * into vp9_ctx->cnts.tx16p when passing the data to the

> +	 * vp9 library function

> +	 */

> +	vp9_ctx->cnts.tx8p = &cnts->tx8x8_count;

> +

> +	vp9_ctx->cnts.y_mode = &cnts->sb_ymode_counts;

> +	vp9_ctx->cnts.uv_mode = &cnts->uv_mode_counts;

> +	vp9_ctx->cnts.comp = &cnts->comp_inter_count;

> +	vp9_ctx->cnts.comp_ref = &cnts->comp_ref_count;

> +	vp9_ctx->cnts.single_ref = &cnts->single_ref_count;

> +	vp9_ctx->cnts.filter = &cnts->switchable_interp_counts;

> +	vp9_ctx->cnts.mv_joint = &cnts->mv_counts.joints;

> +	vp9_ctx->cnts.sign = &cnts->mv_counts.sign;

> +	vp9_ctx->cnts.classes = &cnts->mv_counts.classes;

> +	vp9_ctx->cnts.class0 = &cnts->mv_counts.class0;

> +	vp9_ctx->cnts.bits = &cnts->mv_counts.bits;

> +	vp9_ctx->cnts.class0_fp = &cnts->mv_counts.class0_fp;

> +	vp9_ctx->cnts.fp = &cnts->mv_counts.fp;

> +	vp9_ctx->cnts.class0_hp = &cnts->mv_counts.class0_hp;

> +	vp9_ctx->cnts.hp = &cnts->mv_counts.hp;

> +

> +	for (i = 0; i < ARRAY_SIZE(vp9_ctx->cnts.coeff); ++i)

> +		for (j = 0; j < ARRAY_SIZE(vp9_ctx->cnts.coeff[i]); ++j)

> +			for (k = 0; k < ARRAY_SIZE(vp9_ctx-

>cnts.coeff[i][0]); ++k)

> +				for (l = 0; l < 

ARRAY_SIZE(vp9_ctx->cnts.coeff[i][0][0]); ++l)
> +					INNER_LOOP;

> +}

> +

> +int hantro_vp9_dec_init(struct hantro_ctx *ctx)

> +{

> +	struct hantro_dev *vpu = ctx->dev;

> +	const struct hantro_variant *variant = vpu->variant;

> +	struct hantro_vp9_dec_hw_ctx *vp9_dec = &ctx->vp9_dec;

> +	struct hantro_aux_buf *tile_edge = &vp9_dec->tile_edge;

> +	struct hantro_aux_buf *segment_map = &vp9_dec->segment_map;

> +	struct hantro_aux_buf *misc = &vp9_dec->misc;

> +	u32 i, max_width, max_height, size;

> +

> +	if (variant->num_dec_fmts < 1)

> +		return -EINVAL;

> +

> +	for (i = 0; i < variant->num_dec_fmts; ++i)

> +		if (variant->dec_fmts[i].fourcc == 

V4L2_PIX_FMT_VP9_FRAME)
> +			break;

> +

> +	if (i == variant->num_dec_fmts)

> +		return -EINVAL;

> +

> +	max_width = vpu->variant->dec_fmts[i].frmsize.max_width;

> +	max_height = vpu->variant->dec_fmts[i].frmsize.max_height;

> +

> +	size = hantro_vp9_tile_filter_size(max_height);

> +	vp9_dec->bsd_ctrl_offset = size;

> +	size += hantro_vp9_bsd_control_size(max_height);

> +

> +	tile_edge->cpu = dma_alloc_coherent(vpu->dev, size, &tile_edge-

>dma, GFP_KERNEL);

> +	if (!tile_edge->cpu)

> +		return -ENOMEM;

> +

> +	tile_edge->size = size;

> +	memset(tile_edge->cpu, 0, size);

> +

> +	size = hantro_vp9_segment_map_size(max_width, max_height);

> +	vp9_dec->segment_map_size = size;

> +	size *= 2; /* we need two areas of this size, used alternately */

> +

> +	segment_map->cpu = dma_alloc_coherent(vpu->dev, size, &segment_map-

>dma, GFP_KERNEL);

> +	if (!segment_map->cpu)

> +		goto err_segment_map;

> +

> +	segment_map->size = size;

> +	memset(segment_map->cpu, 0, size);

> +

> +	size = hantro_vp9_prob_tab_size();

> +	vp9_dec->ctx_counters_offset = size;

> +	size += hantro_vp9_count_tab_size();

> +	vp9_dec->tile_info_offset = size;

> +	size += hantro_vp9_tile_info_size();

> +

> +	misc->cpu = dma_alloc_coherent(vpu->dev, size, &misc->dma, 

GFP_KERNEL);
> +	if (!misc->cpu)

> +		goto err_misc;

> +

> +	misc->size = size;

> +	memset(misc->cpu, 0, size);

> +

> +	init_v4l2_vp9_count_tbl(ctx);

> +

> +	return 0;

> +

> +err_misc:

> +	dma_free_coherent(vpu->dev, segment_map->size, segment_map->cpu, 

segment_map->dma);
> +

> +err_segment_map:

> +	dma_free_coherent(vpu->dev, tile_edge->size, tile_edge->cpu, 

tile_edge->dma);
> +

> +	return -ENOMEM;

> +}

> +

> +void hantro_vp9_dec_exit(struct hantro_ctx *ctx)

> +{

> +	struct hantro_dev *vpu = ctx->dev;

> +	struct hantro_vp9_dec_hw_ctx *vp9_dec = &ctx->vp9_dec;

> +	struct hantro_aux_buf *tile_edge = &vp9_dec->tile_edge;

> +	struct hantro_aux_buf *segment_map = &vp9_dec->segment_map;

> +	struct hantro_aux_buf *misc = &vp9_dec->misc;

> +

> +	dma_free_coherent(vpu->dev, misc->size, misc->cpu, misc->dma);

> +	dma_free_coherent(vpu->dev, segment_map->size, segment_map->cpu, 

segment_map->dma);
> +	dma_free_coherent(vpu->dev, tile_edge->size, tile_edge->cpu, 

tile_edge->dma);
> +}

> diff --git a/drivers/staging/media/hantro/hantro_vp9.h b/drivers/staging/

media/hantro/hantro_vp9.h
> new file mode 100644

> index 000000000000..c7f4bd3ff8dd

> --- /dev/null

> +++ b/drivers/staging/media/hantro/hantro_vp9.h

> @@ -0,0 +1,103 @@

> +/* SPDX-License-Identifier: GPL-2.0 */

> +/*

> + * Hantro VP9 codec driver

> + *

> + * Copyright (C) 2021 Collabora Ltd.

> + */

> +

> +struct hantro_g2_mv_probs {

> +	u8 joint[3];

> +	u8 sign[2];

> +	u8 class0_bit[2][1];

> +	u8 fr[2][3];

> +	u8 class0_hp[2];

> +	u8 hp[2];

> +	u8 classes[2][10];

> +	u8 class0_fr[2][2][3];

> +	u8 bits[2][10];

> +};

> +

> +struct hantro_g2_probs {

> +	u8 inter_mode[7][4];

> +	u8 is_inter[4];

> +	u8 uv_mode[10][8];

> +	u8 tx8[2][1];

> +	u8 tx16[2][2];

> +	u8 tx32[2][3];

> +	u8 y_mode_tail[4][1];

> +	u8 y_mode[4][8];

> +	u8 partition[2][16][4]; /* [keyframe][][], [inter][][] */

> +	u8 uv_mode_tail[10][1];

> +	u8 interp_filter[4][2];

> +	u8 comp_mode[5];

> +	u8 skip[3];

> +

> +	u8 pad1[1];

> +

> +	struct hantro_g2_mv_probs mv;

> +

> +	u8 single_ref[5][2];

> +	u8 comp_ref[5];

> +

> +	u8 pad2[17];

> +

> +	u8 coef[4][2][2][6][6][4];

> +};

> +

> +struct hantro_g2_all_probs {

> +	u8 kf_y_mode_prob[10][10][8];

> +

> +	u8 kf_y_mode_prob_tail[10][10][1];

> +	u8 ref_pred_probs[3];

> +	u8 mb_segment_tree_probs[7];

> +	u8 segment_pred_probs[3];

> +	u8 ref_scores[4];

> +	u8 prob_comppred[2];

> +

> +	u8 pad1[9];

> +

> +	u8 kf_uv_mode_prob[10][8];

> +	u8 kf_uv_mode_prob_tail[10][1];

> +

> +	u8 pad2[6];

> +

> +	struct hantro_g2_probs probs;

> +};

> +

> +struct mv_counts {

> +	u32 joints[4];

> +	u32 sign[2][2];

> +	u32 classes[2][11];

> +	u32 class0[2][2];

> +	u32 bits[2][10][2];

> +	u32 class0_fp[2][2][4];

> +	u32 fp[2][4];

> +	u32 class0_hp[2][2];

> +	u32 hp[2][2];

> +};

> +

> +struct symbol_counts {

> +	u32 inter_mode_counts[7][3][2];

> +	u32 sb_ymode_counts[4][10];

> +	u32 uv_mode_counts[10][10];

> +	u32 partition_counts[16][4];

> +	u32 switchable_interp_counts[4][3];

> +	u32 intra_inter_count[4][2];

> +	u32 comp_inter_count[5][2];

> +	u32 single_ref_count[5][2][2];

> +	u32 comp_ref_count[5][2];

> +	u32 tx32x32_count[2][4];

> +	u32 tx16x16_count[2][3];

> +	u32 tx8x8_count[2][2];

> +	u32 mbskip_count[3][2];

> +

> +	struct mv_counts mv_counts;

> +

> +	u32 count_coeffs[2][2][6][6][4];

> +	u32 count_coeffs8x8[2][2][6][6][4];

> +	u32 count_coeffs16x16[2][2][6][6][4];

> +	u32 count_coeffs32x32[2][2][6][6][4];

> +

> +	u32 count_eobs[4][2][2][6][6];

> +};

> +

> diff --git a/drivers/staging/media/hantro/imx8m_vpu_hw.c b/drivers/staging/

media/hantro/imx8m_vpu_hw.c
> index a40b161e5956..455a107ffb02 100644

> --- a/drivers/staging/media/hantro/imx8m_vpu_hw.c

> +++ b/drivers/staging/media/hantro/imx8m_vpu_hw.c

> @@ -150,6 +150,19 @@ static const struct hantro_fmt imx8m_vpu_g2_dec_fmts[] 

= {
>  			.step_height = MB_DIM,

>  		},

>  	},

> +	{

> +		.fourcc = V4L2_PIX_FMT_VP9_FRAME,

> +		.codec_mode = HANTRO_MODE_VP9_DEC,

> +		.max_depth = 2,

> +		.frmsize = {

> +			.min_width = 48,

> +			.max_width = 3840,

> +			.step_width = MB_DIM,

> +			.min_height = 48,

> +			.max_height = 2160,

> +			.step_height = MB_DIM,

> +		},

> +	},

>  };

>  

>  static irqreturn_t imx8m_vpu_g1_irq(int irq, void *dev_id)

> @@ -241,6 +254,13 @@ static const struct hantro_codec_ops 

imx8mq_vpu_g2_codec_ops[] = {
>  		.init = hantro_hevc_dec_init,

>  		.exit = hantro_hevc_dec_exit,

>  	},

> +	[HANTRO_MODE_VP9_DEC] = {

> +		.run = hantro_g2_vp9_dec_run,

> +		.done = hantro_g2_vp9_dec_done,

> +		.reset = imx8m_vpu_g2_reset,

> +		.init = hantro_vp9_dec_init,

> +		.exit = hantro_vp9_dec_exit,

> +	},

>  };

>  

>  /*

> @@ -281,7 +301,7 @@ const struct hantro_variant imx8mq_vpu_g2_variant = {

>  	.dec_offset = 0x0,

>  	.dec_fmts = imx8m_vpu_g2_dec_fmts,

>  	.num_dec_fmts = ARRAY_SIZE(imx8m_vpu_g2_dec_fmts),

> -	.codec = HANTRO_HEVC_DECODER,

> +	.codec = HANTRO_HEVC_DECODER | HANTRO_VP9_DECODER,

>  	.codec_ops = imx8mq_vpu_g2_codec_ops,

>  	.init = imx8mq_vpu_hw_init,

>  	.runtime_resume = imx8mq_runtime_resume,

> -- 

> 2.17.1

> 

>
diff mbox series

Patch

diff --git a/drivers/staging/media/hantro/Kconfig b/drivers/staging/media/hantro/Kconfig
index 20b1f6d7b69c..00a57d88c92e 100644
--- a/drivers/staging/media/hantro/Kconfig
+++ b/drivers/staging/media/hantro/Kconfig
@@ -9,6 +9,7 @@  config VIDEO_HANTRO
 	select VIDEOBUF2_VMALLOC
 	select V4L2_MEM2MEM_DEV
 	select V4L2_H264
+	select V4L2_VP9
 	help
 	  Support for the Hantro IP based Video Processing Units present on
 	  Rockchip and NXP i.MX8M SoCs, which accelerate video and image
diff --git a/drivers/staging/media/hantro/Makefile b/drivers/staging/media/hantro/Makefile
index fe6d84871d07..28af0a1ee4bf 100644
--- a/drivers/staging/media/hantro/Makefile
+++ b/drivers/staging/media/hantro/Makefile
@@ -10,9 +10,10 @@  hantro-vpu-y += \
 		hantro_g1.o \
 		hantro_g1_h264_dec.o \
 		hantro_g1_mpeg2_dec.o \
-		hantro_g2_hevc_dec.o \
 		hantro_g1_vp8_dec.o \
 		hantro_g2.o \
+		hantro_g2_hevc_dec.o \
+		hantro_g2_vp9_dec.o \
 		rockchip_vpu2_hw_jpeg_enc.o \
 		rockchip_vpu2_hw_h264_dec.o \
 		rockchip_vpu2_hw_mpeg2_dec.o \
@@ -21,7 +22,8 @@  hantro-vpu-y += \
 		hantro_h264.o \
 		hantro_hevc.o \
 		hantro_mpeg2.o \
-		hantro_vp8.o
+		hantro_vp8.o \
+		hantro_vp9.o
 
 hantro-vpu-$(CONFIG_VIDEO_HANTRO_IMX8M) += \
 		imx8m_vpu_hw.o
diff --git a/drivers/staging/media/hantro/hantro.h b/drivers/staging/media/hantro/hantro.h
index d91eb2b1c509..1e8c1a6e3eb0 100644
--- a/drivers/staging/media/hantro/hantro.h
+++ b/drivers/staging/media/hantro/hantro.h
@@ -36,6 +36,7 @@  struct hantro_postproc_ops;
 #define HANTRO_VP8_DECODER	BIT(17)
 #define HANTRO_H264_DECODER	BIT(18)
 #define HANTRO_HEVC_DECODER	BIT(19)
+#define HANTRO_VP9_DECODER	BIT(20)
 #define HANTRO_DECODERS		0xffff0000
 
 /**
@@ -110,6 +111,7 @@  enum hantro_codec_mode {
 	HANTRO_MODE_MPEG2_DEC,
 	HANTRO_MODE_VP8_DEC,
 	HANTRO_MODE_HEVC_DEC,
+	HANTRO_MODE_VP9_DEC,
 };
 
 /*
@@ -223,6 +225,7 @@  struct hantro_dev {
  * @mpeg2_dec:		MPEG-2-decoding context.
  * @vp8_dec:		VP8-decoding context.
  * @hevc_dec:		HEVC-decoding context.
+ * @vp9_dec:		VP9-decoding context.
  */
 struct hantro_ctx {
 	struct hantro_dev *dev;
@@ -250,6 +253,7 @@  struct hantro_ctx {
 		struct hantro_mpeg2_dec_hw_ctx mpeg2_dec;
 		struct hantro_vp8_dec_hw_ctx vp8_dec;
 		struct hantro_hevc_dec_hw_ctx hevc_dec;
+		struct hantro_vp9_dec_hw_ctx vp9_dec;
 	};
 };
 
@@ -299,6 +303,22 @@  struct hantro_postproc_regs {
 	struct hantro_reg display_width;
 };
 
+struct hantro_vp9_decoded_buffer_info {
+	/* Info needed when the decoded frame serves as a reference frame. */
+	unsigned short width;
+	unsigned short height;
+	u32 bit_depth : 4;
+};
+
+struct hantro_decoded_buffer {
+	/* Must be the first field in this struct. */
+	struct v4l2_m2m_buffer base;
+
+	union {
+		struct hantro_vp9_decoded_buffer_info vp9;
+	};
+};
+
 /* Logging helpers */
 
 /**
@@ -436,6 +456,12 @@  hantro_get_dec_buf_addr(struct hantro_ctx *ctx, struct vb2_buffer *vb)
 	return vb2_dma_contig_plane_dma_addr(vb, 0);
 }
 
+static inline struct hantro_decoded_buffer *
+vb2_to_hantro_decoded_buf(struct vb2_buffer *buf)
+{
+	return container_of(buf, struct hantro_decoded_buffer, base.vb.vb2_buf);
+}
+
 void hantro_postproc_disable(struct hantro_ctx *ctx);
 void hantro_postproc_enable(struct hantro_ctx *ctx);
 void hantro_postproc_free(struct hantro_ctx *ctx);
diff --git a/drivers/staging/media/hantro/hantro_drv.c b/drivers/staging/media/hantro/hantro_drv.c
index 8a2edd67f2c6..0d1f3914f670 100644
--- a/drivers/staging/media/hantro/hantro_drv.c
+++ b/drivers/staging/media/hantro/hantro_drv.c
@@ -232,7 +232,7 @@  queue_init(void *priv, struct vb2_queue *src_vq, struct vb2_queue *dst_vq)
 	dst_vq->io_modes = VB2_MMAP | VB2_DMABUF;
 	dst_vq->drv_priv = ctx;
 	dst_vq->ops = &hantro_queue_ops;
-	dst_vq->buf_struct_size = sizeof(struct v4l2_m2m_buffer);
+	dst_vq->buf_struct_size = sizeof(struct hantro_decoded_buffer);
 	dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY;
 	dst_vq->lock = &ctx->dev->vpu_mutex;
 	dst_vq->dev = ctx->dev->v4l2_dev.dev;
@@ -266,6 +266,12 @@  static int hantro_try_ctrl(struct v4l2_ctrl *ctrl)
 		if (sps->flags & V4L2_HEVC_SPS_FLAG_SCALING_LIST_ENABLED)
 			/* No scaling support */
 			return -EINVAL;
+	} else if (ctrl->id == V4L2_CID_STATELESS_VP9_FRAME) {
+		const struct v4l2_ctrl_vp9_frame *dec_params = ctrl->p_new.p_vp9_frame;
+
+		/* We only support profile 0 */
+		if (dec_params->profile != 0)
+			return -EINVAL;
 	}
 	return 0;
 }
@@ -459,6 +465,16 @@  static const struct hantro_ctrl controls[] = {
 			.step = 1,
 			.ops = &hantro_hevc_ctrl_ops,
 		},
+	}, {
+		.codec = HANTRO_VP9_DECODER,
+		.cfg = {
+			.id = V4L2_CID_STATELESS_VP9_FRAME,
+		},
+	}, {
+		.codec = HANTRO_VP9_DECODER,
+		.cfg = {
+			.id = V4L2_CID_STATELESS_VP9_COMPRESSED_HDR_PROBS,
+		},
 	},
 };
 
diff --git a/drivers/staging/media/hantro/hantro_g2_regs.h b/drivers/staging/media/hantro/hantro_g2_regs.h
index 0ac0ba375e80..21ca21648614 100644
--- a/drivers/staging/media/hantro/hantro_g2_regs.h
+++ b/drivers/staging/media/hantro/hantro_g2_regs.h
@@ -28,6 +28,7 @@ 
 #define G2_REG_INTERRUPT_DEC_E		BIT(0)
 
 #define HEVC_DEC_MODE			0xc
+#define VP9_DEC_MODE			0xd
 
 #define BUS_WIDTH_32			0
 #define BUS_WIDTH_64			1
@@ -49,6 +50,7 @@ 
 #define g2_pic_height_in_cbs	G2_DEC_REG(4, 6,  0x1fff)
 #define g2_num_ref_frames	G2_DEC_REG(4, 0,  0x1f)
 
+#define g2_start_bit		G2_DEC_REG(5, 25, 0x7f)
 #define g2_scaling_list_e	G2_DEC_REG(5, 24, 0x1)
 #define g2_cb_qp_offset		G2_DEC_REG(5, 19, 0x1f)
 #define g2_cr_qp_offset		G2_DEC_REG(5, 14, 0x1f)
@@ -84,6 +86,7 @@ 
 #define g2_bit_depth_y_minus8	G2_DEC_REG(8, 6,  0x3)
 #define g2_bit_depth_c_minus8	G2_DEC_REG(8, 4,  0x3)
 #define g2_output_8_bits	G2_DEC_REG(8, 3,  0x1)
+#define g2_output_format	G2_DEC_REG(8, 0,  0x7)
 
 #define g2_refidx1_active	G2_DEC_REG(9, 19, 0x1f)
 #define g2_refidx0_active	G2_DEC_REG(9, 14, 0x1f)
@@ -96,6 +99,14 @@ 
 #define g2_tile_e		G2_DEC_REG(10, 1,  0x1)
 #define g2_entropy_sync_e	G2_DEC_REG(10, 0,  0x1)
 
+#define vp9_transform_mode	G2_DEC_REG(11, 27, 0x7)
+#define vp9_filt_sharpness	G2_DEC_REG(11, 21, 0x7)
+#define vp9_mcomp_filt_type	G2_DEC_REG(11,  8, 0x7)
+#define vp9_high_prec_mv_e	G2_DEC_REG(11,  7, 0x1)
+#define vp9_comp_pred_mode	G2_DEC_REG(11,  4, 0x3)
+#define vp9_gref_sign_bias	G2_DEC_REG(11,  2, 0x1)
+#define vp9_aref_sign_bias	G2_DEC_REG(11,  0, 0x1)
+
 #define g2_refer_lterm_e	G2_DEC_REG(12, 16, 0xffff)
 #define g2_min_cb_size		G2_DEC_REG(12, 13, 0x7)
 #define g2_max_cb_size		G2_DEC_REG(12, 10, 0x7)
@@ -154,6 +165,50 @@ 
 #define g2_partial_ctb_y	G2_DEC_REG(20, 30, 0x1)
 #define g2_pic_width_4x4	G2_DEC_REG(20, 16, 0xfff)
 #define g2_pic_height_4x4	G2_DEC_REG(20, 0,  0xfff)
+
+#define vp9_qp_delta_y_dc	G2_DEC_REG(13, 23, 0x3f)
+#define vp9_qp_delta_ch_dc	G2_DEC_REG(13, 17, 0x3f)
+#define vp9_qp_delta_ch_ac	G2_DEC_REG(13, 11, 0x3f)
+#define vp9_last_sign_bias	G2_DEC_REG(13, 10, 0x1)
+#define vp9_lossless_e		G2_DEC_REG(13,  9, 0x1)
+#define vp9_comp_pred_var_ref1	G2_DEC_REG(13,  7, 0x3)
+#define vp9_comp_pred_var_ref0	G2_DEC_REG(13,  5, 0x3)
+#define vp9_comp_pred_fixed_ref	G2_DEC_REG(13,  3, 0x3)
+#define vp9_segment_temp_upd_e	G2_DEC_REG(13,  2, 0x1)
+#define vp9_segment_upd_e	G2_DEC_REG(13,  1, 0x1)
+#define vp9_segment_e		G2_DEC_REG(13,  0, 0x1)
+
+#define vp9_filt_level		G2_DEC_REG(14, 18, 0x3f)
+#define vp9_refpic_seg0		G2_DEC_REG(14, 15, 0x7)
+#define vp9_skip_seg0		G2_DEC_REG(14, 14, 0x1)
+#define vp9_filt_level_seg0	G2_DEC_REG(14,  8, 0x3f)
+#define vp9_quant_seg0		G2_DEC_REG(14,  0, 0xff)
+
+#define vp9_refpic_seg1		G2_DEC_REG(15, 15, 0x7)
+#define vp9_skip_seg1		G2_DEC_REG(15, 14, 0x1)
+#define vp9_filt_level_seg1	G2_DEC_REG(15,  8, 0x3f)
+#define vp9_quant_seg1		G2_DEC_REG(15,  0, 0xff)
+
+#define vp9_refpic_seg2		G2_DEC_REG(16, 15, 0x7)
+#define vp9_skip_seg2		G2_DEC_REG(16, 14, 0x1)
+#define vp9_filt_level_seg2	G2_DEC_REG(16,  8, 0x3f)
+#define vp9_quant_seg2		G2_DEC_REG(16,  0, 0xff)
+
+#define vp9_refpic_seg3		G2_DEC_REG(17, 15, 0x7)
+#define vp9_skip_seg3		G2_DEC_REG(17, 14, 0x1)
+#define vp9_filt_level_seg3	G2_DEC_REG(17,  8, 0x3f)
+#define vp9_quant_seg3		G2_DEC_REG(17,  0, 0xff)
+
+#define vp9_refpic_seg4		G2_DEC_REG(18, 15, 0x7)
+#define vp9_skip_seg4		G2_DEC_REG(18, 14, 0x1)
+#define vp9_filt_level_seg4	G2_DEC_REG(18,  8, 0x3f)
+#define vp9_quant_seg4		G2_DEC_REG(18,  0, 0xff)
+
+#define vp9_refpic_seg5		G2_DEC_REG(19, 15, 0x7)
+#define vp9_skip_seg5		G2_DEC_REG(19, 14, 0x1)
+#define vp9_filt_level_seg5	G2_DEC_REG(19,  8, 0x3f)
+#define vp9_quant_seg5		G2_DEC_REG(19,  0, 0xff)
+
 #define hevc_cur_poc_00		G2_DEC_REG(46, 24, 0xff)
 #define hevc_cur_poc_01		G2_DEC_REG(46, 16, 0xff)
 #define hevc_cur_poc_02		G2_DEC_REG(46, 8,  0xff)
@@ -174,6 +229,44 @@ 
 #define hevc_cur_poc_14		G2_DEC_REG(49, 8,  0xff)
 #define hevc_cur_poc_15		G2_DEC_REG(49, 0,  0xff)
 
+#define vp9_refpic_seg6		G2_DEC_REG(31, 15, 0x7)
+#define vp9_skip_seg6		G2_DEC_REG(31, 14, 0x1)
+#define vp9_filt_level_seg6	G2_DEC_REG(31,  8, 0x3f)
+#define vp9_quant_seg6		G2_DEC_REG(31,  0, 0xff)
+
+#define vp9_refpic_seg7		G2_DEC_REG(32, 15, 0x7)
+#define vp9_skip_seg7		G2_DEC_REG(32, 14, 0x1)
+#define vp9_filt_level_seg7	G2_DEC_REG(32,  8, 0x3f)
+#define vp9_quant_seg7		G2_DEC_REG(32,  0, 0xff)
+
+#define vp9_lref_width		G2_DEC_REG(33, 16, 0xffff)
+#define vp9_lref_height		G2_DEC_REG(33,  0, 0xffff)
+
+#define vp9_gref_width		G2_DEC_REG(34, 16, 0xffff)
+#define vp9_gref_height		G2_DEC_REG(34,  0, 0xffff)
+
+#define vp9_aref_width		G2_DEC_REG(35, 16, 0xffff)
+#define vp9_aref_height		G2_DEC_REG(35,  0, 0xffff)
+
+#define vp9_lref_hor_scale	G2_DEC_REG(36, 16, 0xffff)
+#define vp9_lref_ver_scale	G2_DEC_REG(36,  0, 0xffff)
+
+#define vp9_gref_hor_scale	G2_DEC_REG(37, 16, 0xffff)
+#define vp9_gref_ver_scale	G2_DEC_REG(37,  0, 0xffff)
+
+#define vp9_aref_hor_scale	G2_DEC_REG(38, 16, 0xffff)
+#define vp9_aref_ver_scale	G2_DEC_REG(38,  0, 0xffff)
+
+#define vp9_filt_ref_adj_0	G2_DEC_REG(46, 24, 0x7f)
+#define vp9_filt_ref_adj_1	G2_DEC_REG(46, 16, 0x7f)
+#define vp9_filt_ref_adj_2	G2_DEC_REG(46,  8, 0x7f)
+#define vp9_filt_ref_adj_3	G2_DEC_REG(46,  0, 0x7f)
+
+#define vp9_filt_mb_adj_0	G2_DEC_REG(47, 24, 0x7f)
+#define vp9_filt_mb_adj_1	G2_DEC_REG(47, 16, 0x7f)
+#define vp9_filt_mb_adj_2	G2_DEC_REG(47,  8, 0x7f)
+#define vp9_filt_mb_adj_3	G2_DEC_REG(47,  0, 0x7f)
+
 #define g2_apf_threshold	G2_DEC_REG(55, 0, 0xffff)
 
 #define g2_clk_gate_e		G2_DEC_REG(58, 16, 0x1)
@@ -186,6 +279,8 @@ 
 
 #define G2_ADDR_DST		(G2_SWREG(65))
 #define G2_REG_ADDR_REF(i)	(G2_SWREG(67)  + ((i) * 0x8))
+#define VP9_ADDR_SEGMENT_WRITE	(G2_SWREG(79))
+#define VP9_ADDR_SEGMENT_READ	(G2_SWREG(81))
 #define G2_ADDR_DST_CHR		(G2_SWREG(99))
 #define G2_REG_CHR_REF(i)	(G2_SWREG(101) + ((i) * 0x8))
 #define G2_ADDR_DST_MV		(G2_SWREG(133))
@@ -193,6 +288,8 @@ 
 #define G2_ADDR_TILE_SIZE	(G2_SWREG(167))
 #define G2_ADDR_STR		(G2_SWREG(169))
 #define HEVC_SCALING_LIST	(G2_SWREG(171))
+#define VP9_ADDR_CTR		(G2_SWREG(171))
+#define VP9_ADDR_PROBS		(G2_SWREG(173))
 #define G2_RASTER_SCAN		(G2_SWREG(175))
 #define G2_RASTER_SCAN_CHR	(G2_SWREG(177))
 #define G2_TILE_FILTER		(G2_SWREG(179))
diff --git a/drivers/staging/media/hantro/hantro_g2_vp9_dec.c b/drivers/staging/media/hantro/hantro_g2_vp9_dec.c
new file mode 100644
index 000000000000..45a7be4a43fa
--- /dev/null
+++ b/drivers/staging/media/hantro/hantro_g2_vp9_dec.c
@@ -0,0 +1,978 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Hantro VP9 codec driver
+ *
+ * Copyright (C) 2021 Collabora Ltd.
+ */
+#include "media/videobuf2-core.h"
+#include "media/videobuf2-dma-contig.h"
+#include "media/videobuf2-v4l2.h"
+#include <linux/kernel.h>
+#include <linux/vmalloc.h>
+#include <media/v4l2-mem2mem.h>
+#include <media/v4l2-vp9.h>
+
+#include "hantro.h"
+#include "hantro_vp9.h"
+#include "hantro_g2_regs.h"
+
+#define G2_ALIGN 16
+
+enum hantro_ref_frames {
+	INTRA_FRAME = 0,
+	LAST_FRAME = 1,
+	GOLDEN_FRAME = 2,
+	ALTREF_FRAME = 3,
+	MAX_REF_FRAMES = 4
+};
+
+static int start_prepare_run(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame **dec_params)
+{
+	const struct v4l2_ctrl_vp9_compressed_hdr_probs *prob_updates;
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+	struct v4l2_ctrl *ctrl;
+	unsigned int fctx_idx;
+
+	/* v4l2-specific stuff */
+	hantro_start_prepare_run(ctx);
+
+	ctrl = v4l2_ctrl_find(&ctx->ctrl_handler, V4L2_CID_STATELESS_VP9_FRAME);
+	if (WARN_ON(!ctrl))
+		return -EINVAL;
+	*dec_params = ctrl->p_cur.p;
+
+	ctrl = v4l2_ctrl_find(&ctx->ctrl_handler, V4L2_CID_STATELESS_VP9_COMPRESSED_HDR_PROBS);
+	if (WARN_ON(!ctrl))
+		return -EINVAL;
+	prob_updates = ctrl->p_cur.p;
+
+	/*
+	 * vp9 stuff
+	 *
+	 * by this point the userspace has done all parts of 6.2 uncompressed_header()
+	 * except this fragment:
+	 * if ( FrameIsIntra || error_resilient_mode ) {
+	 *	setup_past_independence ( )
+	 *	if ( frame_type == KEY_FRAME || error_resilient_mode == 1 ||
+	 *	     reset_frame_context == 3 ) {
+	 *		for ( i = 0; i < 4; i ++ ) {
+	 *			save_probs( i )
+	 *		}
+	 *	} else if ( reset_frame_context == 2 ) {
+	 *		save_probs( frame_context_idx )
+	 *	}
+	 *	frame_context_idx = 0
+	 * }
+	 */
+	fctx_idx = v4l2_vp9_reset_frame_ctx(*dec_params, vp9_ctx->frame_context);
+	vp9_ctx->cur.frame_context_idx = fctx_idx;
+
+	/* 6.1 frame(sz): load_probs() and load_probs2() */
+	vp9_ctx->probability_tables = vp9_ctx->frame_context[fctx_idx];
+
+	/*
+	 * The userspace has also performed 6.3 compressed_header(), but handling the
+	 * probs in a special way. All probs which need updating, except MV-related,
+	 * have been read from the bitstream and translated through inv_map_table[],
+	 * but no 6.3.6 inv_recenter_nonneg(v, m) has been performed. The values passed
+	 * by userspace are either translated values (there are no 0 values in
+	 * inv_map_table[]), or zero to indicate no update. All MV-related probs which need
+	 * updating have been read from the bitstream and (mv_prob << 1) | 1 has been
+	 * performed. The values passed by userspace are either new values
+	 * to replace old ones (the above mentioned shift and bitwise or never result in
+	 * a zero) or zero to indicate no update.
+	 * fw_update_probs() performs actual probs updates or leaves probs as-is
+	 * for values for which a zero was passed from userspace.
+	 */
+	v4l2_vp9_fw_update_probs(&vp9_ctx->probability_tables, prob_updates, *dec_params);
+
+	return 0;
+}
+
+static size_t chroma_offset(const struct hantro_ctx *ctx,
+			    const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	int bytes_per_pixel = dec_params->bit_depth == 8 ? 1 : 2;
+
+	return ctx->src_fmt.width * ctx->src_fmt.height * bytes_per_pixel;
+}
+
+static size_t mv_offset(const struct hantro_ctx *ctx,
+			const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	size_t cr_offset = chroma_offset(ctx, dec_params);
+
+	return ALIGN((cr_offset * 3) / 2, G2_ALIGN);
+}
+
+static struct hantro_decoded_buffer *
+get_ref_buf(struct hantro_ctx *ctx, struct vb2_v4l2_buffer *dst, u64 timestamp)
+{
+	struct v4l2_m2m_ctx *m2m_ctx = ctx->fh.m2m_ctx;
+	struct vb2_queue *cap_q = &m2m_ctx->cap_q_ctx.q;
+	int buf_idx;
+
+	/*
+	 * If a ref is unused or invalid, address of current destination
+	 * buffer is returned.
+	 */
+	buf_idx = vb2_find_timestamp(cap_q, timestamp, 0);
+	if (buf_idx < 0)
+		return vb2_to_hantro_decoded_buf(&dst->vb2_buf);
+
+	return vb2_to_hantro_decoded_buf(vb2_get_buffer(cap_q, buf_idx));
+}
+
+static void update_dec_buf_info(struct hantro_decoded_buffer *buf,
+				const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	buf->vp9.width = dec_params->frame_width_minus_1 + 1;
+	buf->vp9.height = dec_params->frame_height_minus_1 + 1;
+	buf->vp9.bit_depth = dec_params->bit_depth;
+}
+
+static void update_ctx_cur_info(struct hantro_vp9_dec_hw_ctx *vp9_ctx,
+				struct hantro_decoded_buffer *buf,
+				const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	vp9_ctx->cur.valid = true;
+	vp9_ctx->cur.reference_mode = dec_params->reference_mode;
+	vp9_ctx->cur.tx_mode = dec_params->tx_mode;
+	vp9_ctx->cur.interpolation_filter = dec_params->interpolation_filter;
+	vp9_ctx->cur.flags = dec_params->flags;
+	vp9_ctx->cur.timestamp = buf->base.vb.vb2_buf.timestamp;
+}
+
+static void config_output(struct hantro_ctx *ctx,
+			  struct hantro_decoded_buffer *dst,
+			  const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	dma_addr_t luma_addr, chroma_addr, mv_addr;
+
+	hantro_reg_write(ctx->dev, &g2_out_dis, 0);
+	hantro_reg_write(ctx->dev, &g2_output_format, 0);
+
+	luma_addr = vb2_dma_contig_plane_dma_addr(&dst->base.vb.vb2_buf, 0);
+	hantro_write_addr(ctx->dev, G2_ADDR_DST, luma_addr);
+
+	chroma_addr = luma_addr + chroma_offset(ctx, dec_params);
+	hantro_write_addr(ctx->dev, G2_ADDR_DST_CHR, chroma_addr);
+
+	mv_addr = luma_addr + mv_offset(ctx, dec_params);
+	hantro_write_addr(ctx->dev, G2_ADDR_DST_MV, mv_addr);
+}
+
+struct hantro_vp9_ref_reg {
+	const struct hantro_reg width;
+	const struct hantro_reg height;
+	const struct hantro_reg hor_scale;
+	const struct hantro_reg ver_scale;
+	u32 y_base;
+	u32 c_base;
+};
+
+static void config_ref(struct hantro_ctx *ctx,
+		       struct hantro_decoded_buffer *dst,
+		       const struct hantro_vp9_ref_reg *ref_reg,
+		       const struct v4l2_ctrl_vp9_frame *dec_params,
+		       u64 ref_ts)
+{
+	struct hantro_decoded_buffer *buf;
+	dma_addr_t luma_addr, chroma_addr;
+	u32 refw, refh;
+
+	buf = get_ref_buf(ctx, &dst->base.vb, ref_ts);
+	refw = buf->vp9.width;
+	refh = buf->vp9.height;
+
+	hantro_reg_write(ctx->dev, &ref_reg->width, refw);
+	hantro_reg_write(ctx->dev, &ref_reg->height, refh);
+
+	hantro_reg_write(ctx->dev, &ref_reg->hor_scale, (refw << 14) / dst->vp9.width);
+	hantro_reg_write(ctx->dev, &ref_reg->ver_scale, (refh << 14) / dst->vp9.height);
+
+	luma_addr = vb2_dma_contig_plane_dma_addr(&buf->base.vb.vb2_buf, 0);
+	hantro_write_addr(ctx->dev, ref_reg->y_base, luma_addr);
+
+	chroma_addr = luma_addr + chroma_offset(ctx, dec_params);
+	hantro_write_addr(ctx->dev, ref_reg->c_base, chroma_addr);
+}
+
+static void config_ref_registers(struct hantro_ctx *ctx,
+				 const struct v4l2_ctrl_vp9_frame *dec_params,
+				 struct hantro_decoded_buffer *dst,
+				 struct hantro_decoded_buffer *mv_ref)
+{
+	static const struct hantro_vp9_ref_reg ref_regs[] = {
+		{
+			/* Last */
+			.width = vp9_lref_width,
+			.height = vp9_lref_height,
+			.hor_scale = vp9_lref_hor_scale,
+			.ver_scale = vp9_lref_ver_scale,
+			.y_base = G2_REG_ADDR_REF(0),
+			.c_base = G2_REG_CHR_REF(0),
+		}, {
+			/* Golden */
+			.width = vp9_gref_width,
+			.height = vp9_gref_height,
+			.hor_scale = vp9_gref_hor_scale,
+			.ver_scale = vp9_gref_ver_scale,
+			.y_base = G2_REG_ADDR_REF(4),
+			.c_base = G2_REG_CHR_REF(4),
+		}, {
+			/* Altref */
+			.width = vp9_aref_width,
+			.height = vp9_aref_height,
+			.hor_scale = vp9_aref_hor_scale,
+			.ver_scale = vp9_aref_ver_scale,
+			.y_base = G2_REG_ADDR_REF(5),
+			.c_base = G2_REG_CHR_REF(5),
+		},
+	};
+	dma_addr_t mv_addr;
+
+	config_ref(ctx, dst, &ref_regs[0], dec_params, dec_params->last_frame_ts);
+	config_ref(ctx, dst, &ref_regs[1], dec_params, dec_params->golden_frame_ts);
+	config_ref(ctx, dst, &ref_regs[2], dec_params, dec_params->alt_frame_ts);
+
+	mv_addr = vb2_dma_contig_plane_dma_addr(&mv_ref->base.vb.vb2_buf, 0) +
+		  mv_offset(ctx, dec_params);
+	hantro_write_addr(ctx->dev, G2_REG_DMV_REF(0), mv_addr);
+
+	hantro_reg_write(ctx->dev, &vp9_last_sign_bias,
+			 dec_params->ref_frame_sign_bias & V4L2_VP9_SIGN_BIAS_LAST ? 1 : 0);
+
+	hantro_reg_write(ctx->dev, &vp9_gref_sign_bias,
+			 dec_params->ref_frame_sign_bias & V4L2_VP9_SIGN_BIAS_GOLDEN ? 1 : 0);
+
+	hantro_reg_write(ctx->dev, &vp9_aref_sign_bias,
+			 dec_params->ref_frame_sign_bias & V4L2_VP9_SIGN_BIAS_ALT ? 1 : 0);
+}
+
+static void recompute_tile_info(unsigned short *tile_info, unsigned int tiles, unsigned int sbs)
+{
+	int i;
+	unsigned int accumulated = 0;
+	unsigned int next_accumulated;
+
+	for (i = 1; i <= tiles; ++i) {
+		next_accumulated = i * sbs / tiles;
+		*tile_info++ = next_accumulated - accumulated;
+		accumulated = next_accumulated;
+	}
+}
+
+static void
+recompute_tile_rc_info(struct hantro_ctx *ctx,
+		       unsigned int tile_r, unsigned int tile_c,
+		       unsigned int sbs_r, unsigned int sbs_c)
+{
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+
+	recompute_tile_info(vp9_ctx->tile_r_info, tile_r, sbs_r);
+	recompute_tile_info(vp9_ctx->tile_c_info, tile_c, sbs_c);
+
+	vp9_ctx->last_tile_r = tile_r;
+	vp9_ctx->last_tile_c = tile_c;
+	vp9_ctx->last_sbs_r = sbs_r;
+	vp9_ctx->last_sbs_c = sbs_c;
+}
+
+static inline unsigned int first_tile_row(unsigned int tile_r, unsigned int sbs_r)
+{
+	if (tile_r == sbs_r + 1)
+		return 1;
+
+	if (tile_r == sbs_r + 2)
+		return 2;
+
+	return 0;
+}
+
+static void
+fill_tile_info(struct hantro_ctx *ctx,
+	       unsigned int tile_r, unsigned int tile_c,
+	       unsigned int sbs_r, unsigned int sbs_c,
+	       unsigned short *tile_mem)
+{
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+	unsigned int i, j;
+	bool first = true;
+
+	for (i = first_tile_row(tile_r, sbs_r); i < tile_r; ++i) {
+		unsigned short r_info = vp9_ctx->tile_r_info[i];
+
+		if (first) {
+			if (i > 0)
+				r_info += vp9_ctx->tile_r_info[0];
+			if (i == 2)
+				r_info += vp9_ctx->tile_r_info[1];
+			first = false;
+		}
+		for (j = 0; j < tile_c; ++j) {
+			*tile_mem++ = vp9_ctx->tile_c_info[j];
+			*tile_mem++ = r_info;
+		}
+	}
+}
+
+static void
+config_tiles(struct hantro_ctx *ctx,
+	     const struct v4l2_ctrl_vp9_frame *dec_params,
+	     struct hantro_decoded_buffer *dst)
+{
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+	struct hantro_aux_buf *misc = &vp9_ctx->misc;
+	struct hantro_aux_buf *tile_edge = &vp9_ctx->tile_edge;
+	dma_addr_t addr;
+	unsigned short *tile_mem;
+
+	addr = misc->dma + vp9_ctx->tile_info_offset;
+	hantro_write_addr(ctx->dev, G2_ADDR_TILE_SIZE, addr);
+
+	tile_mem = misc->cpu + vp9_ctx->tile_info_offset;
+	if (dec_params->tile_cols_log2 || dec_params->tile_rows_log2) {
+		unsigned int tile_r = (1 << dec_params->tile_rows_log2);
+		unsigned int tile_c = (1 << dec_params->tile_cols_log2);
+		unsigned int sbs_r = hantro_vp9_num_sbs(dst->vp9.height);
+		unsigned int sbs_c = hantro_vp9_num_sbs(dst->vp9.width);
+
+		if (tile_r != vp9_ctx->last_tile_r || tile_c != vp9_ctx->last_tile_c ||
+		    sbs_r != vp9_ctx->last_sbs_r || sbs_c != vp9_ctx->last_sbs_c)
+			recompute_tile_rc_info(ctx, tile_r, tile_c, sbs_r, sbs_c);
+
+		fill_tile_info(ctx, tile_r, tile_c, sbs_r, sbs_c, tile_mem);
+
+		hantro_reg_write(ctx->dev, &g2_tile_e, 1);
+		hantro_reg_write(ctx->dev, &g2_num_tile_cols, tile_c);
+		hantro_reg_write(ctx->dev, &g2_num_tile_rows, tile_r);
+
+		addr = tile_edge->dma;
+		hantro_write_addr(ctx->dev, G2_TILE_FILTER, addr);
+
+		addr = tile_edge->dma + vp9_ctx->bsd_ctrl_offset;
+		hantro_write_addr(ctx->dev, G2_TILE_BSD, addr);
+	} else {
+		tile_mem[0] = hantro_vp9_num_sbs(dst->vp9.width);
+		tile_mem[1] = hantro_vp9_num_sbs(dst->vp9.height);
+
+		hantro_reg_write(ctx->dev, &g2_tile_e, 0);
+		hantro_reg_write(ctx->dev, &g2_num_tile_cols, 1);
+		hantro_reg_write(ctx->dev, &g2_num_tile_rows, 1);
+	}
+}
+
+static void
+update_feat_and_flag(struct hantro_vp9_dec_hw_ctx *vp9_ctx,
+		     const struct v4l2_vp9_segmentation *seg,
+		     enum v4l2_vp9_segment_feature feature,
+		     unsigned int segid)
+{
+	u8 mask = V4L2_VP9_SEGMENT_FEATURE_ENABLED(feature);
+
+	vp9_ctx->feature_data[segid][feature] = seg->feature_data[segid][feature];
+	vp9_ctx->feature_enabled[segid] &= ~mask;
+	vp9_ctx->feature_enabled[segid] |= (seg->feature_enabled[segid] & mask);
+}
+
+static inline s16 clip3(s16 x, s16 y, s16 z)
+{
+	return (z < x) ? x : (z > y) ? y : z;
+}
+
+static s16 feat_val_clip3(s16 feat_val, s16 feature_data, bool absolute, u8 clip)
+{
+	if (absolute)
+		return feature_data;
+
+	return clip3(0, 255, feat_val + feature_data);
+}
+
+static void config_segment(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+	const struct v4l2_vp9_segmentation *seg;
+	s16 feat_val;
+	unsigned char feat_id;
+	unsigned int segid;
+	bool segment_enabled, absolute, update_data;
+
+	static const struct hantro_reg seg_regs[8][V4L2_VP9_SEG_LVL_MAX] = {
+		{ vp9_quant_seg0, vp9_filt_level_seg0, vp9_refpic_seg0, vp9_skip_seg0 },
+		{ vp9_quant_seg1, vp9_filt_level_seg1, vp9_refpic_seg1, vp9_skip_seg1 },
+		{ vp9_quant_seg2, vp9_filt_level_seg2, vp9_refpic_seg2, vp9_skip_seg2 },
+		{ vp9_quant_seg3, vp9_filt_level_seg3, vp9_refpic_seg3, vp9_skip_seg3 },
+		{ vp9_quant_seg4, vp9_filt_level_seg4, vp9_refpic_seg4, vp9_skip_seg4 },
+		{ vp9_quant_seg5, vp9_filt_level_seg5, vp9_refpic_seg5, vp9_skip_seg5 },
+		{ vp9_quant_seg6, vp9_filt_level_seg6, vp9_refpic_seg6, vp9_skip_seg6 },
+		{ vp9_quant_seg7, vp9_filt_level_seg7, vp9_refpic_seg7, vp9_skip_seg7 },
+	};
+
+	segment_enabled = !!(dec_params->seg.flags & V4L2_VP9_SEGMENTATION_FLAG_ENABLED);
+	hantro_reg_write(ctx->dev, &vp9_segment_e, segment_enabled);
+	hantro_reg_write(ctx->dev, &vp9_segment_upd_e,
+			 !!(dec_params->seg.flags & V4L2_VP9_SEGMENTATION_FLAG_UPDATE_MAP));
+	hantro_reg_write(ctx->dev, &vp9_segment_temp_upd_e,
+			 !!(dec_params->seg.flags & V4L2_VP9_SEGMENTATION_FLAG_TEMPORAL_UPDATE));
+
+	seg = &dec_params->seg;
+	absolute = !!(seg->flags & V4L2_VP9_SEGMENTATION_FLAG_ABS_OR_DELTA_UPDATE);
+	update_data = !!(seg->flags & V4L2_VP9_SEGMENTATION_FLAG_UPDATE_DATA);
+
+	for (segid = 0; segid < 8; ++segid) {
+		/* Quantizer segment feature */
+		feat_id = V4L2_VP9_SEG_LVL_ALT_Q;
+		feat_val = dec_params->quant.base_q_idx;
+		if (segment_enabled) {
+			if (update_data)
+				update_feat_and_flag(vp9_ctx, seg, feat_id, segid);
+			if (v4l2_vp9_seg_feat_enabled(vp9_ctx->feature_enabled, feat_id, segid))
+				feat_val = feat_val_clip3(feat_val,
+							  vp9_ctx->feature_data[segid][feat_id],
+							  absolute, 255);
+		}
+		hantro_reg_write(ctx->dev, &seg_regs[segid][feat_id], feat_val);
+
+		/* Loop filter segment feature */
+		feat_id = V4L2_VP9_SEG_LVL_ALT_L;
+		feat_val = dec_params->lf.level;
+		if (segment_enabled) {
+			if (update_data)
+				update_feat_and_flag(vp9_ctx, seg, feat_id, segid);
+			if (v4l2_vp9_seg_feat_enabled(vp9_ctx->feature_enabled, feat_id, segid))
+				feat_val = feat_val_clip3(feat_val,
+							  vp9_ctx->feature_data[segid][feat_id],
+							  absolute, 63);
+		}
+		hantro_reg_write(ctx->dev, &seg_regs[segid][feat_id], feat_val);
+
+		/* Reference frame segment feature */
+		feat_id = V4L2_VP9_SEG_LVL_REF_FRAME;
+		feat_val = 0;
+		if (segment_enabled) {
+			if (update_data)
+				update_feat_and_flag(vp9_ctx, seg, feat_id, segid);
+			if (!(dec_params->flags & V4L2_VP9_FRAME_FLAG_KEY_FRAME) &&
+			    v4l2_vp9_seg_feat_enabled(vp9_ctx->feature_enabled, feat_id, segid))
+				feat_val = vp9_ctx->feature_data[segid][feat_id] + 1;
+		}
+		hantro_reg_write(ctx->dev, &seg_regs[segid][feat_id], feat_val);
+
+		/* Skip segment feature */
+		feat_id = V4L2_VP9_SEG_LVL_SKIP;
+		feat_val = 0;
+		if (segment_enabled) {
+			if (update_data)
+				update_feat_and_flag(vp9_ctx, seg, feat_id, segid);
+			feat_val = v4l2_vp9_seg_feat_enabled(vp9_ctx->feature_enabled,
+							     feat_id, segid) ? 1 : 0;
+		}
+		hantro_reg_write(ctx->dev, &seg_regs[segid][feat_id], feat_val);
+	}
+}
+
+static void config_loop_filter(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	bool d = dec_params->lf.flags & V4L2_VP9_LOOP_FILTER_FLAG_DELTA_ENABLED;
+
+	hantro_reg_write(ctx->dev, &vp9_filt_level, dec_params->lf.level);
+	hantro_reg_write(ctx->dev, &g2_out_filtering_dis, dec_params->lf.level == 0);
+	hantro_reg_write(ctx->dev, &vp9_filt_sharpness, dec_params->lf.sharpness);
+
+	hantro_reg_write(ctx->dev, &vp9_filt_ref_adj_0, d ? dec_params->lf.ref_deltas[0] : 0);
+	hantro_reg_write(ctx->dev, &vp9_filt_ref_adj_1, d ? dec_params->lf.ref_deltas[1] : 0);
+	hantro_reg_write(ctx->dev, &vp9_filt_ref_adj_2, d ? dec_params->lf.ref_deltas[2] : 0);
+	hantro_reg_write(ctx->dev, &vp9_filt_ref_adj_3, d ? dec_params->lf.ref_deltas[3] : 0);
+	hantro_reg_write(ctx->dev, &vp9_filt_mb_adj_0, d ? dec_params->lf.mode_deltas[0] : 0);
+	hantro_reg_write(ctx->dev, &vp9_filt_mb_adj_1, d ? dec_params->lf.mode_deltas[1] : 0);
+}
+
+static void config_picture_dimensions(struct hantro_ctx *ctx, struct hantro_decoded_buffer *dst)
+{
+	u32 pic_w_4x4, pic_h_4x4;
+
+	hantro_reg_write(ctx->dev, &g2_pic_width_in_cbs, (dst->vp9.width + 7) / 8);
+	hantro_reg_write(ctx->dev, &g2_pic_height_in_cbs, (dst->vp9.height + 7) / 8);
+	pic_w_4x4 = roundup(dst->vp9.width, 8) >> 2;
+	pic_h_4x4 = roundup(dst->vp9.height, 8) >> 2;
+	hantro_reg_write(ctx->dev, &g2_pic_width_4x4, pic_w_4x4);
+	hantro_reg_write(ctx->dev, &g2_pic_height_4x4, pic_h_4x4);
+}
+
+static void
+config_bit_depth(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	hantro_reg_write(ctx->dev, &g2_bit_depth_y_minus8, dec_params->bit_depth - 8);
+	hantro_reg_write(ctx->dev, &g2_bit_depth_c_minus8, dec_params->bit_depth - 8);
+}
+
+static inline bool is_lossless(const struct v4l2_vp9_quantization *quant)
+{
+	return quant->base_q_idx == 0 && quant->delta_q_uv_ac == 0 &&
+	       quant->delta_q_uv_dc == 0 && quant->delta_q_y_dc == 0;
+}
+
+static void
+config_quant(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	hantro_reg_write(ctx->dev, &vp9_qp_delta_y_dc, dec_params->quant.delta_q_y_dc);
+	hantro_reg_write(ctx->dev, &vp9_qp_delta_ch_dc, dec_params->quant.delta_q_uv_dc);
+	hantro_reg_write(ctx->dev, &vp9_qp_delta_ch_ac, dec_params->quant.delta_q_uv_ac);
+	hantro_reg_write(ctx->dev, &vp9_lossless_e, is_lossless(&dec_params->quant));
+}
+
+static u32
+hantro_interp_filter_from_v4l2(enum v4l2_vp9_interpolation_filter interpolation_filter)
+{
+	switch (interpolation_filter) {
+	case V4L2_VP9_INTERP_FILTER_EIGHTTAP:
+		return 0x1;
+	case V4L2_VP9_INTERP_FILTER_EIGHTTAP_SMOOTH:
+		return 0;
+	case V4L2_VP9_INTERP_FILTER_EIGHTTAP_SHARP:
+		return 0x2;
+	case V4L2_VP9_INTERP_FILTER_BILINEAR:
+		return 0x3;
+	case V4L2_VP9_INTERP_FILTER_SWITCHABLE:
+		return 0x4;
+	}
+
+	return 0;
+}
+
+static void
+config_others(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame *dec_params,
+	      bool intra_only, bool resolution_change)
+{
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+
+	hantro_reg_write(ctx->dev, &g2_idr_pic_e, intra_only);
+
+	hantro_reg_write(ctx->dev, &vp9_transform_mode, dec_params->tx_mode);
+
+	hantro_reg_write(ctx->dev, &vp9_mcomp_filt_type, intra_only ?
+		0 : hantro_interp_filter_from_v4l2(dec_params->interpolation_filter));
+
+	hantro_reg_write(ctx->dev, &vp9_high_prec_mv_e,
+			 !!(dec_params->flags & V4L2_VP9_FRAME_FLAG_ALLOW_HIGH_PREC_MV));
+
+	hantro_reg_write(ctx->dev, &vp9_comp_pred_mode, dec_params->reference_mode);
+
+	hantro_reg_write(ctx->dev, &g2_tempor_mvp_e,
+			 !(dec_params->flags & V4L2_VP9_FRAME_FLAG_ERROR_RESILIENT) &&
+			 !(dec_params->flags & V4L2_VP9_FRAME_FLAG_KEY_FRAME) &&
+			 !(vp9_ctx->last.flags & V4L2_VP9_FRAME_FLAG_KEY_FRAME) &&
+			 !(dec_params->flags & V4L2_VP9_FRAME_FLAG_INTRA_ONLY) &&
+			 !resolution_change &&
+			 vp9_ctx->last.flags & V4L2_VP9_FRAME_FLAG_SHOW_FRAME
+	);
+
+	hantro_reg_write(ctx->dev, &g2_write_mvs_e,
+			 !(dec_params->flags & V4L2_VP9_FRAME_FLAG_KEY_FRAME));
+}
+
+static void
+config_compound_reference(struct hantro_ctx *ctx,
+			  const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	u32 comp_fixed_ref, comp_var_ref[2];
+	bool last_ref_frame_sign_bias;
+	bool golden_ref_frame_sign_bias;
+	bool alt_ref_frame_sign_bias;
+	bool comp_ref_allowed = 0;
+
+	comp_fixed_ref = 0;
+	comp_var_ref[0] = 0;
+	comp_var_ref[1] = 0;
+
+	last_ref_frame_sign_bias = dec_params->ref_frame_sign_bias & V4L2_VP9_SIGN_BIAS_LAST;
+	golden_ref_frame_sign_bias = dec_params->ref_frame_sign_bias & V4L2_VP9_SIGN_BIAS_GOLDEN;
+	alt_ref_frame_sign_bias = dec_params->ref_frame_sign_bias & V4L2_VP9_SIGN_BIAS_ALT;
+
+	/* 6.3.12 Frame reference mode syntax */
+	comp_ref_allowed |= golden_ref_frame_sign_bias != last_ref_frame_sign_bias;
+	comp_ref_allowed |= alt_ref_frame_sign_bias != last_ref_frame_sign_bias;
+
+	if (comp_ref_allowed) {
+		if (last_ref_frame_sign_bias ==
+		    golden_ref_frame_sign_bias) {
+			comp_fixed_ref = ALTREF_FRAME;
+			comp_var_ref[0] = LAST_FRAME;
+			comp_var_ref[1] = GOLDEN_FRAME;
+		} else if (last_ref_frame_sign_bias ==
+			   alt_ref_frame_sign_bias) {
+			comp_fixed_ref = GOLDEN_FRAME;
+			comp_var_ref[0] = LAST_FRAME;
+			comp_var_ref[1] = ALTREF_FRAME;
+		} else {
+			comp_fixed_ref = LAST_FRAME;
+			comp_var_ref[0] = GOLDEN_FRAME;
+			comp_var_ref[1] = ALTREF_FRAME;
+		}
+	}
+
+	hantro_reg_write(ctx->dev, &vp9_comp_pred_fixed_ref, comp_fixed_ref);
+	hantro_reg_write(ctx->dev, &vp9_comp_pred_var_ref0, comp_var_ref[0]);
+	hantro_reg_write(ctx->dev, &vp9_comp_pred_var_ref1, comp_var_ref[1]);
+}
+
+#define INNER_LOOP \
+do {									\
+	for (m = 0; m < ARRAY_SIZE(adaptive->coef[0][0][0][0]); ++m) {	\
+		memcpy(adaptive->coef[i][j][k][l][m],			\
+		       probs->coef[i][j][k][l][m],			\
+		       sizeof(probs->coef[i][j][k][l][m]));		\
+									\
+		adaptive->coef[i][j][k][l][m][3] = 0;			\
+	}								\
+} while (0)
+
+static void config_probs(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame *dec_params)
+{
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+	struct hantro_aux_buf *misc = &vp9_ctx->misc;
+	struct hantro_g2_all_probs *all_probs = misc->cpu;
+	struct hantro_g2_probs *adaptive;
+	struct hantro_g2_mv_probs *mv;
+	const struct v4l2_vp9_segmentation *seg = &dec_params->seg;
+	const struct v4l2_vp9_frame_context *probs = &vp9_ctx->probability_tables;
+	int i, j, k, l, m;
+
+	for (i = 0; i < ARRAY_SIZE(all_probs->kf_y_mode_prob); ++i)
+		for (j = 0; j < ARRAY_SIZE(all_probs->kf_y_mode_prob[0]); ++j) {
+			memcpy(all_probs->kf_y_mode_prob[i][j],
+			       v4l2_vp9_kf_y_mode_prob[i][j],
+			       ARRAY_SIZE(all_probs->kf_y_mode_prob[i][j]));
+
+			all_probs->kf_y_mode_prob_tail[i][j][0] =
+				v4l2_vp9_kf_y_mode_prob[i][j][8];
+		}
+
+	memcpy(all_probs->mb_segment_tree_probs, seg->tree_probs,
+	       sizeof(all_probs->mb_segment_tree_probs));
+
+	memcpy(all_probs->segment_pred_probs, seg->pred_probs,
+	       sizeof(all_probs->segment_pred_probs));
+
+	for (i = 0; i < ARRAY_SIZE(all_probs->kf_uv_mode_prob); ++i) {
+		memcpy(all_probs->kf_uv_mode_prob[i], v4l2_vp9_kf_uv_mode_prob[i],
+		       ARRAY_SIZE(all_probs->kf_uv_mode_prob[i]));
+
+		all_probs->kf_uv_mode_prob_tail[i][0] = v4l2_vp9_kf_uv_mode_prob[i][8];
+	}
+
+	adaptive = &all_probs->probs;
+
+	for (i = 0; i < ARRAY_SIZE(adaptive->inter_mode); ++i) {
+		memcpy(adaptive->inter_mode[i], probs->inter_mode[i],
+		       sizeof(probs->inter_mode));
+
+		adaptive->inter_mode[i][3] = 0;
+	}
+
+	memcpy(adaptive->is_inter, probs->is_inter, sizeof(adaptive->is_inter));
+
+	for (i = 0; i < ARRAY_SIZE(adaptive->uv_mode); ++i) {
+		memcpy(adaptive->uv_mode[i], probs->uv_mode[i],
+		       sizeof(adaptive->uv_mode[i]));
+		adaptive->uv_mode_tail[i][0] = probs->uv_mode[i][8];
+	}
+
+	memcpy(adaptive->tx8, probs->tx8, sizeof(adaptive->tx8));
+	memcpy(adaptive->tx16, probs->tx16, sizeof(adaptive->tx16));
+	memcpy(adaptive->tx32, probs->tx32, sizeof(adaptive->tx32));
+
+	for (i = 0; i < ARRAY_SIZE(adaptive->y_mode); ++i) {
+		memcpy(adaptive->y_mode[i], probs->y_mode[i],
+		       ARRAY_SIZE(adaptive->y_mode[i]));
+
+		adaptive->y_mode_tail[i][0] = probs->y_mode[i][8];
+	}
+
+	for (i = 0; i < ARRAY_SIZE(adaptive->partition[0]); ++i) {
+		memcpy(adaptive->partition[0][i], v4l2_vp9_kf_partition_probs[i],
+		       sizeof(v4l2_vp9_kf_partition_probs[i]));
+
+		adaptive->partition[0][i][3] = 0;
+	}
+
+	for (i = 0; i < ARRAY_SIZE(adaptive->partition[1]); ++i) {
+		memcpy(adaptive->partition[1][i], probs->partition[i],
+		       sizeof(probs->partition[i]));
+
+		adaptive->partition[1][i][3] = 0;
+	}
+
+	memcpy(adaptive->interp_filter, probs->interp_filter,
+	       sizeof(adaptive->interp_filter));
+
+	memcpy(adaptive->comp_mode, probs->comp_mode, sizeof(adaptive->comp_mode));
+
+	memcpy(adaptive->skip, probs->skip, sizeof(adaptive->skip));
+
+	mv = &adaptive->mv;
+
+	memcpy(mv->joint, probs->mv.joint, sizeof(mv->joint));
+	memcpy(mv->sign, probs->mv.sign, sizeof(mv->sign));
+	memcpy(mv->class0_bit, probs->mv.class0_bit, sizeof(mv->class0_bit));
+	memcpy(mv->fr, probs->mv.fr, sizeof(mv->fr));
+	memcpy(mv->class0_hp, probs->mv.class0_hp, sizeof(mv->class0_hp));
+	memcpy(mv->hp, probs->mv.hp, sizeof(mv->hp));
+	memcpy(mv->classes, probs->mv.classes, sizeof(mv->classes));
+	memcpy(mv->class0_fr, probs->mv.class0_fr, sizeof(mv->class0_fr));
+	memcpy(mv->bits, probs->mv.bits, sizeof(mv->bits));
+
+	memcpy(adaptive->single_ref, probs->single_ref, sizeof(adaptive->single_ref));
+
+	memcpy(adaptive->comp_ref, probs->comp_ref, sizeof(adaptive->comp_ref));
+
+	for (i = 0; i < ARRAY_SIZE(adaptive->coef); ++i)
+		for (j = 0; j < ARRAY_SIZE(adaptive->coef[0]); ++j)
+			for (k = 0; k < ARRAY_SIZE(adaptive->coef[0][0]); ++k)
+				for (l = 0; l < ARRAY_SIZE(adaptive->coef[0][0][0]); ++l)
+					INNER_LOOP;
+
+	hantro_write_addr(ctx->dev, VP9_ADDR_PROBS, misc->dma);
+}
+
+static void config_counts(struct hantro_ctx *ctx)
+{
+	struct hantro_vp9_dec_hw_ctx *vp9_dec = &ctx->vp9_dec;
+	struct hantro_aux_buf *misc = &vp9_dec->misc;
+	dma_addr_t addr = misc->dma + vp9_dec->ctx_counters_offset;
+
+	hantro_write_addr(ctx->dev, VP9_ADDR_CTR, addr);
+}
+
+static void config_seg_map(struct hantro_ctx *ctx,
+			   const struct v4l2_ctrl_vp9_frame *dec_params,
+			   bool intra_only, bool update_map)
+{
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+	struct hantro_aux_buf *segment_map = &vp9_ctx->segment_map;
+	dma_addr_t addr;
+
+	if (intra_only ||
+	    (dec_params->flags & V4L2_VP9_FRAME_FLAG_ERROR_RESILIENT)) {
+		memset(segment_map->cpu, 0, segment_map->size);
+		memset(vp9_ctx->feature_data, 0, sizeof(vp9_ctx->feature_data));
+		memset(vp9_ctx->feature_enabled, 0, sizeof(vp9_ctx->feature_enabled));
+	}
+
+	addr = segment_map->dma + vp9_ctx->active_segment * vp9_ctx->segment_map_size;
+	hantro_write_addr(ctx->dev, VP9_ADDR_SEGMENT_READ, addr);
+
+	addr = segment_map->dma + (1 - vp9_ctx->active_segment) * vp9_ctx->segment_map_size;
+	hantro_write_addr(ctx->dev, VP9_ADDR_SEGMENT_WRITE, addr);
+
+	if (update_map)
+		vp9_ctx->active_segment = 1 - vp9_ctx->active_segment;
+}
+
+static void
+config_source(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame *dec_params,
+	      struct vb2_v4l2_buffer *vb2_src)
+{
+	dma_addr_t stream_base, tmp_addr;
+	unsigned int headres_size;
+	u32 src_len, start_bit, src_buf_len;
+
+	headres_size = dec_params->uncompressed_header_size
+		     + dec_params->compressed_header_size;
+
+	stream_base = vb2_dma_contig_plane_dma_addr(&vb2_src->vb2_buf, 0);
+	hantro_write_addr(ctx->dev, G2_ADDR_STR, stream_base);
+
+	tmp_addr = stream_base + headres_size;
+	start_bit = (tmp_addr & 0xf) * 8;
+	hantro_reg_write(ctx->dev, &g2_start_bit, start_bit);
+
+	src_len = vb2_get_plane_payload(&vb2_src->vb2_buf, 0);
+	src_len += start_bit / 8 - headres_size;
+	hantro_reg_write(ctx->dev, &g2_stream_len, src_len);
+
+	tmp_addr &= ~0xf;
+	hantro_reg_write(ctx->dev, &g2_strm_start_offset, tmp_addr - stream_base);
+	src_buf_len = vb2_plane_size(&vb2_src->vb2_buf, 0);
+	hantro_reg_write(ctx->dev, &g2_strm_buffer_len, src_buf_len);
+}
+
+static void
+config_registers(struct hantro_ctx *ctx, const struct v4l2_ctrl_vp9_frame *dec_params,
+		 struct vb2_v4l2_buffer *vb2_src, struct vb2_v4l2_buffer *vb2_dst)
+{
+	struct hantro_decoded_buffer *dst, *last, *mv_ref;
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+	const struct v4l2_vp9_segmentation *seg;
+	bool intra_only, resolution_change;
+
+	/* vp9 stuff */
+	dst = vb2_to_hantro_decoded_buf(&vb2_dst->vb2_buf);
+
+	if (vp9_ctx->last.valid)
+		last = get_ref_buf(ctx, &dst->base.vb, vp9_ctx->last.timestamp);
+	else
+		last = dst;
+
+	update_dec_buf_info(dst, dec_params);
+	update_ctx_cur_info(vp9_ctx, dst, dec_params);
+	seg = &dec_params->seg;
+
+	intra_only = !!(dec_params->flags &
+			(V4L2_VP9_FRAME_FLAG_KEY_FRAME |
+			V4L2_VP9_FRAME_FLAG_INTRA_ONLY));
+
+	if (!intra_only &&
+	    !(dec_params->flags & V4L2_VP9_FRAME_FLAG_ERROR_RESILIENT) &&
+	    vp9_ctx->last.valid)
+		mv_ref = last;
+	else
+		mv_ref = dst;
+
+	resolution_change = dst->vp9.width != last->vp9.width ||
+			    dst->vp9.height != last->vp9.height;
+
+	/* configure basic registers */
+	hantro_reg_write(ctx->dev, &g2_mode, VP9_DEC_MODE);
+	hantro_reg_write(ctx->dev, &g2_strm_swap, 0xf);
+	hantro_reg_write(ctx->dev, &g2_dirmv_swap, 0xf);
+	hantro_reg_write(ctx->dev, &g2_compress_swap, 0xf);
+	hantro_reg_write(ctx->dev, &g2_buswidth, BUS_WIDTH_128);
+	hantro_reg_write(ctx->dev, &g2_max_burst, 16);
+	hantro_reg_write(ctx->dev, &g2_apf_threshold, 8);
+	hantro_reg_write(ctx->dev, &g2_ref_compress_bypass, 1);
+	hantro_reg_write(ctx->dev, &g2_clk_gate_e, 1);
+	hantro_reg_write(ctx->dev, &g2_max_cb_size, 6);
+	hantro_reg_write(ctx->dev, &g2_min_cb_size, 3);
+
+	config_output(ctx, dst, dec_params);
+
+	if (!intra_only)
+		config_ref_registers(ctx, dec_params, dst, mv_ref);
+
+	config_tiles(ctx, dec_params, dst);
+	config_segment(ctx, dec_params);
+	config_loop_filter(ctx, dec_params);
+	config_picture_dimensions(ctx, dst);
+	config_bit_depth(ctx, dec_params);
+	config_quant(ctx, dec_params);
+	config_others(ctx, dec_params, intra_only, resolution_change);
+	config_compound_reference(ctx, dec_params);
+	config_probs(ctx, dec_params);
+	config_counts(ctx);
+	config_seg_map(ctx, dec_params, intra_only,
+		       seg->flags & V4L2_VP9_SEGMENTATION_FLAG_UPDATE_MAP);
+	config_source(ctx, dec_params, vb2_src);
+}
+
+int hantro_g2_vp9_dec_run(struct hantro_ctx *ctx)
+{
+	const struct v4l2_ctrl_vp9_frame *decode_params;
+	struct vb2_v4l2_buffer *src;
+	struct vb2_v4l2_buffer *dst;
+	int ret;
+
+	hantro_g2_check_idle(ctx->dev);
+
+	ret = start_prepare_run(ctx, &decode_params);
+	if (ret) {
+		hantro_end_prepare_run(ctx);
+		return ret;
+	}
+
+	src = hantro_get_src_buf(ctx);
+	dst = hantro_get_dst_buf(ctx);
+
+	config_registers(ctx, decode_params, src, dst);
+
+	hantro_end_prepare_run(ctx);
+
+	vdpu_write(ctx->dev, G2_REG_INTERRUPT_DEC_E, G2_REG_INTERRUPT);
+
+	return 0;
+}
+
+#define copy_tx_and_skip(p1, p2)				\
+do {								\
+	memcpy((p1)->tx8, (p2)->tx8, sizeof((p1)->tx8));	\
+	memcpy((p1)->tx16, (p2)->tx16, sizeof((p1)->tx16));	\
+	memcpy((p1)->tx32, (p2)->tx32, sizeof((p1)->tx32));	\
+	memcpy((p1)->skip, (p2)->skip, sizeof((p1)->skip));	\
+} while (0)
+
+void hantro_g2_vp9_dec_done(struct hantro_ctx *ctx)
+{
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+	unsigned int fctx_idx;
+
+	if (!(vp9_ctx->cur.flags & V4L2_VP9_FRAME_FLAG_REFRESH_FRAME_CTX))
+		goto out_update_last;
+
+	fctx_idx = vp9_ctx->cur.frame_context_idx;
+
+	if (!(vp9_ctx->cur.flags & V4L2_VP9_FRAME_FLAG_PARALLEL_DEC_MODE)) {
+		/* error_resilient_mode == 0 && frame_parallel_decoding_mode == 0 */
+		struct v4l2_vp9_frame_context *probs = &vp9_ctx->probability_tables;
+		bool frame_is_intra = vp9_ctx->cur.flags &
+		    (V4L2_VP9_FRAME_FLAG_KEY_FRAME | V4L2_VP9_FRAME_FLAG_INTRA_ONLY);
+		struct tx_and_skip {
+			u8 tx8[2][1];
+			u8 tx16[2][2];
+			u8 tx32[2][3];
+			u8 skip[3];
+		} _tx_skip, *tx_skip = &_tx_skip;
+		struct v4l2_vp9_frame_symbol_counts *counts;
+		struct symbol_counts *hantro_cnts;
+		u32 tx16p[2][4];
+		int i;
+
+		/* buffer the forward-updated TX and skip probs */
+		if (frame_is_intra)
+			copy_tx_and_skip(tx_skip, probs);
+
+		/* 6.1.2 refresh_probs(): load_probs() and load_probs2() */
+		*probs = vp9_ctx->frame_context[fctx_idx];
+
+		/* if FrameIsIntra then undo the effect of load_probs2() */
+		if (frame_is_intra)
+			copy_tx_and_skip(probs, tx_skip);
+
+		counts = &vp9_ctx->cnts;
+		hantro_cnts = vp9_ctx->misc.cpu + vp9_ctx->ctx_counters_offset;
+		for (i = 0; i < ARRAY_SIZE(tx16p); ++i) {
+			memcpy(tx16p[i],
+			       hantro_cnts->tx16x16_count[i],
+			       sizeof(hantro_cnts->tx16x16_count[0]));
+			tx16p[i][3] = 0;
+		}
+		counts->tx16p = &tx16p;
+
+		v4l2_vp9_adapt_coef_probs(probs, counts,
+					  !vp9_ctx->last.valid ||
+					  vp9_ctx->last.flags & V4L2_VP9_FRAME_FLAG_KEY_FRAME,
+					  frame_is_intra);
+
+		if (!frame_is_intra) {
+			/* load_probs2() already done */
+			u32 mv_mode[7][4];
+
+			for (i = 0; i < ARRAY_SIZE(mv_mode); ++i) {
+				mv_mode[i][0] = hantro_cnts->inter_mode_counts[i][1][0];
+				mv_mode[i][1] = hantro_cnts->inter_mode_counts[i][2][0];
+				mv_mode[i][2] = hantro_cnts->inter_mode_counts[i][0][0];
+				mv_mode[i][3] = hantro_cnts->inter_mode_counts[i][2][1];
+			}
+			counts->mv_mode = &mv_mode;
+			v4l2_vp9_adapt_noncoef_probs(&vp9_ctx->probability_tables, counts,
+						     vp9_ctx->cur.reference_mode,
+						     vp9_ctx->cur.interpolation_filter,
+						     vp9_ctx->cur.tx_mode, vp9_ctx->cur.flags);
+		}
+	}
+
+	vp9_ctx->frame_context[fctx_idx] = vp9_ctx->probability_tables;
+
+out_update_last:
+	vp9_ctx->last = vp9_ctx->cur;
+}
diff --git a/drivers/staging/media/hantro/hantro_hw.h b/drivers/staging/media/hantro/hantro_hw.h
index 42b3f3961f75..2961d399fd60 100644
--- a/drivers/staging/media/hantro/hantro_hw.h
+++ b/drivers/staging/media/hantro/hantro_hw.h
@@ -12,6 +12,7 @@ 
 #include <linux/interrupt.h>
 #include <linux/v4l2-controls.h>
 #include <media/v4l2-ctrls.h>
+#include <media/v4l2-vp9.h>
 #include <media/videobuf2-core.h>
 
 #define DEC_8190_ALIGN_MASK	0x07U
@@ -161,6 +162,50 @@  struct hantro_vp8_dec_hw_ctx {
 	struct hantro_aux_buf prob_tbl;
 };
 
+struct hantro_vp9_frame_info {
+	u32 valid : 1;
+	u32 frame_context_idx : 2;
+	u32 reference_mode : 2;
+	u32 tx_mode : 3;
+	u32 interpolation_filter : 3;
+	u32 flags;
+	u64 timestamp;
+};
+
+#define MAX_SB_COLS	64
+#define MAX_SB_ROWS	34
+
+/**
+ * struct hantro_vp9_dec_hw_ctx
+ *
+ */
+struct hantro_vp9_dec_hw_ctx {
+	struct hantro_aux_buf tile_edge;
+	struct hantro_aux_buf segment_map;
+	struct hantro_aux_buf misc;
+	struct v4l2_vp9_frame_symbol_counts cnts;
+	struct v4l2_vp9_frame_context probability_tables;
+	struct v4l2_vp9_frame_context frame_context[4];
+	struct hantro_vp9_frame_info cur;
+	struct hantro_vp9_frame_info last;
+
+	unsigned int bsd_ctrl_offset;
+	unsigned int segment_map_size;
+	unsigned int ctx_counters_offset;
+	unsigned int tile_info_offset;
+
+	unsigned short tile_r_info[MAX_SB_ROWS];
+	unsigned short tile_c_info[MAX_SB_COLS];
+	unsigned int last_tile_r;
+	unsigned int last_tile_c;
+	unsigned int last_sbs_r;
+	unsigned int last_sbs_c;
+
+	unsigned int active_segment;
+	u8 feature_enabled[8];
+	s16 feature_data[8][4];
+};
+
 /**
  * struct hantro_postproc_ctx
  *
@@ -267,6 +312,24 @@  void hantro_hevc_ref_remove_unused(struct hantro_ctx *ctx);
 size_t hantro_hevc_chroma_offset(const struct v4l2_ctrl_hevc_sps *sps);
 size_t hantro_hevc_motion_vectors_offset(const struct v4l2_ctrl_hevc_sps *sps);
 
+static inline unsigned short hantro_vp9_num_sbs(unsigned short dimension)
+{
+	return (dimension + 63) / 64;
+}
+
+static inline size_t
+hantro_vp9_mv_size(unsigned int width, unsigned int height)
+{
+	int num_ctbs;
+
+	/*
+	 * There can be up to (CTBs x 64) number of blocks,
+	 * and the motion vector for each block needs 16 bytes.
+	 */
+	num_ctbs = hantro_vp9_num_sbs(width) * hantro_vp9_num_sbs(height);
+	return (num_ctbs * 64) * 16;
+}
+
 static inline size_t
 hantro_h264_mv_size(unsigned int width, unsigned int height)
 {
@@ -308,6 +371,10 @@  void hantro_vp8_dec_exit(struct hantro_ctx *ctx);
 void hantro_vp8_prob_update(struct hantro_ctx *ctx,
 			    const struct v4l2_ctrl_vp8_frame *hdr);
 
+int hantro_g2_vp9_dec_run(struct hantro_ctx *ctx);
+void hantro_g2_vp9_dec_done(struct hantro_ctx *ctx);
+int hantro_vp9_dec_init(struct hantro_ctx *ctx);
+void hantro_vp9_dec_exit(struct hantro_ctx *ctx);
 void hantro_g2_check_idle(struct hantro_dev *vpu);
 
 #endif /* HANTRO_HW_H_ */
diff --git a/drivers/staging/media/hantro/hantro_v4l2.c b/drivers/staging/media/hantro/hantro_v4l2.c
index d1f060c55fed..e4b0645ba6fc 100644
--- a/drivers/staging/media/hantro/hantro_v4l2.c
+++ b/drivers/staging/media/hantro/hantro_v4l2.c
@@ -299,6 +299,11 @@  static int hantro_try_fmt(const struct hantro_ctx *ctx,
 			pix_mp->plane_fmt[0].sizeimage +=
 				hantro_h264_mv_size(pix_mp->width,
 						    pix_mp->height);
+		else if (ctx->vpu_src_fmt->fourcc == V4L2_PIX_FMT_VP9_FRAME &&
+			 !hantro_needs_postproc(ctx, fmt))
+			pix_mp->plane_fmt[0].sizeimage +=
+				hantro_vp9_mv_size(pix_mp->width,
+						   pix_mp->height);
 	} else if (!pix_mp->plane_fmt[0].sizeimage) {
 		/*
 		 * For coded formats the application can specify
@@ -407,6 +412,7 @@  hantro_update_requires_request(struct hantro_ctx *ctx, u32 fourcc)
 	case V4L2_PIX_FMT_VP8_FRAME:
 	case V4L2_PIX_FMT_H264_SLICE:
 	case V4L2_PIX_FMT_HEVC_SLICE:
+	case V4L2_PIX_FMT_VP9_FRAME:
 		ctx->fh.m2m_ctx->out_q_ctx.q.requires_requests = true;
 		break;
 	default:
diff --git a/drivers/staging/media/hantro/hantro_vp9.c b/drivers/staging/media/hantro/hantro_vp9.c
new file mode 100644
index 000000000000..566cd376c097
--- /dev/null
+++ b/drivers/staging/media/hantro/hantro_vp9.c
@@ -0,0 +1,240 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Hantro VP9 codec driver
+ *
+ * Copyright (C) 2021 Collabora Ltd.
+ */
+
+#include <linux/types.h>
+#include <media/v4l2-mem2mem.h>
+
+#include "hantro.h"
+#include "hantro_hw.h"
+#include "hantro_vp9.h"
+
+#define POW2(x) (1 << (x))
+
+#define MAX_LOG2_TILE_COLUMNS 6
+#define MAX_NUM_TILE_COLS POW2(MAX_LOG2_TILE_COLUMNS)
+#define MAX_TILE_COLS 20
+#define MAX_TILE_ROWS 22
+
+static size_t hantro_vp9_tile_filter_size(unsigned int height)
+{
+	u32 h, height32, size;
+
+	h = roundup(height, 8);
+
+	height32 = roundup(h, 64);
+	size = 24 * height32 * (MAX_NUM_TILE_COLS - 1); /* luma: 8, chroma: 8 + 8 */
+
+	return size;
+}
+
+static size_t hantro_vp9_bsd_control_size(unsigned int height)
+{
+	u32 h, height32;
+
+	h = roundup(height, 8);
+	height32 = roundup(h, 64);
+
+	return 16 * (height32 / 4) * (MAX_NUM_TILE_COLS - 1);
+}
+
+static size_t hantro_vp9_segment_map_size(unsigned int width, unsigned int height)
+{
+	u32 w, h;
+	int num_ctbs;
+
+	w = roundup(width, 8);
+	h = roundup(height, 8);
+	num_ctbs = ((w + 63) / 64) * ((h + 63) / 64);
+
+	return num_ctbs * 32;
+}
+
+static inline size_t hantro_vp9_prob_tab_size(void)
+{
+	return roundup(sizeof(struct hantro_g2_all_probs), 16);
+}
+
+static inline size_t hantro_vp9_count_tab_size(void)
+{
+	return roundup(sizeof(struct symbol_counts), 16);
+}
+
+static inline size_t hantro_vp9_tile_info_size(void)
+{
+	return roundup((MAX_TILE_COLS * MAX_TILE_ROWS * 4 * sizeof(u16) + 15 + 16) & ~0xf, 16);
+}
+
+static void *get_coeffs_arr(struct symbol_counts *cnts, int i, int j, int k, int l, int m)
+{
+	if (i == 0)
+		return &cnts->count_coeffs[j][k][l][m];
+
+	if (i == 1)
+		return &cnts->count_coeffs8x8[j][k][l][m];
+
+	if (i == 2)
+		return &cnts->count_coeffs16x16[j][k][l][m];
+
+	if (i == 3)
+		return &cnts->count_coeffs32x32[j][k][l][m];
+
+	return NULL;
+}
+
+static void *get_eobs1(struct symbol_counts *cnts, int i, int j, int k, int l, int m)
+{
+	if (i == 0)
+		return &cnts->count_coeffs[j][k][l][m][3];
+
+	if (i == 1)
+		return &cnts->count_coeffs8x8[j][k][l][m][3];
+
+	if (i == 2)
+		return &cnts->count_coeffs16x16[j][k][l][m][3];
+
+	if (i == 3)
+		return &cnts->count_coeffs32x32[j][k][l][m][3];
+
+	return NULL;
+}
+
+#define INNER_LOOP \
+	do {										\
+		for (m = 0; m < ARRAY_SIZE(vp9_ctx->cnts.coeff[i][0][0][0]); ++m) {	\
+			vp9_ctx->cnts.coeff[i][j][k][l][m] =				\
+				get_coeffs_arr(cnts, i, j, k, l, m);			\
+			vp9_ctx->cnts.eob[i][j][k][l][m][0] =				\
+				&cnts->count_eobs[i][j][k][l][m];			\
+			vp9_ctx->cnts.eob[i][j][k][l][m][1] =				\
+				get_eobs1(cnts, i, j, k, l, m);				\
+		}									\
+	} while (0)
+
+static void init_v4l2_vp9_count_tbl(struct hantro_ctx *ctx)
+{
+	struct hantro_vp9_dec_hw_ctx *vp9_ctx = &ctx->vp9_dec;
+	struct symbol_counts *cnts = vp9_ctx->misc.cpu + vp9_ctx->ctx_counters_offset;
+	int i, j, k, l, m;
+
+	vp9_ctx->cnts.partition = &cnts->partition_counts;
+	vp9_ctx->cnts.skip = &cnts->mbskip_count;
+	vp9_ctx->cnts.intra_inter = &cnts->intra_inter_count;
+	vp9_ctx->cnts.tx32p = &cnts->tx32x32_count;
+	/*
+	 * g2 hardware uses tx16x16_count[2][3], while the api
+	 * expects tx16p[2][4], so this must be explicitly copied
+	 * into vp9_ctx->cnts.tx16p when passing the data to the
+	 * vp9 library function
+	 */
+	vp9_ctx->cnts.tx8p = &cnts->tx8x8_count;
+
+	vp9_ctx->cnts.y_mode = &cnts->sb_ymode_counts;
+	vp9_ctx->cnts.uv_mode = &cnts->uv_mode_counts;
+	vp9_ctx->cnts.comp = &cnts->comp_inter_count;
+	vp9_ctx->cnts.comp_ref = &cnts->comp_ref_count;
+	vp9_ctx->cnts.single_ref = &cnts->single_ref_count;
+	vp9_ctx->cnts.filter = &cnts->switchable_interp_counts;
+	vp9_ctx->cnts.mv_joint = &cnts->mv_counts.joints;
+	vp9_ctx->cnts.sign = &cnts->mv_counts.sign;
+	vp9_ctx->cnts.classes = &cnts->mv_counts.classes;
+	vp9_ctx->cnts.class0 = &cnts->mv_counts.class0;
+	vp9_ctx->cnts.bits = &cnts->mv_counts.bits;
+	vp9_ctx->cnts.class0_fp = &cnts->mv_counts.class0_fp;
+	vp9_ctx->cnts.fp = &cnts->mv_counts.fp;
+	vp9_ctx->cnts.class0_hp = &cnts->mv_counts.class0_hp;
+	vp9_ctx->cnts.hp = &cnts->mv_counts.hp;
+
+	for (i = 0; i < ARRAY_SIZE(vp9_ctx->cnts.coeff); ++i)
+		for (j = 0; j < ARRAY_SIZE(vp9_ctx->cnts.coeff[i]); ++j)
+			for (k = 0; k < ARRAY_SIZE(vp9_ctx->cnts.coeff[i][0]); ++k)
+				for (l = 0; l < ARRAY_SIZE(vp9_ctx->cnts.coeff[i][0][0]); ++l)
+					INNER_LOOP;
+}
+
+int hantro_vp9_dec_init(struct hantro_ctx *ctx)
+{
+	struct hantro_dev *vpu = ctx->dev;
+	const struct hantro_variant *variant = vpu->variant;
+	struct hantro_vp9_dec_hw_ctx *vp9_dec = &ctx->vp9_dec;
+	struct hantro_aux_buf *tile_edge = &vp9_dec->tile_edge;
+	struct hantro_aux_buf *segment_map = &vp9_dec->segment_map;
+	struct hantro_aux_buf *misc = &vp9_dec->misc;
+	u32 i, max_width, max_height, size;
+
+	if (variant->num_dec_fmts < 1)
+		return -EINVAL;
+
+	for (i = 0; i < variant->num_dec_fmts; ++i)
+		if (variant->dec_fmts[i].fourcc == V4L2_PIX_FMT_VP9_FRAME)
+			break;
+
+	if (i == variant->num_dec_fmts)
+		return -EINVAL;
+
+	max_width = vpu->variant->dec_fmts[i].frmsize.max_width;
+	max_height = vpu->variant->dec_fmts[i].frmsize.max_height;
+
+	size = hantro_vp9_tile_filter_size(max_height);
+	vp9_dec->bsd_ctrl_offset = size;
+	size += hantro_vp9_bsd_control_size(max_height);
+
+	tile_edge->cpu = dma_alloc_coherent(vpu->dev, size, &tile_edge->dma, GFP_KERNEL);
+	if (!tile_edge->cpu)
+		return -ENOMEM;
+
+	tile_edge->size = size;
+	memset(tile_edge->cpu, 0, size);
+
+	size = hantro_vp9_segment_map_size(max_width, max_height);
+	vp9_dec->segment_map_size = size;
+	size *= 2; /* we need two areas of this size, used alternately */
+
+	segment_map->cpu = dma_alloc_coherent(vpu->dev, size, &segment_map->dma, GFP_KERNEL);
+	if (!segment_map->cpu)
+		goto err_segment_map;
+
+	segment_map->size = size;
+	memset(segment_map->cpu, 0, size);
+
+	size = hantro_vp9_prob_tab_size();
+	vp9_dec->ctx_counters_offset = size;
+	size += hantro_vp9_count_tab_size();
+	vp9_dec->tile_info_offset = size;
+	size += hantro_vp9_tile_info_size();
+
+	misc->cpu = dma_alloc_coherent(vpu->dev, size, &misc->dma, GFP_KERNEL);
+	if (!misc->cpu)
+		goto err_misc;
+
+	misc->size = size;
+	memset(misc->cpu, 0, size);
+
+	init_v4l2_vp9_count_tbl(ctx);
+
+	return 0;
+
+err_misc:
+	dma_free_coherent(vpu->dev, segment_map->size, segment_map->cpu, segment_map->dma);
+
+err_segment_map:
+	dma_free_coherent(vpu->dev, tile_edge->size, tile_edge->cpu, tile_edge->dma);
+
+	return -ENOMEM;
+}
+
+void hantro_vp9_dec_exit(struct hantro_ctx *ctx)
+{
+	struct hantro_dev *vpu = ctx->dev;
+	struct hantro_vp9_dec_hw_ctx *vp9_dec = &ctx->vp9_dec;
+	struct hantro_aux_buf *tile_edge = &vp9_dec->tile_edge;
+	struct hantro_aux_buf *segment_map = &vp9_dec->segment_map;
+	struct hantro_aux_buf *misc = &vp9_dec->misc;
+
+	dma_free_coherent(vpu->dev, misc->size, misc->cpu, misc->dma);
+	dma_free_coherent(vpu->dev, segment_map->size, segment_map->cpu, segment_map->dma);
+	dma_free_coherent(vpu->dev, tile_edge->size, tile_edge->cpu, tile_edge->dma);
+}
diff --git a/drivers/staging/media/hantro/hantro_vp9.h b/drivers/staging/media/hantro/hantro_vp9.h
new file mode 100644
index 000000000000..c7f4bd3ff8dd
--- /dev/null
+++ b/drivers/staging/media/hantro/hantro_vp9.h
@@ -0,0 +1,103 @@ 
+/* SPDX-License-Identifier: GPL-2.0 */
+/*
+ * Hantro VP9 codec driver
+ *
+ * Copyright (C) 2021 Collabora Ltd.
+ */
+
+struct hantro_g2_mv_probs {
+	u8 joint[3];
+	u8 sign[2];
+	u8 class0_bit[2][1];
+	u8 fr[2][3];
+	u8 class0_hp[2];
+	u8 hp[2];
+	u8 classes[2][10];
+	u8 class0_fr[2][2][3];
+	u8 bits[2][10];
+};
+
+struct hantro_g2_probs {
+	u8 inter_mode[7][4];
+	u8 is_inter[4];
+	u8 uv_mode[10][8];
+	u8 tx8[2][1];
+	u8 tx16[2][2];
+	u8 tx32[2][3];
+	u8 y_mode_tail[4][1];
+	u8 y_mode[4][8];
+	u8 partition[2][16][4]; /* [keyframe][][], [inter][][] */
+	u8 uv_mode_tail[10][1];
+	u8 interp_filter[4][2];
+	u8 comp_mode[5];
+	u8 skip[3];
+
+	u8 pad1[1];
+
+	struct hantro_g2_mv_probs mv;
+
+	u8 single_ref[5][2];
+	u8 comp_ref[5];
+
+	u8 pad2[17];
+
+	u8 coef[4][2][2][6][6][4];
+};
+
+struct hantro_g2_all_probs {
+	u8 kf_y_mode_prob[10][10][8];
+
+	u8 kf_y_mode_prob_tail[10][10][1];
+	u8 ref_pred_probs[3];
+	u8 mb_segment_tree_probs[7];
+	u8 segment_pred_probs[3];
+	u8 ref_scores[4];
+	u8 prob_comppred[2];
+
+	u8 pad1[9];
+
+	u8 kf_uv_mode_prob[10][8];
+	u8 kf_uv_mode_prob_tail[10][1];
+
+	u8 pad2[6];
+
+	struct hantro_g2_probs probs;
+};
+
+struct mv_counts {
+	u32 joints[4];
+	u32 sign[2][2];
+	u32 classes[2][11];
+	u32 class0[2][2];
+	u32 bits[2][10][2];
+	u32 class0_fp[2][2][4];
+	u32 fp[2][4];
+	u32 class0_hp[2][2];
+	u32 hp[2][2];
+};
+
+struct symbol_counts {
+	u32 inter_mode_counts[7][3][2];
+	u32 sb_ymode_counts[4][10];
+	u32 uv_mode_counts[10][10];
+	u32 partition_counts[16][4];
+	u32 switchable_interp_counts[4][3];
+	u32 intra_inter_count[4][2];
+	u32 comp_inter_count[5][2];
+	u32 single_ref_count[5][2][2];
+	u32 comp_ref_count[5][2];
+	u32 tx32x32_count[2][4];
+	u32 tx16x16_count[2][3];
+	u32 tx8x8_count[2][2];
+	u32 mbskip_count[3][2];
+
+	struct mv_counts mv_counts;
+
+	u32 count_coeffs[2][2][6][6][4];
+	u32 count_coeffs8x8[2][2][6][6][4];
+	u32 count_coeffs16x16[2][2][6][6][4];
+	u32 count_coeffs32x32[2][2][6][6][4];
+
+	u32 count_eobs[4][2][2][6][6];
+};
+
diff --git a/drivers/staging/media/hantro/imx8m_vpu_hw.c b/drivers/staging/media/hantro/imx8m_vpu_hw.c
index a40b161e5956..455a107ffb02 100644
--- a/drivers/staging/media/hantro/imx8m_vpu_hw.c
+++ b/drivers/staging/media/hantro/imx8m_vpu_hw.c
@@ -150,6 +150,19 @@  static const struct hantro_fmt imx8m_vpu_g2_dec_fmts[] = {
 			.step_height = MB_DIM,
 		},
 	},
+	{
+		.fourcc = V4L2_PIX_FMT_VP9_FRAME,
+		.codec_mode = HANTRO_MODE_VP9_DEC,
+		.max_depth = 2,
+		.frmsize = {
+			.min_width = 48,
+			.max_width = 3840,
+			.step_width = MB_DIM,
+			.min_height = 48,
+			.max_height = 2160,
+			.step_height = MB_DIM,
+		},
+	},
 };
 
 static irqreturn_t imx8m_vpu_g1_irq(int irq, void *dev_id)
@@ -241,6 +254,13 @@  static const struct hantro_codec_ops imx8mq_vpu_g2_codec_ops[] = {
 		.init = hantro_hevc_dec_init,
 		.exit = hantro_hevc_dec_exit,
 	},
+	[HANTRO_MODE_VP9_DEC] = {
+		.run = hantro_g2_vp9_dec_run,
+		.done = hantro_g2_vp9_dec_done,
+		.reset = imx8m_vpu_g2_reset,
+		.init = hantro_vp9_dec_init,
+		.exit = hantro_vp9_dec_exit,
+	},
 };
 
 /*
@@ -281,7 +301,7 @@  const struct hantro_variant imx8mq_vpu_g2_variant = {
 	.dec_offset = 0x0,
 	.dec_fmts = imx8m_vpu_g2_dec_fmts,
 	.num_dec_fmts = ARRAY_SIZE(imx8m_vpu_g2_dec_fmts),
-	.codec = HANTRO_HEVC_DECODER,
+	.codec = HANTRO_HEVC_DECODER | HANTRO_VP9_DECODER,
 	.codec_ops = imx8mq_vpu_g2_codec_ops,
 	.init = imx8mq_vpu_hw_init,
 	.runtime_resume = imx8mq_runtime_resume,