path: root/drivers/mxc/mipi/mxc_mipi_csi2.c

/*
 * 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 <linux/types.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/err.h>
#include <linux/clk.h>
#include <linux/console.h>
#include <linux/io.h>
#include <linux/bitops.h>
#include <linux/ipu.h>
#include <linux/mxcfb.h>
#include <linux/regulator/consumer.h>
#include <linux/backlight.h>
#include <linux/spinlock.h>
#include <linux/delay.h>
#include <linux/fsl_devices.h>

#include <mach/hardware.h>
#include <mach/clock.h>
#include <mach/mipi_csi2.h>

#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");