From a74aa4fd537ca07a038e31a102cd00290f163e38 Mon Sep 17 00:00:00 2001 From: Even Xu Date: Fri, 4 Nov 2011 13:54:22 +0800 Subject: ENGR00161382-3 MX6Q MIPI CSI2: Add MIPI CSI2 driver Add MIPI CSI2 driver Signed-off-by: Even Xu --- drivers/mxc/Kconfig | 1 + drivers/mxc/Makefile | 1 + drivers/mxc/mipi/Kconfig | 13 ++ drivers/mxc/mipi/Makefile | 4 + drivers/mxc/mipi/mxc_mipi_csi2.c | 368 +++++++++++++++++++++++++++++++++++++++ drivers/mxc/mipi/mxc_mipi_csi2.h | 42 +++++ 6 files changed, 429 insertions(+) create mode 100644 drivers/mxc/mipi/Kconfig create mode 100644 drivers/mxc/mipi/Makefile create mode 100644 drivers/mxc/mipi/mxc_mipi_csi2.c create mode 100644 drivers/mxc/mipi/mxc_mipi_csi2.h (limited to 'drivers/mxc') diff --git a/drivers/mxc/Kconfig b/drivers/mxc/Kconfig index ac7f92d7e66e..441b655da153 100644 --- a/drivers/mxc/Kconfig +++ b/drivers/mxc/Kconfig @@ -37,6 +37,7 @@ source "drivers/mxc/adc/Kconfig" source "drivers/mxc/amd-gpu/Kconfig" source "drivers/mxc/gpu-viv/Kconfig" source "drivers/mxc/thermal/Kconfig" +source "drivers/mxc/mipi/Kconfig" endmenu diff --git a/drivers/mxc/Makefile b/drivers/mxc/Makefile index b70d4b7af2d1..fbcd0fee1801 100644 --- a/drivers/mxc/Makefile +++ b/drivers/mxc/Makefile @@ -18,3 +18,4 @@ obj-$(CONFIG_IMX_ADC) += adc/ obj-$(CONFIG_MXC_AMD_GPU) += amd-gpu/ obj-$(CONFIG_MXC_GPU_VIV) += gpu-viv/ obj-$(CONFIG_ANATOP_THERMAL) += thermal/ +obj-$(CONFIG_MXC_MIPI_CSI2) += mipi/ diff --git a/drivers/mxc/mipi/Kconfig b/drivers/mxc/mipi/Kconfig new file mode 100644 index 000000000000..2ff0f0b47fc3 --- /dev/null +++ b/drivers/mxc/mipi/Kconfig @@ -0,0 +1,13 @@ +# +# MIPI configuration +# + +menu "MXC MIPI Support" + +config MXC_MIPI_CSI2 + tristate "MIPI CSI2 support" + depends on ARCH_MX6 + ---help--- + Say Y to get the MIPI CSI2 support. + +endmenu diff --git a/drivers/mxc/mipi/Makefile b/drivers/mxc/mipi/Makefile new file mode 100644 index 000000000000..98cda773bd28 --- /dev/null +++ b/drivers/mxc/mipi/Makefile @@ -0,0 +1,4 @@ +# +# Makefile for the mipi interface driver +# +obj-$(CONFIG_MXC_MIPI_CSI2) += mxc_mipi_csi2.o diff --git a/drivers/mxc/mipi/mxc_mipi_csi2.c b/drivers/mxc/mipi/mxc_mipi_csi2.c new file mode 100644 index 000000000000..89592a84745c --- /dev/null +++ b/drivers/mxc/mipi/mxc_mipi_csi2.c @@ -0,0 +1,368 @@ +/* + * Copyright (C) 2011 Freescale Semiconductor, Inc. All Rights Reserved. + * + * 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. + + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + + * You should have received a copy of the GNU General Public License along + * with this program; if not, write to the Free Software Foundation, Inc., + * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include + +#include "mxc_mipi_csi2.h" + +static struct mipi_csi2_info *gmipi_csi2; + +static inline void mipi_csi2_write(struct mipi_csi2_info *info, unsigned value, unsigned offset) +{ + writel(value, info->mipi_csi2_base + offset); +} + +static inline unsigned int mipi_csi2_read(struct mipi_csi2_info *info, unsigned offset) +{ + return readl(info->mipi_csi2_base + offset); +} + +/*! + * This function is called to set mipi lanes. + * + * @param info mipi csi2 hander + * @return Returns setted value + */ +unsigned int mipi_csi2_set_lanes(struct mipi_csi2_info *info) +{ + mipi_csi2_write(info, info->lanes - 1, CSI2_N_LANES); + + return mipi_csi2_read(info, CSI2_N_LANES); +} +EXPORT_SYMBOL(mipi_csi2_set_lanes); + +/*! + * This function is called to set mipi data type. + * + * @param info mipi csi2 hander + * @return Returns setted value + */ +unsigned int mipi_csi2_set_datatype(struct mipi_csi2_info *info, + unsigned int datatype) +{ + info->datatype = datatype; + + return info->datatype; +} +EXPORT_SYMBOL(mipi_csi2_set_datatype); + +/*! + * This function is called to get mipi data type. + * + * @param info mipi csi2 hander + * @return Returns mipi data type + */ +unsigned int mipi_csi2_get_datatype(struct mipi_csi2_info *info) +{ + return info->datatype; +} +EXPORT_SYMBOL(mipi_csi2_get_datatype); + +/*! + * This function is called to get mipi csi2 dphy status. + * + * @param info mipi csi2 hander + * @return Returns dphy status + */ +unsigned int mipi_csi2_dphy_status(struct mipi_csi2_info *info) +{ + return mipi_csi2_read(info, CSI2_PHY_STATE); +} +EXPORT_SYMBOL(mipi_csi2_dphy_status); + +/*! + * This function is called to get mipi csi2 error1 status. + * + * @param info mipi csi2 hander + * @return Returns error1 value + */ +unsigned int mipi_csi2_get_error1(struct mipi_csi2_info *info) +{ + return mipi_csi2_read(info, CSI2_ERR1); +} +EXPORT_SYMBOL(mipi_csi2_get_error1); + +/*! + * This function is called to get mipi csi2 error1 status. + * + * @param info mipi csi2 hander + * @return Returns error1 value + */ +unsigned int mipi_csi2_get_error2(struct mipi_csi2_info *info) +{ + return mipi_csi2_read(info, CSI2_ERR2); +} +EXPORT_SYMBOL(mipi_csi2_get_error2); + +/*! + * This function is called to enable mipi to ipu pixel clock. + * + * @param info mipi csi2 hander + * @return Returns 0 on success or negative error code on fail + */ +int mipi_csi2_pixelclk_enable(struct mipi_csi2_info *info) +{ + return clk_enable(info->pixel_clk); +} +EXPORT_SYMBOL(mipi_csi2_pixelclk_enable); + +/*! + * This function is called to disable mipi to ipu pixel clock. + * + * @param info mipi csi2 hander + * @return Returns 0 on success or negative error code on fail + */ +void mipi_csi2_pixelclk_disable(struct mipi_csi2_info *info) +{ + clk_disable(info->pixel_clk); +} +EXPORT_SYMBOL(mipi_csi2_pixelclk_disable); + +/*! + * This function is called to power on mipi csi2. + * + * @param info mipi csi2 hander + * @return Returns 0 on success or negative error code on fail + */ +int mipi_csi2_reset(struct mipi_csi2_info *info) +{ + mipi_csi2_write(info, 0x0, CSI2_PHY_SHUTDOWNZ); + mipi_csi2_write(info, 0x0, CSI2_DPHY_RSTZ); + mipi_csi2_write(info, 0x0, CSI2_RESETN); + + mipi_csi2_write(info, 0x00000001, CSI2_PHY_TST_CTRL0); + mipi_csi2_write(info, 0x00000000, CSI2_PHY_TST_CTRL1); + mipi_csi2_write(info, 0x00000000, CSI2_PHY_TST_CTRL0); + mipi_csi2_write(info, 0x00000002, CSI2_PHY_TST_CTRL0); + mipi_csi2_write(info, 0x00010044, CSI2_PHY_TST_CTRL1); + mipi_csi2_write(info, 0x00000000, CSI2_PHY_TST_CTRL0); + mipi_csi2_write(info, 0x00000014, CSI2_PHY_TST_CTRL1); + mipi_csi2_write(info, 0x00000002, CSI2_PHY_TST_CTRL0); + mipi_csi2_write(info, 0x00000000, CSI2_PHY_TST_CTRL0); + + mipi_csi2_write(info, 0xffffffff, CSI2_PHY_SHUTDOWNZ); + mipi_csi2_write(info, 0xffffffff, CSI2_DPHY_RSTZ); + mipi_csi2_write(info, 0xffffffff, CSI2_RESETN); + + return 0; +} +EXPORT_SYMBOL(mipi_csi2_reset); + +/*! + * This function is called to get mipi csi2 info. + * + * @return Returns mipi csi2 info struct pointor + */ +struct mipi_csi2_info *mipi_csi2_get_info(void) +{ + return gmipi_csi2; +} +EXPORT_SYMBOL(mipi_csi2_get_info); + +/*! + * This function is called to get mipi csi2 bind ipu num. + * + * @return Returns mipi csi2 bind ipu num + */ +int mipi_csi2_get_bind_ipu(struct mipi_csi2_info *info) +{ + return info->ipu_id; +} +EXPORT_SYMBOL(mipi_csi2_get_bind_ipu); + +/*! + * This function is called to get mipi csi2 bind csi num. + * + * @return Returns mipi csi2 bind csi num + */ +unsigned int mipi_csi2_get_bind_csi(struct mipi_csi2_info *info) +{ + return info->csi_id; +} +EXPORT_SYMBOL(mipi_csi2_get_bind_csi); + +/*! + * This function is called to get mipi csi2 virtual channel. + * + * @return Returns mipi csi2 virtual channel num + */ +unsigned int mipi_csi2_get_virtual_channel(struct mipi_csi2_info *info) +{ + return info->v_channel; +} +EXPORT_SYMBOL(mipi_csi2_get_virtual_channel); + +/** + * This function is called by the driver framework to initialize the MIPI CSI2 + * device. + * + * @param pdev The device structure for the MIPI CSI2 passed in by the + * driver framework. + * + * @return Returns 0 on success or negative error code on error + */ +static int mipi_csi2_probe(struct platform_device *pdev) +{ + struct mipi_csi2_platform_data *plat_data = pdev->dev.platform_data; + struct resource *res; + u32 mipi_csi2_dphy_ver; + int ret; + + if ((plat_data->ipu_id < 0) || (plat_data->ipu_id > 1) || + (plat_data->csi_id > 1) || (plat_data->v_channel > 3) || + (plat_data->lanes > 4)) { + dev_err(&pdev->dev, "invalid param for mimp csi2!\n"); + return -EINVAL; + } + + gmipi_csi2 = kmalloc(sizeof(struct mipi_csi2_info), GFP_KERNEL); + if (!gmipi_csi2) { + ret = -ENOMEM; + goto alloc_failed; + } + + /* get mipi csi2 informaiton */ + gmipi_csi2->pdev = pdev; + gmipi_csi2->ipu_id = plat_data->ipu_id; + gmipi_csi2->csi_id = plat_data->csi_id; + gmipi_csi2->v_channel = plat_data->v_channel; + gmipi_csi2->lanes = plat_data->lanes; + + /* get mipi dphy clk */ + gmipi_csi2->dphy_clk = clk_get(&pdev->dev, plat_data->dphy_clk); + if (IS_ERR(gmipi_csi2->dphy_clk)) { + dev_err(&pdev->dev, "failed to get dphy pll_ref_clk\n"); + ret = PTR_ERR(gmipi_csi2->dphy_clk); + goto err_clk1; + } + + /* get mipi to ipu pixel clk */ + gmipi_csi2->pixel_clk = clk_get(&pdev->dev, plat_data->pixel_clk); + if (IS_ERR(gmipi_csi2->pixel_clk)) { + dev_err(&pdev->dev, "failed to get mipi pixel clk\n"); + ret = PTR_ERR(gmipi_csi2->pixel_clk); + goto err_clk2; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res) { + ret = -ENODEV; + goto failed_get_res; + } + + /* mipi register mapping */ + gmipi_csi2->mipi_csi2_base = ioremap(res->start, PAGE_SIZE); + if (!gmipi_csi2->mipi_csi2_base) { + ret = -ENOMEM; + goto failed_ioremap; + } + + /* mipi dphy clk enable for register access */ + clk_enable(gmipi_csi2->dphy_clk); + /* get mipi csi2 dphy version */ + mipi_csi2_dphy_ver = mipi_csi2_read(gmipi_csi2, CSI2_VERSION); + + platform_set_drvdata(pdev, gmipi_csi2); + + dev_info(&pdev->dev, "i.MX MIPI CSI2 driver probed\n"); + dev_info(&pdev->dev, "i.MX MIPI CSI2 dphy version is 0x%x\n", + mipi_csi2_dphy_ver); + + return 0; + +failed_ioremap: +failed_get_res: + clk_put(gmipi_csi2->pixel_clk); +err_clk2: + clk_put(gmipi_csi2->dphy_clk); +err_clk1: + kfree(gmipi_csi2); +alloc_failed: + return ret; +} + +static int __devexit mipi_csi2_remove(struct platform_device *pdev) +{ + /* unmapping mipi register */ + iounmap(gmipi_csi2->mipi_csi2_base); + + /* disable mipi dphy clk */ + clk_disable(gmipi_csi2->dphy_clk); + clk_put(gmipi_csi2->dphy_clk); + + clk_put(gmipi_csi2->pixel_clk); + + kfree(gmipi_csi2); + + dev_set_drvdata(&pdev->dev, NULL); + + return 0; +} + +static struct platform_driver mipi_csi2_driver = { + .driver = { + .name = "mxc_mipi_csi2", + }, + .probe = mipi_csi2_probe, + .remove = __devexit_p(mipi_csi2_remove), +}; + +static int __init mipi_csi2_init(void) +{ + int err; + + err = platform_driver_register(&mipi_csi2_driver); + if (err) { + pr_err("mipi_csi2_driver register failed\n"); + return -ENODEV; + } + + pr_info("MIPI CSI2 driver module loaded\n"); + + return 0; +} + +static void __exit mipi_csi2_cleanup(void) +{ + platform_driver_unregister(&mipi_csi2_driver); +} + +module_init(mipi_csi2_init); +module_exit(mipi_csi2_cleanup); + +MODULE_AUTHOR("Freescale Semiconductor, Inc."); +MODULE_DESCRIPTION("i.MX MIPI CSI2 driver"); +MODULE_LICENSE("GPL"); diff --git a/drivers/mxc/mipi/mxc_mipi_csi2.h b/drivers/mxc/mipi/mxc_mipi_csi2.h new file mode 100644 index 000000000000..d7c4ba1e36da --- /dev/null +++ b/drivers/mxc/mipi/mxc_mipi_csi2.h @@ -0,0 +1,42 @@ +/* + * Copyright (C) 2011 Freescale Semiconductor, Inc. All Rights Reserved. + * + * 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. + + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + + * You should have received a copy of the GNU General Public License along + * with this program; if not, write to the Free Software Foundation, Inc., + * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. + */ + +#ifndef __MXC_MIPI_CSI2_H__ +#define __MXC_MIPI_CSI2_H__ + +#ifdef DEBUG +#define mipi_dbg(fmt, ...) \ + printk(KERN_DEBUG pr_fmt(fmt), ##__VA_ARGS__) +#else +#define mipi_dbg(fmt, ...) +#endif + +/* driver private data */ +struct mipi_csi2_info { + int ipu_id; + unsigned int csi_id; + unsigned int v_channel; + unsigned int lanes; + unsigned int datatype; + struct clk *dphy_clk; + struct clk *pixel_clk; + unsigned int *mipi_csi2_base; + struct platform_device *pdev; +}; + +#endif -- cgit v1.2.3