fimc-core.rar_fimc_postprocessor

/* * S5P camera interface (video postprocessor) driver * * * * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published * by the Free Software Foundation, either version 2 of the License, * or (at your option) any later version. */ #include <linux/module.h> #include <linux/kernel.h> #include <linux/version.h> #include <linux/types.h> #include <linux/errno.h> #include <linux/bug.h> #include <linux/interrupt.h> #include <linux/device.h> #include <linux/platform_device.h> #include <linux/list.h> #include <linux/io.h> #include <linux/slab.h> #include <linux/clk.h> #include <media/v4l2-ioctl.h> #include <media/videobuf-dma-contig.h> #include "fimc-core.h" static char *fimc_clock_name[NUM_FIMC_CLOCKS] = { "sclk_fimc", "fimc" }; static struct fimc_fmt fimc_formats[] = { { .name = "RGB565", .fourcc = V4L2_PIX_FMT_RGB565X, .depth = 16, .color = S5P_FIMC_RGB565, .buff_cnt = 1, .planes_cnt = 1 }, { .name = "BGR666", .fourcc = V4L2_PIX_FMT_BGR666, .depth = 32, .color = S5P_FIMC_RGB666, .buff_cnt = 1, .planes_cnt = 1 }, { .name = "XRGB-8-8-8-8, 24 bpp", .fourcc = V4L2_PIX_FMT_RGB24, .depth = 32, .color = S5P_FIMC_RGB888, .buff_cnt = 1, .planes_cnt = 1 }, { .name = "YUV 4:2:2 packed, YCbYCr", .fourcc = V4L2_PIX_FMT_YUYV, .depth = 16, .color = S5P_FIMC_YCBYCR422, .buff_cnt = 1, .planes_cnt = 1 }, { .name = "YUV 4:2:2 packed, CbYCrY", .fourcc = V4L2_PIX_FMT_UYVY, .depth = 16, .color = S5P_FIMC_CBYCRY422, .buff_cnt = 1, .planes_cnt = 1 }, { .name = "YUV 4:2:2 packed, CrYCbY", .fourcc = V4L2_PIX_FMT_VYUY, .depth = 16, .color = S5P_FIMC_CRYCBY422, .buff_cnt = 1, .planes_cnt = 1 }, { .name = "YUV 4:2:2 packed, YCrYCb", .fourcc = V4L2_PIX_FMT_YVYU, .depth = 16, .color = S5P_FIMC_YCRYCB422, .buff_cnt = 1, .planes_cnt = 1 }, { .name = "YUV 4:2:2 planar, Y/Cb/Cr", .fourcc = V4L2_PIX_FMT_YUV422P, .depth = 12, .color = S5P_FIMC_YCBCR422, .buff_cnt = 1, .planes_cnt = 3 }, { .name = "YUV 4:2:2 planar, Y/CbCr", .fourcc = V4L2_PIX_FMT_NV16, .depth = 16, .color = S5P_FIMC_YCBCR422, .buff_cnt = 1, .planes_cnt = 2 }, { .name = "YUV 4:2:2 planar, Y/CrCb", .fourcc = V4L2_PIX_FMT_NV61, .depth = 16, .color = S5P_FIMC_RGB565, .buff_cnt = 1, .planes_cnt = 2 }, { .name = "YUV 4:2:0 planar, YCbCr", .fourcc = V4L2_PIX_FMT_YUV420, .depth = 12, .color = S5P_FIMC_YCBCR420, .buff_cnt = 1, .planes_cnt = 3 }, { .name = "YUV 4:2:0 planar, Y/CbCr", .fourcc = V4L2_PIX_FMT_NV12, .depth = 12, .color = S5P_FIMC_YCBCR420, .buff_cnt = 1, .planes_cnt = 2 } }; static struct v4l2_queryctrl fimc_ctrls[] = { { .id = V4L2_CID_HFLIP, .type = V4L2_CTRL_TYPE_BOOLEAN, .name = "Horizontal flip", .minimum = 0, .maximum = 1, .default_value = 0, }, { .id = V4L2_CID_VFLIP, .type = V4L2_CTRL_TYPE_BOOLEAN, .name = "Vertical flip", .minimum = 0, .maximum = 1, .default_value = 0, }, { .id = V4L2_CID_ROTATE, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Rotation (CCW)", .minimum = 0, .maximum = 270, .step = 90, .default_value = 0, }, }; static struct v4l2_queryctrl *get_ctrl(int id) { int i; for (i = 0; i < ARRAY_SIZE(fimc_ctrls); ++i) if (id == fimc_ctrls[i].id) return &fimc_ctrls[i]; return NULL; } static int fimc_check_scaler_ratio(struct v4l2_rect *r, struct fimc_frame *f) { if (r->width > f->width) { if (f->width > (r->width * SCALER_MAX_HRATIO)) return -EINVAL; } else { if ((f->width * SCALER_MAX_HRATIO) < r->width) return -EINVAL; } if (r->height > f->height) { if (f->height > (r->height * SCALER_MAX_VRATIO)) return -EINVAL; } else { if ((f->height * SCALER_MAX_VRATIO) < r->height) return -EINVAL; } return 0; } static int fimc_get_scaler_factor(u32 src, u32 tar, u32 *ratio, u32 *shift) { if (src >= tar * 64) { return -EINVAL; } else if (src >= tar * 32) { *ratio = 32; *shift = 5; } else if (src >= tar * 16) { *ratio = 16; *shift = 4; } else if (src >= tar * 8) { *ratio = 8; *shift = 3; } else if (src >= tar * 4) { *ratio = 4; *shift = 2; } else if (src >= tar * 2) { *ratio = 2; *shift = 1; } else { *ratio = 1; *shift = 0; } return 0; } static int fimc_set_scaler_info(struct fimc_ctx *ctx) { struct fimc_scaler *sc = &ctx->scaler; struct fimc_frame *s_frame = &ctx->s_frame; struct fimc_frame *d_frame = &ctx->d_frame; int tx, ty, sx, sy; int ret; tx = d_frame->width; ty = d_frame->height; if (tx <= 0 || ty <= 0) { v4l2_err(&ctx->fimc_dev->m2m.v4l2_dev, "invalid target size: %d x %d", tx, ty); return -EINVAL; } sx = s_frame->width; sy = s_frame->height; if (sx <= 0 || sy <= 0) { err("invalid source size: %d x %d", sx, sy); return -EINVAL; } sc->real_width = sx; sc->real_height = sy; dbg("sx= %d, sy= %d, tx= %d, ty= %d", sx, sy, tx, ty); ret = fimc_get_scaler_factor(sx, tx, &sc->pre_hratio, &sc->hfactor); if (ret) return ret; ret = fimc_get_scaler_factor(sy, ty, &sc->pre_vratio, &sc->vfactor); if (ret) return ret; sc->pre_dst_width = sx / sc->pre_hratio; sc->pre_dst_height = sy / sc->pre_vratio; sc->main_hratio = (sx << 8) / (tx << sc->hfactor); sc->main_vratio = (sy << 8) / (ty << sc->vfactor); sc->scaleup_h = (tx >= sx) ? 1 : 0; sc->scaleup_v = (ty >= sy) ? 1 : 0; /* check to see if input and output size/format differ */ if (s_frame->fmt->color == d_frame->fmt->color && s_frame->width == d_frame->width && s_frame->height == d_frame->height) sc->copy_mode = 1; else sc->copy_mode = 0; return 0; } static irqreturn_t fimc_isr(int irq, void *priv) { struct fimc_vid_buffer *src_buf, *dst_buf; struct fimc_dev *fimc = (struct fimc_dev *)priv; struct fimc_ctx *ctx; BUG_ON(!fimc); fimc_hw_clear_irq(fimc); spin_lock(&fimc->slock); if (test_and_clear_bit(ST_M2M_PEND, &fimc->state)) { ctx = v4l2_m2m_get_curr_priv(fimc->m2m.m2m_dev); if (!ctx || !ctx->m2m_ctx) goto isr_unlock; src_buf = v4l2_m2m_src_buf_remove(ctx->m2m_ctx); dst_buf = v4l2_m2m_dst_buf_remove(ctx->m2m_ctx); if (src_buf && dst_buf) { spin_lock(&fimc->irqlock); src_buf->vb.state = dst_buf->vb.state = VIDEOBUF_DONE; wake_up(&src_buf->vb.done); wake_up(&dst_buf->vb.done); spin_unlock(&fimc->irqlock); v4l2_m2m_job_finish(fimc->m2m.m2m_dev, ctx->m2m_ctx); } } isr_unlock: spin_unlock(&fimc->slock); return IRQ_HANDLED; } /* The color format (planes_cnt, buff_cnt) must be already configured. */ static int fimc_prepare_addr(struct fimc_ctx *ctx, struct fimc_vid_buffer *buf, enum v4l2_buf_type type) { struct fimc_frame *frame; struct fimc_addr *paddr; u32 pix_size; int ret = 0; frame = ctx_m2m_get_frame(ctx, type); if (IS_ERR(frame)) return PTR_ERR(frame); paddr = &frame->paddr; if (!buf) return -EINVAL; pix_size = frame->width * frame->height; dbg("buff_cnt= %d, planes_cnt= %d, frame->size= %d, pix_size= %d", frame->fmt->buff_cnt, frame->fmt->planes_cnt, frame->size, pix_size); if (frame->fmt->buff_cnt == 1) { paddr->y = videobuf_to_dma_contig(&buf->vb); switch (frame->fmt->planes_cnt) { case 1: paddr->cb = 0; paddr->cr = 0; break; case 2: /* decompose Y into Y/Cb */ paddr->cb = (u32)(paddr->y + pix_size); paddr->cr = 0; break; case 3: paddr->cb = (u32)(paddr->y + pix_size); /* decompose Y into Y/Cb/Cr */ if (S5P_FIMC_YCBCR420 == frame->fmt->color) paddr->cr = (u32)(paddr->cb + (pix_size >> 2)); else /* 422 */ paddr->cr = (u32)(paddr->cb + (pix_size >> 1)); break; default: return -EINVAL; } } dbg("PHYS_ADDR: type= %d, y= 0x%X cb= 0x%X cr= 0x%X ret= %d", type, paddr->y, paddr->cb, paddr->cr, ret); return ret; } /* Set order for 1 and 2 plane YCBCR 4:2:2 formats. */ static void fimc_set_yuv_order(struct fimc_ctx *ctx) { /* The one only mode supported in SoC. */ ctx->in_order_2p = S