[linux-2.6-block.git] / drivers / media / video / soc_mediabus.c

/*
 * 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/soc_mediabus.h>

#define MBUS_IDX(f) (V4L2_MBUS_FMT_ ## f - V4L2_MBUS_FMT_FIXED - 1)

static const struct soc_mbus_pixelfmt mbus_fmt[] = {
	[MBUS_IDX(YUYV8_2X8)] = {
		.fourcc			= V4L2_PIX_FMT_YUYV,
		.name			= "YUYV",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(YVYU8_2X8)] = {
		.fourcc			= V4L2_PIX_FMT_YVYU,
		.name			= "YVYU",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(UYVY8_2X8)] = {
		.fourcc			= V4L2_PIX_FMT_UYVY,
		.name			= "UYVY",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(VYUY8_2X8)] = {
		.fourcc			= V4L2_PIX_FMT_VYUY,
		.name			= "VYUY",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(RGB555_2X8_PADHI_LE)] = {
		.fourcc			= V4L2_PIX_FMT_RGB555,
		.name			= "RGB555",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(RGB555_2X8_PADHI_BE)] = {
		.fourcc			= V4L2_PIX_FMT_RGB555X,
		.name			= "RGB555X",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(RGB565_2X8_LE)] = {
		.fourcc			= V4L2_PIX_FMT_RGB565,
		.name			= "RGB565",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(RGB565_2X8_BE)] = {
		.fourcc			= V4L2_PIX_FMT_RGB565X,
		.name			= "RGB565X",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(SBGGR8_1X8)] = {
		.fourcc			= V4L2_PIX_FMT_SBGGR8,
		.name			= "Bayer 8 BGGR",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_NONE,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(SBGGR10_1X10)] = {
		.fourcc			= V4L2_PIX_FMT_SBGGR10,
		.name			= "Bayer 10 BGGR",
		.bits_per_sample	= 10,
		.packing		= SOC_MBUS_PACKING_EXTEND16,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(Y8_1X8)] = {
		.fourcc			= V4L2_PIX_FMT_GREY,
		.name			= "Grey",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_NONE,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(Y10_1X10)] = {
		.fourcc			= V4L2_PIX_FMT_Y10,
		.name			= "Grey 10bit",
		.bits_per_sample	= 10,
		.packing		= SOC_MBUS_PACKING_EXTEND16,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(SBGGR10_2X8_PADHI_LE)] = {
		.fourcc			= V4L2_PIX_FMT_SBGGR10,
		.name			= "Bayer 10 BGGR",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(SBGGR10_2X8_PADLO_LE)] = {
		.fourcc			= V4L2_PIX_FMT_SBGGR10,
		.name			= "Bayer 10 BGGR",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADLO,
		.order			= SOC_MBUS_ORDER_LE,
	},
	[MBUS_IDX(SBGGR10_2X8_PADHI_BE)] = {
		.fourcc			= V4L2_PIX_FMT_SBGGR10,
		.name			= "Bayer 10 BGGR",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
		.order			= SOC_MBUS_ORDER_BE,
	},
	[MBUS_IDX(SBGGR10_2X8_PADLO_BE)] = {
		.fourcc			= V4L2_PIX_FMT_SBGGR10,
		.name			= "Bayer 10 BGGR",
		.bits_per_sample	= 8,
		.packing		= SOC_MBUS_PACKING_2X8_PADLO,
		.order			= SOC_MBUS_ORDER_BE,
	},
};

int soc_mbus_samples_per_pixel(const struct soc_mbus_pixelfmt *mf)
{
	switch (mf->packing) {
	case SOC_MBUS_PACKING_NONE:
	case SOC_MBUS_PACKING_EXTEND16:
		return 1;
	case SOC_MBUS_PACKING_2X8_PADHI:
	case SOC_MBUS_PACKING_2X8_PADLO:
		return 2;
	}
	return -EINVAL;
}
EXPORT_SYMBOL(soc_mbus_samples_per_pixel);

s32 soc_mbus_bytes_per_line(u32 width, const struct soc_mbus_pixelfmt *mf)
{
	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;
	}
	return -EINVAL;
}
EXPORT_SYMBOL(soc_mbus_bytes_per_line);

const struct soc_mbus_pixelfmt *soc_mbus_get_fmtdesc(
	enum v4l2_mbus_pixelcode code)
{
	if (code - V4L2_MBUS_FMT_FIXED > ARRAY_SIZE(mbus_fmt) ||
	    code <= V4L2_MBUS_FMT_FIXED)
		return NULL;
	return mbus_fmt + code - V4L2_MBUS_FMT_FIXED - 1;
}
EXPORT_SYMBOL(soc_mbus_get_fmtdesc);

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");
Commit	Line	Data
9a74251d GL	1	/*
	2	* soc-camera media bus helper routines
	3	*
	4	* Copyright (C) 2009, Guennadi Liakhovetski <g.liakhovetski@gmx.de>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* published by the Free Software Foundation.
	9	*/
	10
	11	#include <linux/kernel.h>
	12	#include <linux/module.h>
	13
	14	#include <media/v4l2-device.h>
	15	#include <media/v4l2-mediabus.h>
	16	#include <media/soc_mediabus.h>
	17
	18	#define MBUS_IDX(f) (V4L2_MBUS_FMT_ ## f - V4L2_MBUS_FMT_FIXED - 1)
	19
	20	static const struct soc_mbus_pixelfmt mbus_fmt[] = {
ace6e979	21	[MBUS_IDX(YUYV8_2X8)] = {
9a74251d GL	22	.fourcc = V4L2_PIX_FMT_YUYV,
	23	.name = "YUYV",
	24	.bits_per_sample = 8,
	25	.packing = SOC_MBUS_PACKING_2X8_PADHI,
	26	.order = SOC_MBUS_ORDER_LE,
81355e40	27	},
ace6e979	28	[MBUS_IDX(YVYU8_2X8)] = {
9a74251d GL	29	.fourcc = V4L2_PIX_FMT_YVYU,
	30	.name = "YVYU",
	31	.bits_per_sample = 8,
	32	.packing = SOC_MBUS_PACKING_2X8_PADHI,
	33	.order = SOC_MBUS_ORDER_LE,
81355e40	34	},
ace6e979	35	[MBUS_IDX(UYVY8_2X8)] = {
9a74251d GL	36	.fourcc = V4L2_PIX_FMT_UYVY,
	37	.name = "UYVY",
	38	.bits_per_sample = 8,
	39	.packing = SOC_MBUS_PACKING_2X8_PADHI,
	40	.order = SOC_MBUS_ORDER_LE,
81355e40	41	},
ace6e979	42	[MBUS_IDX(VYUY8_2X8)] = {
9a74251d GL	43	.fourcc = V4L2_PIX_FMT_VYUY,
	44	.name = "VYUY",
	45	.bits_per_sample = 8,
	46	.packing = SOC_MBUS_PACKING_2X8_PADHI,
	47	.order = SOC_MBUS_ORDER_LE,
81355e40 GL	48	},
81355e40 GL	49	[MBUS_IDX(RGB555_2X8_PADHI_LE)] = {
9a74251d GL	50	.fourcc = V4L2_PIX_FMT_RGB555,
	51	.name = "RGB555",
	52	.bits_per_sample = 8,
	53	.packing = SOC_MBUS_PACKING_2X8_PADHI,
	54	.order = SOC_MBUS_ORDER_LE,
81355e40 GL	55	},
81355e40 GL	56	[MBUS_IDX(RGB555_2X8_PADHI_BE)] = {
9a74251d GL	57	.fourcc = V4L2_PIX_FMT_RGB555X,
	58	.name = "RGB555X",
	59	.bits_per_sample = 8,
	60	.packing = SOC_MBUS_PACKING_2X8_PADHI,
	61	.order = SOC_MBUS_ORDER_LE,
81355e40 GL	62	},
81355e40 GL	63	[MBUS_IDX(RGB565_2X8_LE)] = {
9a74251d GL	64	.fourcc = V4L2_PIX_FMT_RGB565,
	65	.name = "RGB565",
	66	.bits_per_sample = 8,
	67	.packing = SOC_MBUS_PACKING_2X8_PADHI,
	68	.order = SOC_MBUS_ORDER_LE,
81355e40 GL	69	},
81355e40 GL	70	[MBUS_IDX(RGB565_2X8_BE)] = {
9a74251d GL	71	.fourcc = V4L2_PIX_FMT_RGB565X,
	72	.name = "RGB565X",
	73	.bits_per_sample = 8,
	74	.packing = SOC_MBUS_PACKING_2X8_PADHI,
	75	.order = SOC_MBUS_ORDER_LE,
81355e40 GL	76	},
81355e40 GL	77	[MBUS_IDX(SBGGR8_1X8)] = {
9a74251d GL	78	.fourcc = V4L2_PIX_FMT_SBGGR8,
	79	.name = "Bayer 8 BGGR",
	80	.bits_per_sample = 8,
	81	.packing = SOC_MBUS_PACKING_NONE,
	82	.order = SOC_MBUS_ORDER_LE,
81355e40 GL	83	},
81355e40 GL	84	[MBUS_IDX(SBGGR10_1X10)] = {
9a74251d GL	85	.fourcc = V4L2_PIX_FMT_SBGGR10,
	86	.name = "Bayer 10 BGGR",
	87	.bits_per_sample = 10,
	88	.packing = SOC_MBUS_PACKING_EXTEND16,
	89	.order = SOC_MBUS_ORDER_LE,
81355e40	90	},
07670433	91	[MBUS_IDX(Y8_1X8)] = {
9a74251d GL	92	.fourcc = V4L2_PIX_FMT_GREY,
	93	.name = "Grey",
	94	.bits_per_sample = 8,
	95	.packing = SOC_MBUS_PACKING_NONE,
	96	.order = SOC_MBUS_ORDER_LE,
81355e40 GL	97	},
81355e40 GL	98	[MBUS_IDX(Y10_1X10)] = {
9a74251d GL	99	.fourcc = V4L2_PIX_FMT_Y10,
	100	.name = "Grey 10bit",
	101	.bits_per_sample = 10,
	102	.packing = SOC_MBUS_PACKING_EXTEND16,
	103	.order = SOC_MBUS_ORDER_LE,
81355e40 GL	104	},
81355e40 GL	105	[MBUS_IDX(SBGGR10_2X8_PADHI_LE)] = {
9a74251d GL	106	.fourcc = V4L2_PIX_FMT_SBGGR10,
	107	.name = "Bayer 10 BGGR",
	108	.bits_per_sample = 8,
	109	.packing = SOC_MBUS_PACKING_2X8_PADHI,
	110	.order = SOC_MBUS_ORDER_LE,
81355e40 GL	111	},
81355e40 GL	112	[MBUS_IDX(SBGGR10_2X8_PADLO_LE)] = {
9a74251d GL	113	.fourcc = V4L2_PIX_FMT_SBGGR10,
	114	.name = "Bayer 10 BGGR",
	115	.bits_per_sample = 8,
	116	.packing = SOC_MBUS_PACKING_2X8_PADLO,
	117	.order = SOC_MBUS_ORDER_LE,
81355e40 GL	118	},
81355e40 GL	119	[MBUS_IDX(SBGGR10_2X8_PADHI_BE)] = {
9a74251d GL	120	.fourcc = V4L2_PIX_FMT_SBGGR10,
	121	.name = "Bayer 10 BGGR",
	122	.bits_per_sample = 8,
	123	.packing = SOC_MBUS_PACKING_2X8_PADHI,
	124	.order = SOC_MBUS_ORDER_BE,
81355e40 GL	125	},
81355e40 GL	126	[MBUS_IDX(SBGGR10_2X8_PADLO_BE)] = {
9a74251d GL	127	.fourcc = V4L2_PIX_FMT_SBGGR10,
	128	.name = "Bayer 10 BGGR",
	129	.bits_per_sample = 8,
	130	.packing = SOC_MBUS_PACKING_2X8_PADLO,
	131	.order = SOC_MBUS_ORDER_BE,
	132	},
	133	};
	134
