static int vivid_streaming_s_ctrl(struct v4l2_ctrl *ctrl)
{
struct vivid_dev *dev = container_of(ctrl->handler, struct vivid_dev, ctrl_hdl_streaming);
struct timeval tv;
switch (ctrl->id) {
case VIVID_CID_DQBUF_ERROR:
dev->dqbuf_error = true;
break;
case VIVID_CID_PERC_DROPPED:
dev->perc_dropped_buffers = ctrl->val;
break;
case VIVID_CID_QUEUE_SETUP_ERROR:
dev->queue_setup_error = true;
break;
case VIVID_CID_BUF_PREPARE_ERROR:
dev->buf_prepare_error = true;
break;
case VIVID_CID_START_STR_ERROR:
dev->start_streaming_error = true;
break;
case VIVID_CID_QUEUE_ERROR:
if (vb2_start_streaming_called(&dev->vb_vid_cap_q))
vb2_queue_error(&dev->vb_vid_cap_q);
if (vb2_start_streaming_called(&dev->vb_vbi_cap_q))
vb2_queue_error(&dev->vb_vbi_cap_q);
if (vb2_start_streaming_called(&dev->vb_vid_out_q))
vb2_queue_error(&dev->vb_vid_out_q);
if (vb2_start_streaming_called(&dev->vb_vbi_out_q))
vb2_queue_error(&dev->vb_vbi_out_q);
if (vb2_start_streaming_called(&dev->vb_sdr_cap_q))
vb2_queue_error(&dev->vb_sdr_cap_q);
break;
case VIVID_CID_SEQ_WRAP:
dev->seq_wrap = ctrl->val;
break;
case VIVID_CID_TIME_WRAP:
dev->time_wrap = ctrl->val;
if (ctrl->val == 0) {
dev->time_wrap_offset = 0;
break;
}
v4l2_get_timestamp(&tv);
dev->time_wrap_offset = -tv.tv_sec - 16;
break;
}
return 0;
}
static int vb2ops_venc_start_streaming(struct vb2_queue *q, unsigned int count)
{
struct mtk_vcodec_ctx *ctx = vb2_get_drv_priv(q);
struct venc_enc_param param;
int ret;
int i;
/* Once state turn into MTK_STATE_ABORT, we need stop_streaming
* to clear it
*/
if ((ctx->state == MTK_STATE_ABORT) || (ctx->state == MTK_STATE_FREE)) {
ret = -EIO;
goto err_set_param;
}
/* Do the initialization when both start_streaming have been called */
if (V4L2_TYPE_IS_OUTPUT(q->type)) {
if (!vb2_start_streaming_called(&ctx->m2m_ctx->cap_q_ctx.q))
return 0;
} else {
if (!vb2_start_streaming_called(&ctx->m2m_ctx->out_q_ctx.q))
return 0;
}
mtk_venc_set_param(ctx, ¶m);
ret = venc_if_set_param(ctx, VENC_SET_PARAM_ENC, ¶m);
if (ret) {
mtk_v4l2_err("venc_if_set_param failed=%d", ret);
ctx->state = MTK_STATE_ABORT;
goto err_set_param;
}
ctx->param_change = MTK_ENCODE_PARAM_NONE;
if ((ctx->q_data[MTK_Q_DATA_DST].fmt->fourcc == V4L2_PIX_FMT_H264) &&
(ctx->enc_params.seq_hdr_mode !=
V4L2_MPEG_VIDEO_HEADER_MODE_SEPARATE)) {
ret = venc_if_set_param(ctx,
VENC_SET_PARAM_PREPEND_HEADER,
NULL);
if (ret) {
mtk_v4l2_err("venc_if_set_param failed=%d", ret);
ctx->state = MTK_STATE_ABORT;
goto err_set_param;
}
ctx->state = MTK_STATE_HEADER;
}
return 0;
err_set_param:
for (i = 0; i < q->num_buffers; ++i) {
if (q->bufs[i]->state == VB2_BUF_STATE_ACTIVE) {
mtk_v4l2_debug(0, "[%d] id=%d, type=%d, %d -> VB2_BUF_STATE_QUEUED",
ctx->id, i, q->type,
(int)q->bufs[i]->state);
v4l2_m2m_buf_done(to_vb2_v4l2_buffer(q->bufs[i]),
VB2_BUF_STATE_QUEUED);
}
}
return ret;
}
static int hva_start_streaming(struct vb2_queue *vq, unsigned int count)
{
struct hva_ctx *ctx = vb2_get_drv_priv(vq);
struct hva_dev *hva = ctx_to_hdev(ctx);
struct device *dev = ctx_to_dev(ctx);
struct vb2_v4l2_buffer *vbuf;
int ret;
unsigned int i;
bool found = false;
dev_dbg(dev, "%s %s start streaming\n", ctx->name,
to_type_str(vq->type));
/* open encoder when both start_streaming have been called */
if (V4L2_TYPE_IS_OUTPUT(vq->type)) {
if (!vb2_start_streaming_called(&ctx->fh.m2m_ctx->cap_q_ctx.q))
return 0;
} else {
if (!vb2_start_streaming_called(&ctx->fh.m2m_ctx->out_q_ctx.q))
return 0;
}
/* store the instance context in the instances array */
for (i = 0; i < HVA_MAX_INSTANCES; i++) {
if (!hva->instances[i]) {
hva->instances[i] = ctx;
/* save the context identifier in the context */
ctx->id = i;
found = true;
break;
}
}
if (!found) {
dev_err(dev, "%s maximum instances reached\n", ctx->name);
ret = -ENOMEM;
goto err;
}
hva->nb_of_instances++;
if (!ctx->enc) {
ret = hva_open_encoder(ctx,
ctx->streaminfo.streamformat,
ctx->frameinfo.pixelformat,
&ctx->enc);
if (ret < 0)
goto err_ctx;
}
return 0;
err_ctx:
hva->instances[ctx->id] = NULL;
hva->nb_of_instances--;
err:
if (vq->type == V4L2_BUF_TYPE_VIDEO_OUTPUT) {
/* return of all pending buffers to vb2 (in queued state) */
while ((vbuf = v4l2_m2m_src_buf_remove(ctx->fh.m2m_ctx)))
v4l2_m2m_buf_done(vbuf, VB2_BUF_STATE_QUEUED);
} else {
/* return of all pending buffers to vb2 (in queued state) */
while ((vbuf = v4l2_m2m_dst_buf_remove(ctx->fh.m2m_ctx)))
v4l2_m2m_buf_done(vbuf, VB2_BUF_STATE_QUEUED);
}
return ret;
}
