Re: [RFC/PATCH] v4l: Add S5P MIPI-CSI2 interface subdev driver

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



On Thursday, December 23, 2010 20:26:15 Sylwester Nawrocki wrote:
> Add the v4l2 subdev/platform device driver for S5P SoC MIPI-CSI2
> slave devices.
> 
> Signed-off-by: Sylwester Nawrocki <s.nawrocki@xxxxxxxxxxx>
> Signed-off-by: Kyungmin Park <kyungmin.park@xxxxxxxxxxx>
> 
> ---
> 
> Hello,
> 
> this patch adds a v4l2 subdev/platform device driver for S5P SoC MIPI-CSI2
> slave devices.On S5PVXXX SoC there might be up two MIPI-CSI channels.
> This driver creates for each channel a subdev instance which is intended
> to interwork with the s5pc-fimc host driver. I am going to post 
> the patches for the s5p fimc driver in near future so it can be seen how 
> the subdevs are used.
> We are looking forward to use the media controller framework
> with S5P SoC for camera devices control, since the SoC architecture
> is relatively complex and flexible in configuration.
> There are up to 4 camera host interfaces with scaler, rotator
> and color format converter, up to 2 MIPI-CSI2 interfaces and
> there are also available datapaths to and from up to 2 LCD controllers.
> 
> Regards,
> --
> Sylwester Nawrocki
> Samsung Poland R&D Center
> 
> ---
>  drivers/media/video/Kconfig         |    8 +
>  drivers/media/video/Makefile        |    1 +
>  drivers/media/video/s5p-mipi_csis.c |  592 +++++++++++++++++++++++++++++++++++
>  3 files changed, 601 insertions(+), 0 deletions(-)
>  create mode 100644 drivers/media/video/s5p-mipi_csis.c
> 
> diff --git a/drivers/media/video/Kconfig b/drivers/media/video/Kconfig
> index da08267..04441aa 100644
> --- a/drivers/media/video/Kconfig
> +++ b/drivers/media/video/Kconfig
> @@ -732,6 +732,13 @@ config VIDEO_VIA_CAMERA
>  	   Chrome9 chipsets.  Currently only tested on OLPC xo-1.5 systems
>  	   with ov7670 sensors.
>  
> +config VIDEO_S5P_MIPI_CSIS
> +	bool "S5P MIPI-CSI2 slave iterface support"

Typo: 'interface'