48a3c773 AP	135	int soc_mbus_samples_per_pixel(const struct soc_mbus_pixelfmt *mf)
	136	{
	137	switch (mf->packing) {
	138	case SOC_MBUS_PACKING_NONE:
	139	case SOC_MBUS_PACKING_EXTEND16:
	140	return 1;
	141	case SOC_MBUS_PACKING_2X8_PADHI:
	142	case SOC_MBUS_PACKING_2X8_PADLO:
	143	return 2;
	144	}
	145	return -EINVAL;
	146	}
	147	EXPORT_SYMBOL(soc_mbus_samples_per_pixel);
	148
9a74251d GL	149	s32 soc_mbus_bytes_per_line(u32 width, const struct soc_mbus_pixelfmt *mf)
	150	{
	151	switch (mf->packing) {
	152	case SOC_MBUS_PACKING_NONE:
	153	return width * mf->bits_per_sample / 8;
	154	case SOC_MBUS_PACKING_2X8_PADHI:
	155	case SOC_MBUS_PACKING_2X8_PADLO:
	156	case SOC_MBUS_PACKING_EXTEND16:
	157	return width * 2;
	158	}
	159	return -EINVAL;
	160	}
	161	EXPORT_SYMBOL(soc_mbus_bytes_per_line);
	162
	163	const struct soc_mbus_pixelfmt *soc_mbus_get_fmtdesc(
	164	enum v4l2_mbus_pixelcode code)
	165	{
84f3751d BS	166	if (code - V4L2_MBUS_FMT_FIXED > ARRAY_SIZE(mbus_fmt) \|\|
84f3751d BS	167	code <= V4L2_MBUS_FMT_FIXED)
9a74251d GL	168	return NULL;
	169	return mbus_fmt + code - V4L2_MBUS_FMT_FIXED - 1;
	170	}
	171	EXPORT_SYMBOL(soc_mbus_get_fmtdesc);
	172
	173	static int __init soc_mbus_init(void)
	174	{
	175	return 0;
	176	}
	177
	178	static void __exit soc_mbus_exit(void)
	179	{
	180	}
	181
	182	module_init(soc_mbus_init);
	183	module_exit(soc_mbus_exit);
	184
	185	MODULE_DESCRIPTION("soc-camera media bus interface");
	186	MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@gmx.de>");
	187	MODULE_LICENSE("GPL v2");