| /* |
| * soc-camera media bus helper routines |
| * |
| * Copyright (C) 2009, Guennadi Liakhovetski <g.liakhovetski@gmx.de> |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| |
| #include <media/v4l2-device.h> |
| #include <media/v4l2-mediabus.h> |
| #include <media/drv-intf/soc_mediabus.h> |
| |
| static const struct soc_mbus_lookup mbus_fmt[] = { |
| { |
| .code = MEDIA_BUS_FMT_YUYV8_2X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_YUYV, |
| .name = "YUYV", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_YVYU8_2X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_YVYU, |
| .name = "YVYU", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_UYVY8_2X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_UYVY, |
| .name = "UYVY", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_VYUY8_2X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_VYUY, |
| .name = "VYUY", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_RGB555_2X8_PADHI_LE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_RGB555, |
| .name = "RGB555", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_RGB555_2X8_PADHI_BE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_RGB555X, |
| .name = "RGB555X", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_BE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_RGB565_2X8_LE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_RGB565, |
| .name = "RGB565", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_RGB565_2X8_BE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_RGB565X, |
| .name = "RGB565X", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_BE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_RGB666_1X18, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_RGB32, |
| .name = "RGB666/32bpp", |
| .bits_per_sample = 18, |
| .packing = SOC_MBUS_PACKING_EXTEND32, |
| .order = SOC_MBUS_ORDER_LE, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_RGB888_1X24, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_RGB32, |
| .name = "RGB888/32bpp", |
| .bits_per_sample = 24, |
| .packing = SOC_MBUS_PACKING_EXTEND32, |
| .order = SOC_MBUS_ORDER_LE, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_RGB888_2X12_BE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_RGB32, |
| .name = "RGB888/32bpp", |
| .bits_per_sample = 12, |
| .packing = SOC_MBUS_PACKING_EXTEND32, |
| .order = SOC_MBUS_ORDER_BE, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_RGB888_2X12_LE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_RGB32, |
| .name = "RGB888/32bpp", |
| .bits_per_sample = 12, |
| .packing = SOC_MBUS_PACKING_EXTEND32, |
| .order = SOC_MBUS_ORDER_LE, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SBGGR8_1X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SBGGR8, |
| .name = "Bayer 8 BGGR", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_NONE, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SBGGR10_1X10, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SBGGR10, |
| .name = "Bayer 10 BGGR", |
| .bits_per_sample = 10, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_Y8_1X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_GREY, |
| .name = "Grey", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_NONE, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_Y10_1X10, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_Y10, |
| .name = "Grey 10bit", |
| .bits_per_sample = 10, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_LE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SBGGR10, |
| .name = "Bayer 10 BGGR", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SBGGR10_2X8_PADLO_LE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SBGGR10, |
| .name = "Bayer 10 BGGR", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADLO, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_BE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SBGGR10, |
| .name = "Bayer 10 BGGR", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_BE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SBGGR10_2X8_PADLO_BE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SBGGR10, |
| .name = "Bayer 10 BGGR", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADLO, |
| .order = SOC_MBUS_ORDER_BE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_JPEG_1X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_JPEG, |
| .name = "JPEG", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_VARIABLE, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_RGB444_2X8_PADHI_BE, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_RGB444, |
| .name = "RGB444", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_2X8_PADHI, |
| .order = SOC_MBUS_ORDER_BE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_YUYV8_1_5X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_YUV420, |
| .name = "YUYV 4:2:0", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_1_5X8, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_YVYU8_1_5X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_YVU420, |
| .name = "YVYU 4:2:0", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_1_5X8, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_UYVY8_1X16, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_UYVY, |
| .name = "UYVY 16bit", |
| .bits_per_sample = 16, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_VYUY8_1X16, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_VYUY, |
| .name = "VYUY 16bit", |
| .bits_per_sample = 16, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_YUYV8_1X16, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_YUYV, |
| .name = "YUYV 16bit", |
| .bits_per_sample = 16, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_YVYU8_1X16, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_YVYU, |
| .name = "YVYU 16bit", |
| .bits_per_sample = 16, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SGRBG8_1X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SGRBG8, |
| .name = "Bayer 8 GRBG", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_NONE, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SGRBG10_DPCM8_1X8, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SGRBG10DPCM8, |
| .name = "Bayer 10 BGGR DPCM 8", |
| .bits_per_sample = 8, |
| .packing = SOC_MBUS_PACKING_NONE, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SGBRG10_1X10, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SGBRG10, |
| .name = "Bayer 10 GBRG", |
| .bits_per_sample = 10, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SGRBG10_1X10, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SGRBG10, |
| .name = "Bayer 10 GRBG", |
| .bits_per_sample = 10, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SRGGB10_1X10, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SRGGB10, |
| .name = "Bayer 10 RGGB", |
| .bits_per_sample = 10, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SBGGR12_1X12, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SBGGR12, |
| .name = "Bayer 12 BGGR", |
| .bits_per_sample = 12, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SGBRG12_1X12, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SGBRG12, |
| .name = "Bayer 12 GBRG", |
| .bits_per_sample = 12, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SGRBG12_1X12, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SGRBG12, |
| .name = "Bayer 12 GRBG", |
| .bits_per_sample = 12, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, { |
| .code = MEDIA_BUS_FMT_SRGGB12_1X12, |
| .fmt = { |
| .fourcc = V4L2_PIX_FMT_SRGGB12, |
| .name = "Bayer 12 RGGB", |
| .bits_per_sample = 12, |
| .packing = SOC_MBUS_PACKING_EXTEND16, |
| .order = SOC_MBUS_ORDER_LE, |
| .layout = SOC_MBUS_LAYOUT_PACKED, |
| }, |
| }, |
| }; |
| |
| int soc_mbus_samples_per_pixel(const struct soc_mbus_pixelfmt *mf, |
| unsigned int *numerator, unsigned int *denominator) |
| { |
| switch (mf->packing) { |
| case SOC_MBUS_PACKING_NONE: |
| case SOC_MBUS_PACKING_EXTEND16: |
| *numerator = 1; |
| *denominator = 1; |
| return 0; |
| case SOC_MBUS_PACKING_EXTEND32: |
| *numerator = 1; |
| *denominator = 1; |
| return 0; |
| case SOC_MBUS_PACKING_2X8_PADHI: |
| case SOC_MBUS_PACKING_2X8_PADLO: |
| *numerator = 2; |
| *denominator = 1; |
| return 0; |
| case SOC_MBUS_PACKING_1_5X8: |
| *numerator = 3; |
| *denominator = 2; |
| return 0; |
| case SOC_MBUS_PACKING_VARIABLE: |
| *numerator = 0; |
| *denominator = 1; |
| return 0; |
| } |
| return -EINVAL; |
| } |
| EXPORT_SYMBOL(soc_mbus_samples_per_pixel); |
| |
| s32 soc_mbus_bytes_per_line(u32 width, const struct soc_mbus_pixelfmt *mf) |
| { |
| if (mf->layout != SOC_MBUS_LAYOUT_PACKED) |
| return width * mf->bits_per_sample / 8; |
| |
| switch (mf->packing) { |
| case SOC_MBUS_PACKING_NONE: |
| return width * mf->bits_per_sample / 8; |
| case SOC_MBUS_PACKING_2X8_PADHI: |
| case SOC_MBUS_PACKING_2X8_PADLO: |
| case SOC_MBUS_PACKING_EXTEND16: |
| return width * 2; |
| case SOC_MBUS_PACKING_1_5X8: |
| return width * 3 / 2; |
| case SOC_MBUS_PACKING_VARIABLE: |
| return 0; |
| case SOC_MBUS_PACKING_EXTEND32: |
| return width * 4; |
| } |
| return -EINVAL; |
| } |
| EXPORT_SYMBOL(soc_mbus_bytes_per_line); |
| |
| s32 soc_mbus_image_size(const struct soc_mbus_pixelfmt *mf, |
| u32 bytes_per_line, u32 height) |
| { |
| if (mf->layout == SOC_MBUS_LAYOUT_PACKED) |
| return bytes_per_line * height; |
| |
| switch (mf->packing) { |
| case SOC_MBUS_PACKING_2X8_PADHI: |
| case SOC_MBUS_PACKING_2X8_PADLO: |
| return bytes_per_line * height * 2; |
| case SOC_MBUS_PACKING_1_5X8: |
| return bytes_per_line * height * 3 / 2; |
| default: |
| return -EINVAL; |
| } |
| } |
| EXPORT_SYMBOL(soc_mbus_image_size); |
| |
| const struct soc_mbus_pixelfmt *soc_mbus_find_fmtdesc( |
| u32 code, |
| const struct soc_mbus_lookup *lookup, |
| int n) |
| { |
| int i; |
| |
| for (i = 0; i < n; i++) |
| if (lookup[i].code == code) |
| return &lookup[i].fmt; |
| |
| return NULL; |
| } |
| EXPORT_SYMBOL(soc_mbus_find_fmtdesc); |
| |
| const struct soc_mbus_pixelfmt *soc_mbus_get_fmtdesc( |
| u32 code) |
| { |
| return soc_mbus_find_fmtdesc(code, mbus_fmt, ARRAY_SIZE(mbus_fmt)); |
| } |
| EXPORT_SYMBOL(soc_mbus_get_fmtdesc); |
| |
| unsigned int soc_mbus_config_compatible(const struct v4l2_mbus_config *cfg, |
| unsigned int flags) |
| { |
| unsigned long common_flags; |
| bool hsync = true, vsync = true, pclk, data, mode; |
| bool mipi_lanes, mipi_clock; |
| |
| common_flags = cfg->flags & flags; |
| |
| switch (cfg->type) { |
| case V4L2_MBUS_PARALLEL: |
| hsync = common_flags & (V4L2_MBUS_HSYNC_ACTIVE_HIGH | |
| V4L2_MBUS_HSYNC_ACTIVE_LOW); |
| vsync = common_flags & (V4L2_MBUS_VSYNC_ACTIVE_HIGH | |
| V4L2_MBUS_VSYNC_ACTIVE_LOW); |
| /* fall through */ |
| case V4L2_MBUS_BT656: |
| pclk = common_flags & (V4L2_MBUS_PCLK_SAMPLE_RISING | |
| V4L2_MBUS_PCLK_SAMPLE_FALLING); |
| data = common_flags & (V4L2_MBUS_DATA_ACTIVE_HIGH | |
| V4L2_MBUS_DATA_ACTIVE_LOW); |
| mode = common_flags & (V4L2_MBUS_MASTER | V4L2_MBUS_SLAVE); |
| return (!hsync || !vsync || !pclk || !data || !mode) ? |
| 0 : common_flags; |
| case V4L2_MBUS_CSI2: |
| mipi_lanes = common_flags & V4L2_MBUS_CSI2_LANES; |
| mipi_clock = common_flags & (V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK | |
| V4L2_MBUS_CSI2_CONTINUOUS_CLOCK); |
| return (!mipi_lanes || !mipi_clock) ? 0 : common_flags; |
| default: |
| WARN_ON(1); |
| return -EINVAL; |
| } |
| return 0; |
| } |
| EXPORT_SYMBOL(soc_mbus_config_compatible); |
| |
| static int __init soc_mbus_init(void) |
| { |
| return 0; |
| } |
| |
| static void __exit soc_mbus_exit(void) |
| { |
| } |
| |
| module_init(soc_mbus_init); |
| module_exit(soc_mbus_exit); |
| |
| MODULE_DESCRIPTION("soc-camera media bus interface"); |
| MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@gmx.de>"); |
| MODULE_LICENSE("GPL v2"); |