> +	depends on VIDEO_V4L2
> +	---help---
> +	  This is video4linux driver for MIPI CSI2 interfaces
> +	  in Samsung S5P SoCs.
> +
>  config SOC_CAMERA
>  	tristate "SoC camera support"
>  	depends on VIDEO_V4L2 && HAS_DMA && I2C
> @@ -1000,6 +1007,7 @@ config  VIDEO_SAMSUNG_S5P_FIMC
>  	depends on VIDEO_DEV && VIDEO_V4L2 && PLAT_S5P
>  	select VIDEOBUF_DMA_CONTIG
>  	select V4L2_MEM2MEM_DEV
> +	select VIDEO_SAMSUNG_MIPI_CSIS
>  	help
>  	  This is a v4l2 driver for the S5P camera interface
>  	  (video postprocessor)
> diff --git a/drivers/media/video/Makefile b/drivers/media/video/Makefile
> index 482f14b..8cc093f 100644
> --- a/drivers/media/video/Makefile
> +++ b/drivers/media/video/Makefile
> @@ -164,6 +164,7 @@ obj-$(CONFIG_VIDEO_PXA27x)		+= pxa_camera.o
>  obj-$(CONFIG_VIDEO_SH_MOBILE_CSI2)	+= sh_mobile_csi2.o
>  obj-$(CONFIG_VIDEO_SH_MOBILE_CEU)	+= sh_mobile_ceu_camera.o
>  obj-$(CONFIG_VIDEO_OMAP1)		+= omap1_camera.o
> +obj-$(CONFIG_VIDEO_S5P_MIPI_CSIS)	+= s5p-mipi_csis.o
>  obj-$(CONFIG_VIDEO_SAMSUNG_S5P_FIMC) 	+= s5p-fimc/
>  
>  obj-$(CONFIG_ARCH_DAVINCI)		+= davinci/
> diff --git a/drivers/media/video/s5p-mipi_csis.c b/drivers/media/video/s5p-mipi_csis.c
> new file mode 100644
> index 0000000..823f49f
> --- /dev/null
> +++ b/drivers/media/video/s5p-mipi_csis.c
> @@ -0,0 +1,592 @@
> +/*
> + * Samsung S5P SoC series MIPI-CSI2 slave interface driver
> + *
> + * Copyright (c) 2010 Samsung Electronics Co., Ltd
> + * Contact: Sylwester Nawrocki, <s.nawrocki@xxxxxxxxxxx>
> + *
> + * 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/module.h>
> +#include <linux/kernel.h>
> +#include <linux/errno.h>
> +#include <linux/clk.h>
> +#include <linux/irq.h>
> +#include <linux/interrupt.h>
> +#include <linux/device.h>
> +#include <linux/platform_device.h>
> +#include <linux/slab.h>
> +#include <linux/io.h>
> +#include <linux/delay.h>
> +#include <linux/memory.h>
> +#include <linux/regulator/machine.h>
> +#include <linux/regulator/consumer.h>
> +#include <plat/csis.h>
> +
> +#include <linux/videodev2.h>
> +#include <media/v4l2-subdev.h>
> +
> +static int debug;
> +module_param(debug, int, 0644);
> +MODULE_PARM_DESC(debug, "Enable module debug trace. Set to 1 to enable.");
> +
> +#define MODULE_NAME	"s5p-mipi-csis"
> +
> +/* Register map definition */
> +
> +/* CSI global control. */
> +#define S5P_CSIS_CTRL			0x00
> +#define S5P_CSIS_CTRL_DPDN_DEFAULT	(0 << 31)
> +#define S5P_CSIS_CTRL_DPDN_SWAP		(1 << 31)
> +#define S5P_CSIS_CTRL_ALIGN_32BIT	(1 << 20)
> +#define S5P_CSIS_CTRL_UPDATE_SHADOW	(1 << 16)
> +#define S5P_CSIS_CTRL_WCLK_EXTCLK	(1 << 8)
> +#define S5P_CSIS_CTRL_RESET		(1 << 4)
> +#define S5P_CSIS_CTRL_ENABLE		(1 << 0)
> +
> +/* D-PHY control. */
> +#define S5P_CSIS_DPHYCTRL		0x04
> +#define S5P_CSIS_DPHYCTRL_HSS_MASK	(0x1F << 27)
> +#define S5P_CSIS_DPHYCTRL_ENABLE	(0x1F << 0)
> +
> +#define S5P_CSIS_CONFIG			0x08
> +#define S5P_CSIS_CFG_FMT_YCBCR422_8BIT	(0x1E << 2)
> +#define S5P_CSIS_CFG_FMT_RAW8		(0x2A << 2)
> +#define S5P_CSIS_CFG_FMT_RAW10		(0x2B << 2)
> +#define S5P_CSIS_CFG_FMT_RAW12		(0x2C << 2)
> +#define S5P_CSIS_CFG_FMT_USER1		(0x30 << 2)
> +#define S5P_CSIS_CFG_FMT_MASK		(0x3F << 2)
> +#define S5P_CSIS_CFG_NR_LANE_MASK	3
> +
> +/* Interrupt mask. */
> +#define S5P_CSIS_INTMSK			0x10
> +#define S5P_CSIS_INTMSK_EN_ALL		0xF000003F
> +#define S5P_CSIS_INTSRC			0x14
> +
> +/* Pixel resolution. */
> +#define S5P_CSIS_RESOL			0x2C
> +#define CSIS_MAX_PIX_WIDTH		0xFFFF
> +#define CSIS_MAX_PIX_HEIGHT		0xFFFF
> +
> +enum {
> +	CSIS_CLK_BUS,
> +	CSIS_CLK_GATE,
> +};
> +
> +static char *csi_clock_name[] = {
> +	[CSIS_CLK_BUS]  = "sclk_csis",
> +	[CSIS_CLK_GATE] = "csis",
> +};
> +
> +#define NUM_CSIS_CLOCKS	ARRAY_SIZE(csi_clock_name)
> +
> +struct s5p_csis_state {
> +	struct v4l2_subdev sd;
> +	struct v4l2_mbus_framefmt fmt;
> +	struct platform_device *pdev;
> +	struct resource *regs_res;
> +	void __iomem *regs;
> +	int irq;
> +	struct clk *clock[NUM_CSIS_CLOCKS];
> +	struct regulator *supply;
> +};
> +
> +struct s5p_csis_color_format {
> +	enum v4l2_mbus_pixelcode code;
> +	u32 fmt_reg;
> +	u16 pix_hor_align;
> +};
> +
> +static const struct s5p_csis_color_format s5p_csis_formats[] = {
> +	{
> +		.code		= V4L2_MBUS_FMT_VYUY8_2X8,
> +		.fmt_reg	= S5P_CSIS_CFG_FMT_YCBCR422_8BIT,
> +		.pix_hor_align	= 1,
> +	},
> +	/* TODO: Add S5P_CSIS_CFG_FMT_USER1 for JPEG format. */
> +};
> +
> +static struct s5p_csis_state *to_s5p_csis_state(struct v4l2_subdev *sdev)
> +{
> +	return container_of(sdev, struct s5p_csis_state, sd);
> +}
> +
> +
> +static void s5p_csis_enable_interrupts(struct s5p_csis_state *state, int on)
> +{
> +	u32 cfg = readl(state->regs + S5P_CSIS_CTRL);
> +
> +	if (on)
> +		cfg |= S5P_CSIS_INTMSK_EN_ALL;
> +	else
> +		cfg &= ~S5P_CSIS_INTMSK_EN_ALL;
> +	writel(cfg, state->regs + S5P_CSIS_INTMSK);
> +}
> +
> +static void s5p_csis_reset(struct s5p_csis_state *state)
> +{
> +	u32 cfg = readl(state->regs + S5P_CSIS_CTRL);
> +
> +	writel(cfg | S5P_CSIS_CTRL_RESET, state->regs + S5P_CSIS_CTRL);
> +	udelay(10);
> +}
> +
> +static void s5p_csis_system_enable(struct s5p_csis_state *state, int on)
> +{
> +	u32 cfg;
> +
> +	cfg = readl(state->regs + S5P_CSIS_CTRL);
> +	if (on)
> +		cfg |= S5P_CSIS_CTRL_ENABLE;
> +	else
> +		cfg &= ~S5P_CSIS_CTRL_ENABLE;
> +	writel(cfg, state->regs + S5P_CSIS_CTRL);
> +
> +	cfg = readl(state->regs + S5P_CSIS_DPHYCTRL);
> +	if (on)
> +		cfg |= S5P_CSIS_DPHYCTRL_ENABLE;
> +	else
> +		cfg &= ~S5P_CSIS_DPHYCTRL_ENABLE;
> +	writel(cfg, state->regs + S5P_CSIS_DPHYCTRL);
> +
> +	s5p_csis_enable_interrupts(state, on);
> +}
> +
> +
> +static int s5p_csis_set_format(struct s5p_csis_state *state)
> +{
> +	u32 cfg;
> +	int i = ARRAY_SIZE(s5p_csis_formats);
> +
> +	v4l2_dbg(1, debug, &state->sd, "fmt: %d, %d x %d\n",
> +		 state->fmt.code, state->fmt.width, state->fmt.height);
> +
> +	/* Color format */
> +	cfg = readl(state->regs + S5P_CSIS_CONFIG);
> +	cfg &= ~S5P_CSIS_CFG_FMT_MASK;
> +
> +	while (i--)
> +		if (state->fmt.code == s5p_csis_formats[i].code)
> +			break;
> +
> +	if (i >= ARRAY_SIZE(s5p_csis_formats))
> +		return -EINVAL;
> +
> +	writel(cfg | s5p_csis_formats[i].fmt_reg,
> +	       state->regs + S5P_CSIS_CONFIG);
> +
> +	/* Pixel resolution */
> +	cfg = (state->fmt.width << 16) | state->fmt.height;
> +	writel(cfg, state->regs + S5P_CSIS_RESOL);
> +
> +	return 0;
> +}
> +
> +static void s5p_csis_set_hsync_settle(struct s5p_csis_state *state, int settle)
> +{
> +	u32 cfg = readl(state->regs + S5P_CSIS_DPHYCTRL);
> +
> +	cfg &= ~S5P_CSIS_DPHYCTRL_HSS_MASK;
> +	cfg |= (settle << 27);
> +	writel(cfg, state->regs + S5P_CSIS_DPHYCTRL);
> +}
> +
> +static void s5p_csis_set_params(struct s5p_csis_state *state)
> +{
> +	struct s5p_platform_mipi_csis *pdata = state->pdev->dev.platform_data;
> +	u32 cfg, tmp;
> +
> +	/* Number of MIPI lanes used */
> +	cfg = readl(state->regs + S5P_CSIS_CONFIG);
> +	cfg &= ~S5P_CSIS_CFG_NR_LANE_MASK;
> +	tmp = (pdata->lanes - 1) & 0x3;
> +	writel(cfg | tmp, state->regs + S5P_CSIS_CONFIG);
> +
> +	s5p_csis_set_format(state);
> +
> +	s5p_csis_set_hsync_settle(state, pdata->hs_settle);
> +
> +	/* CSI bus data alignment. */
> +	cfg = readl(state->regs + S5P_CSIS_CTRL);
> +
> +	if (pdata->alignment == 32)
> +		cfg |= S5P_CSIS_CTRL_ALIGN_32BIT;
> +	else /* 24-bits */
> +		cfg &= ~S5P_CSIS_CTRL_ALIGN_32BIT;
> +
> +	/* Not using external clock. */
> +	cfg &= ~S5P_CSIS_CTRL_WCLK_EXTCLK;
> +
> +	writel(cfg, state->regs + S5P_CSIS_CTRL);
> +
> +	/* Update the shadow register. */
> +	cfg = readl(state->regs + S5P_CSIS_CTRL);
> +	writel(cfg | S5P_CSIS_CTRL_UPDATE_SHADOW, state->regs + S5P_CSIS_CTRL);
> +}
> +
> +static void s5p_csis_clk_enable(struct s5p_csis_state *state, bool enable)
> +{
> +	int i;
> +
> +	for (i = 0; i < NUM_CSIS_CLOCKS; i++) {
> +		if (!state->clock[i])
> +			continue;
> +		if (enable)
> +			clk_enable(state->clock[i]);
> +		else
> +			clk_disable(state->clock[i]);
> +	}
> +
> +	v4l2_dbg(1, debug, &state->sd, "%s: clocks %sabled\n",
> +		 __func__, enable ? "en" : "dis");
> +}
> +
> +static void s5p_csis_clk_put(struct s5p_csis_state *state)
> +{
> +	int i = NUM_CSIS_CLOCKS - 1;
> +
> +	while (i-- >= 0) {
> +		if (!state->clock[i])
> +			continue;
> +		clk_disable(state->clock[i]);
> +		clk_put(state->clock[i]);
> +	}
> +}
> +
> +static int s5p_csis_clk_get(struct s5p_csis_state *state)
> +{
> +	struct device *dev = &state->pdev->dev;
> +	int i;
> +
> +	for (i = 0; i < NUM_CSIS_CLOCKS; i++) {
> +		state->clock[i] = clk_get(dev, csi_clock_name[i]);
> +
> +		if (IS_ERR(state->clock[i])) {
> +			dev_err(dev, "failed to get clock: %s\n",
> +				csi_clock_name[i]);
> +			return -ENXIO;
> +		}
> +		clk_enable(state->clock[i]);
> +	}
> +	return 0;
> +}
> +
> +static int mipi_csis_power(struct v4l2_subdev *sd, int on)
> +{
> +	struct s5p_csis_state *state = to_s5p_csis_state(sd);
> +	struct s5p_platform_mipi_csis *pdata = state->pdev->dev.platform_data;
> +	int ret;
> +
> +	if (on) {
> +		ret = regulator_enable(state->supply);
> +		if (pdata->phy_enable)
> +			ret = pdata->phy_enable(state->pdev, true);
> +	} else {
> +		if (pdata->phy_enable) {
> +			ret = pdata->phy_enable(state->pdev, false);
> +			if (ret)
> +				return ret;
> +		}
> +		ret = regulator_disable(state->supply);
> +	}
> +
> +	if (!ret)
> +		v4l2_dbg(1, debug, sd, "%s: regulator is %s\n",
> +			 __func__, on ? "on" : "off");
> +	return ret;
> +}
> +
> +static int s5p_csis_s_power(struct v4l2_subdev *sd, int on)
> +{
> +	struct s5p_csis_state *state = to_s5p_csis_state(sd);
> +	int ret;
> +
> +	v4l2_dbg(1, debug, sd, "%s: on= %d\n",  __func__, on);
> +
> +	if (on) {
> +		ret = mipi_csis_power(sd, on);
> +		if (ret)
> +			return ret;
> +		s5p_csis_clk_enable(state, on);
> +		s5p_csis_reset(state);
> +	} else {
> +		s5p_csis_enable_interrupts(state, false);
> +		s5p_csis_system_enable(state, false);
> +		s5p_csis_clk_enable(state, false);
> +		ret = mipi_csis_power(sd, on);
> +	}
> +
> +	return ret;
> +}
> +
> +static inline struct s5p_csis_color_format const *find_csis_format(
> +	struct v4l2_mbus_framefmt *mf)
> +{
> +	int i = ARRAY_SIZE(s5p_csis_formats);
> +
> +	while (i--)
> +		if (mf->code == s5p_csis_formats[i].code)
> +			break;
> +
> +	if (i >= ARRAY_SIZE(s5p_csis_formats))
> +		return NULL;
> +
> +	return &s5p_csis_formats[i];
> +}
> +
> +static int s5p_csis_try_fmt(struct v4l2_subdev *sd,
> +			    struct v4l2_mbus_framefmt *mf)
> +{
> +	struct s5p_csis_color_format const *csis_fmt;
> +
> +	if (!sd || !mf)
> +		return -EINVAL;
> +
> +	csis_fmt = find_csis_format(mf);
> +
> +	if (csis_fmt == NULL)
> +		csis_fmt = &s5p_csis_formats[0];
> +
> +	mf->code = csis_fmt->code;
> +
> +	/* Adjust pixel size if required so it fits in the supported range
> +	   and meets the aligment requirements. */
> +	v4l_bound_align_image(&mf->width, 1, CSIS_MAX_PIX_WIDTH,
> +			      csis_fmt->pix_hor_align,
> +			      &mf->height, 1, CSIS_MAX_PIX_HEIGHT, 1,
> +			      0);
> +	return 0;
> +}
> +
> +static int s5p_csis_s_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *mf)
> +{
> +	struct s5p_csis_state *state = to_s5p_csis_state(sd);
> +	struct s5p_csis_color_format const *csis_fmt = find_csis_format(mf);
> +
> +	v4l2_dbg(1, debug, sd, "%s: w: %d, h: %d\n", __func__,
> +		 mf->width, mf->height);
> +
> +	if (csis_fmt == NULL ||
> +	   mf->width > CSIS_MAX_PIX_WIDTH  ||
> +	   mf->height > CSIS_MAX_PIX_WIDTH ||
> +	   mf->width & (u32)(csis_fmt->pix_hor_align - 1))
> +		return -EINVAL;
> +
> +	state->fmt = *mf;
> +
> +	return 0;
> +}
> +
> +static int s5p_csis_g_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *mf)
> +{
> +	struct s5p_csis_state *state = to_s5p_csis_state(sd);
> +
> +	*mf = state->fmt;
> +	return 0;
> +}
> +
> +static int s5p_csis_s_stream(struct v4l2_subdev *sd, int enable)
> +{
> +	struct s5p_csis_state *state = to_s5p_csis_state(sd);
> +
> +	v4l2_dbg(1, debug, sd, "%s: arg: %d\n", __func__, enable);
> +
> +	if (enable) {
> +		s5p_csis_clk_enable(state, enable);
> +		s5p_csis_reset(state);
> +		s5p_csis_set_params(state);
> +		s5p_csis_system_enable(state, enable);
> +	} else {
> +		s5p_csis_enable_interrupts(state, enable);
> +		s5p_csis_system_enable(state, enable);
> +		s5p_csis_clk_enable(state, enable);
> +	}
> +
> +	return 0;
> +}
> +
> +static struct v4l2_subdev_core_ops s5p_csis_core_ops = {
> +	.s_power = s5p_csis_s_power,
> +};
> +
> +static struct v4l2_subdev_video_ops s5p_csis_video_ops = {
> +	.try_mbus_fmt	= s5p_csis_try_fmt,
> +	.g_mbus_fmt	= s5p_csis_g_fmt,
> +	.s_mbus_fmt	= s5p_csis_s_fmt,
> +	.s_stream	= s5p_csis_s_stream,
> +};
> +
> +static struct v4l2_subdev_ops s5p_csis_subdev_ops = {
> +	.core	= &s5p_csis_core_ops,
> +	.video	= &s5p_csis_video_ops,
> +};
> +
> +static irqreturn_t s5p_csis_isr(int irq, void *dev_id)
> +{
> +	struct s5p_csis_state *state = dev_id;
> +	u32 cfg;
> +
> +	/* Just clear the interrupt pending bits. */
> +	cfg = readl(state->regs + S5P_CSIS_INTSRC);
> +	writel(cfg, state->regs + S5P_CSIS_INTSRC);
> +
> +	return IRQ_HANDLED;
> +}
> +
> +static int s5p_csis_probe(struct platform_device *pdev)
> +{
> +	struct s5p_platform_mipi_csis *pdata;
> +	struct resource *mem_res;
> +	struct resource *regs_res;
> +	struct s5p_csis_state *state;
> +	int ret = -ENODEV;
> +
> +	state = kzalloc(sizeof(*state), GFP_KERNEL);
> +	if (!state)
> +		return -ENOMEM;
> +
> +	state->pdev = pdev;
> +	state->irq  = -ENXIO;

Huh?

> +
> +	pdata = pdev->dev.platform_data;
> +	if (!pdata) {
> +		dev_err(&pdev->dev, "Platform data not set\n");
> +		goto p_err1;
> +	}
> +
> +	mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> +	if (!mem_res) {
> +		dev_err(&pdev->dev, "Failed to get io memory region\n");
> +		goto p_err1;
> +	}
> +
> +	regs_res = request_mem_region(mem_res->start,
> +			mem_res->end - mem_res->start + 1, pdev->name);
> +	if (!regs_res) {
> +		dev_err(&pdev->dev, "Failed to request io memory region\n");
> +		goto p_err1;
> +	}
> +	state->regs_res = regs_res;
> +
> +	state->regs = ioremap(mem_res->start,
> +			      mem_res->end - mem_res->start + 1);
> +	if (!state->regs) {
> +		dev_err(&pdev->dev, "Failed to remap io region\n");
> +		goto p_err2;
> +	}
> +
> +	if (s5p_csis_clk_get(state))
> +		goto p_err3;
> +
> +	if (pdata->clk_rate)
> +		clk_set_rate(state->clock[CSIS_CLK_BUS], pdata->clk_rate);
> +
> +	if (pdata->phy_enable)
> +		pdata->phy_enable(state->pdev, false);
> +
> +	state->irq = platform_get_irq(pdev, 0);
> +	if (state->irq < 0) {
> +		dev_err(&pdev->dev, "failed to get irq\n");

Missing: ret = state->irq;

> +		goto p_err4;
> +	}
> +
> +	ret = request_irq(state->irq, s5p_csis_isr, 0, MODULE_NAME, state);
> +	if (ret) {
> +		dev_err(&pdev->dev, "request_irq failed\n");
> +		goto p_err4;
> +	}
> +
> +	state->supply = regulator_get(&pdev->dev, "mipi_csi");
> +	if (IS_ERR(state->supply)) {
> +		state->supply = NULL;

Shouldn't there be a 'ret = PTR_ERR(state->supply)' here?

> +		goto p_err5;
> +	}
> +
> +	v4l2_subdev_init(&state->sd, &s5p_csis_subdev_ops);
> +	state->sd.owner = THIS_MODULE;
> +	strcpy(state->sd.name, MODULE_NAME);
> +
> +
> +	/* This allows to retrieve the platform device id by the host driver */
> +	v4l2_set_subdevdata(&state->sd, pdev);
> +
> +	/* .. and a pointer to the subdev. */
> +	platform_set_drvdata(pdev, &state->sd);
> +
> +	return 0;
> +
> +p_err5:
> +	free_irq(state->irq, state);
> +p_err4:
> +	s5p_csis_clk_put(state);
> +p_err3:
> +	iounmap(state->regs);
> +p_err2:
> +	release_mem_region(regs_res->start,
> +			   regs_res->end - regs_res->start + 1);
> +p_err1:
> +	kfree(state);
> +	return ret;
> +}
> +
> +static int s5p_csis_remove(struct platform_device *pdev)
> +{
> +	struct v4l2_subdev *sd = platform_get_drvdata(pdev);
> +	struct s5p_csis_state *state = to_s5p_csis_state(sd);
> +	struct resource *res = state->regs_res;
> +
> +	s5p_csis_clk_put(state);
> +	s5p_csis_s_power(&state->sd, 0);
> +
> +	free_irq(state->irq, state);
> +	iounmap(state->regs);
> +	release_mem_region(res->start, res->end - res->start + 1);
> +	kfree(state);
> +	return 0;
> +}
> +
> +static int s5p_csis_suspend(struct platform_device *pdev, pm_message_t msg)
> +{
> +	struct v4l2_subdev *sd = platform_get_drvdata(pdev);
> +
> +	s5p_csis_clk_enable(to_s5p_csis_state(sd), false);
> +	return 0;
> +}
> +
> +static int s5p_csis_resume(struct platform_device *pdev)
> +{
> +	struct v4l2_subdev *sd = platform_get_drvdata(pdev);
> +
> +	s5p_csis_clk_enable(to_s5p_csis_state(sd), true);
> +	return 0;
> +}
> +
> +static struct platform_driver s5p_csis_driver = {
> +	.probe		= s5p_csis_probe,
> +	.remove		= s5p_csis_remove,
> +	.suspend	= s5p_csis_suspend,
> +	.resume		= s5p_csis_resume,
> +	.driver		= {
> +		.name	= MODULE_NAME,
> +		.owner	= THIS_MODULE,
> +	},
> +};
> +
> +static int __init s5p_csis_register(void)
> +{
> +	return platform_driver_register(&s5p_csis_driver);
> +}
> +
> +static void __exit s5p_csis_unregister(void)
> +{
> +	platform_driver_unregister(&s5p_csis_driver);
> +}
> +
> +module_init(s5p_csis_register);
> +module_exit(s5p_csis_unregister);
> +
> +MODULE_AUTHOR("Sylwester Nawrocki, <s.nawrocki@xxxxxxxxxxx>");
> +MODULE_DESCRIPTION("S5P MIPI-CSI2 slave interface driver");
> +MODULE_LICENSE("GPL");
> 

Looks good otherwise.

Regards,

	Hans

-- 
Hans Verkuil - video4linux developer - sponsored by Cisco
--
To unsubscribe from this list: send the line "unsubscribe linux-samsung-soc" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html


[Index of Archives]     [Linux SoC Development]     [Linux Rockchip Development]     [Linux USB Development]     [Video for Linux]     [Linux Audio Users]     [Linux SCSI]     [Yosemite News]

  Powered by Linux