343 lines
7.8 KiB
C
343 lines
7.8 KiB
C
/*
|
|
* ISP5 driver for T194
|
|
*
|
|
* Copyright (c) 2017-2019, NVIDIA Corporation. All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2, as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope 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, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <asm/ioctls.h>
|
|
#include <linux/debugfs.h>
|
|
#include <linux/device.h>
|
|
#include <linux/dma-mapping.h>
|
|
#include <linux/export.h>
|
|
#include <linux/fs.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/of_graph.h>
|
|
#include <linux/of_irq.h>
|
|
#include <linux/of_platform.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/regulator/consumer.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/uaccess.h>
|
|
#include <media/isp_channel.h>
|
|
#include <media/tegra_camera_platform.h>
|
|
#include <soc/tegra/camrtc-capture.h>
|
|
#include <soc/tegra/chip-id.h>
|
|
#include <soc/tegra/fuse.h>
|
|
|
|
#include "isp5.h"
|
|
#include "capture/capture-support.h"
|
|
#include "dev.h"
|
|
#include "bus_client.h"
|
|
#include "nvhost_acm.h"
|
|
#include "nvhost_syncpt_unit_interface.h"
|
|
#include "t194/t194.h"
|
|
#include <uapi/linux/nvhost_isp_ioctl.h>
|
|
|
|
#define ISP_PPC 2
|
|
/* 20% overhead */
|
|
#define ISP_OVERHEAD 20
|
|
|
|
struct host_isp5 {
|
|
struct platform_device *pdev;
|
|
struct platform_device *isp_thi;
|
|
};
|
|
|
|
static int isp5_alloc_syncpt(struct platform_device *pdev,
|
|
const char *name,
|
|
uint32_t *syncpt_id)
|
|
{
|
|
struct host_isp5 *isp5 = nvhost_get_private_data(pdev);
|
|
|
|
return t194_capture_alloc_syncpt(isp5->isp_thi, name, syncpt_id);
|
|
}
|
|
|
|
static void isp5_release_syncpt(struct platform_device *pdev, uint32_t id)
|
|
{
|
|
struct host_isp5 *isp5 = nvhost_get_private_data(pdev);
|
|
|
|
t194_capture_release_syncpt(isp5->isp_thi, id);
|
|
}
|
|
|
|
static int isp5_get_syncpt_gos_backing(struct platform_device *pdev,
|
|
uint32_t id,
|
|
dma_addr_t *syncpt_addr,
|
|
uint32_t *gos_index,
|
|
uint32_t *gos_offset)
|
|
{
|
|
struct host_isp5 *isp5 = nvhost_get_private_data(pdev);
|
|
|
|
return t194_capture_get_syncpt_gos_backing(isp5->isp_thi, id,
|
|
syncpt_addr, gos_index, gos_offset);
|
|
|
|
}
|
|
|
|
static uint32_t isp5_get_gos_table(struct platform_device *pdev,
|
|
const dma_addr_t **table)
|
|
{
|
|
struct host_isp5 *isp5 = nvhost_get_private_data(pdev);
|
|
uint32_t count;
|
|
|
|
t194_capture_get_gos_table(isp5->isp_thi, &count, table);
|
|
|
|
return count;
|
|
}
|
|
|
|
static struct isp_channel_drv_ops isp5_channel_drv_ops = {
|
|
.alloc_syncpt = isp5_alloc_syncpt,
|
|
.release_syncpt = isp5_release_syncpt,
|
|
.get_gos_table = isp5_get_gos_table,
|
|
.get_syncpt_gos_backing = isp5_get_syncpt_gos_backing,
|
|
};
|
|
|
|
int isp5_priv_early_probe(struct platform_device *pdev)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
struct nvhost_device_data *info;
|
|
struct device_node *thi_np;
|
|
struct platform_device *thi = NULL;
|
|
struct host_isp5 *isp5;
|
|
int err = 0;
|
|
|
|
info = (void *)of_device_get_match_data(dev);
|
|
if (unlikely(info == NULL)) {
|
|
dev_WARN(dev, "no platform data\n");
|
|
return -ENODATA;
|
|
}
|
|
|
|
thi_np = of_parse_phandle(dev->of_node, "nvidia,isp-falcon-device", 0);
|
|
if (thi_np == NULL) {
|
|
dev_WARN(dev, "missing %s handle\n",
|
|
"nvidia,isp-falcon-device");
|
|
err = -ENODEV;
|
|
goto error;
|
|
}
|
|
|
|
thi = of_find_device_by_node(thi_np);
|
|
of_node_put(thi_np);
|
|
|
|
if (thi == NULL) {
|
|
err = -ENODEV;
|
|
goto error;
|
|
}
|
|
|
|
if (tegra_get_chipid() == TEGRA_CHIPID_TEGRA19 &&
|
|
tegra_get_sku_id() == 0x9E) {
|
|
dev_err(dev, "ISP IP is disabled in SKU\n");
|
|
err = -ENODEV;
|
|
goto error;
|
|
}
|
|
|
|
if (thi->dev.driver == NULL) {
|
|
platform_device_put(thi);
|
|
return -EPROBE_DEFER;
|
|
}
|
|
|
|
isp5 = devm_kzalloc(dev, sizeof(*isp5), GFP_KERNEL);
|
|
if (!isp5)
|
|
return -ENOMEM;
|
|
|
|
isp5->isp_thi = thi;
|
|
isp5->pdev = pdev;
|
|
info->pdev = pdev;
|
|
mutex_init(&info->lock);
|
|
platform_set_drvdata(pdev, info);
|
|
info->private_data = isp5;
|
|
|
|
/* A bit was stolen */
|
|
(void) dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(39));
|
|
|
|
return 0;
|
|
|
|
error:
|
|
info->private_data = NULL;
|
|
if (err != -EPROBE_DEFER)
|
|
dev_err(&pdev->dev, "probe failed: %d\n", err);
|
|
return err;
|
|
}
|
|
|
|
int isp5_priv_late_probe(struct platform_device *pdev)
|
|
{
|
|
struct tegra_camera_dev_info isp_info;
|
|
struct nvhost_device_data *info = platform_get_drvdata(pdev);
|
|
struct host_vi5 *isp5 = info->private_data;
|
|
int err;
|
|
|
|
memset(&isp_info, 0, sizeof(isp_info));
|
|
isp_info.overhead = ISP_OVERHEAD;
|
|
isp_info.ppc = ISP_PPC;
|
|
isp_info.hw_type = HWTYPE_ISPA;
|
|
isp_info.pdev = pdev;
|
|
err = tegra_camera_device_register(&isp_info, isp5);
|
|
if (err)
|
|
goto device_release;
|
|
|
|
#if defined(CONFIG_TEGRA_CAMERA_RTCPU)
|
|
err = isp_channel_drv_register(pdev, &isp5_channel_drv_ops);
|
|
if (err)
|
|
goto device_release;
|
|
#endif
|
|
|
|
return 0;
|
|
|
|
device_release:
|
|
nvhost_client_device_release(pdev);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int isp5_probe(struct platform_device *pdev)
|
|
{
|
|
struct nvhost_device_data *pdata;
|
|
struct host_isp5 *isp5;
|
|
int err = 0;
|
|
|
|
err = isp5_priv_early_probe(pdev);
|
|
if (err)
|
|
goto error;
|
|
|
|
pdata = platform_get_drvdata(pdev);
|
|
isp5 = pdata->private_data;
|
|
|
|
err = nvhost_client_device_get_resources(pdev);
|
|
if (err)
|
|
goto put_thi;
|
|
|
|
err = nvhost_module_init(pdev);
|
|
if (err)
|
|
goto put_thi;
|
|
|
|
err = nvhost_client_device_init(pdev);
|
|
if (err) {
|
|
nvhost_module_deinit(pdev);
|
|
goto put_thi;
|
|
}
|
|
|
|
err = isp5_priv_late_probe(pdev);
|
|
if (err)
|
|
goto put_thi;
|
|
|
|
return 0;
|
|
|
|
put_thi:
|
|
platform_device_put(isp5->isp_thi);
|
|
error:
|
|
if (err != -EPROBE_DEFER)
|
|
dev_err(&pdev->dev, "probe failed: %d\n", err);
|
|
return err;
|
|
}
|
|
|
|
static long isp_ioctl(struct file *file,
|
|
unsigned int cmd, unsigned long arg)
|
|
{
|
|
struct t194_isp5_file_private *filepriv = file->private_data;
|
|
struct platform_device *pdev = filepriv->pdev;
|
|
|
|
if (_IOC_TYPE(cmd) != NVHOST_ISP_IOCTL_MAGIC)
|
|
return -EFAULT;
|
|
|
|
switch (_IOC_NR(cmd)) {
|
|
case _IOC_NR(NVHOST_ISP_IOCTL_SET_ISP_LA_BW): {
|
|
/* No BW control needed. Return without error. */
|
|
return 0;
|
|
}
|
|
default:
|
|
dev_err(&pdev->dev,
|
|
"%s: Unknown ISP ioctl.\n", __func__);
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int isp_open(struct inode *inode, struct file *file)
|
|
{
|
|
struct nvhost_device_data *pdata = container_of(inode->i_cdev,
|
|
struct nvhost_device_data, ctrl_cdev);
|
|
struct platform_device *pdev = pdata->pdev;
|
|
struct t194_isp5_file_private *filepriv;
|
|
|
|
filepriv = kzalloc(sizeof(*filepriv), GFP_KERNEL);
|
|
if (unlikely(filepriv == NULL))
|
|
return -ENOMEM;
|
|
|
|
filepriv->pdev = pdev;
|
|
|
|
file->private_data = filepriv;
|
|
|
|
return nonseekable_open(inode, file);
|
|
}
|
|
|
|
static int isp_release(struct inode *inode, struct file *file)
|
|
{
|
|
struct t194_isp5_file_private *filepriv = file->private_data;
|
|
|
|
kfree(filepriv);
|
|
|
|
return 0;
|
|
}
|
|
|
|
const struct file_operations tegra194_isp5_ctrl_ops = {
|
|
.owner = THIS_MODULE,
|
|
.open = isp_open,
|
|
.unlocked_ioctl = isp_ioctl,
|
|
#ifdef CONFIG_COMPAT
|
|
.compat_ioctl = isp_ioctl,
|
|
#endif
|
|
.release = isp_release,
|
|
};
|
|
|
|
static int isp5_remove(struct platform_device *pdev)
|
|
{
|
|
struct nvhost_device_data *pdata = platform_get_drvdata(pdev);
|
|
struct host_isp5 *isp5 = (struct host_isp5 *)pdata->private_data;
|
|
|
|
tegra_camera_device_unregister(isp5);
|
|
|
|
#if defined(CONFIG_TEGRA_CAMERA_RTCPU)
|
|
isp_channel_drv_unregister(&pdev->dev);
|
|
#endif
|
|
|
|
platform_device_put(isp5->isp_thi);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id tegra_isp5_of_match[] = {
|
|
{
|
|
.compatible = "nvidia,tegra194-isp",
|
|
.data = &t19_isp5_info,
|
|
},
|
|
{ },
|
|
};
|
|
|
|
static struct platform_driver isp5_driver = {
|
|
.probe = isp5_probe,
|
|
.remove = isp5_remove,
|
|
.driver = {
|
|
.owner = THIS_MODULE,
|
|
.name = "tegra194-isp5",
|
|
#ifdef CONFIG_OF
|
|
.of_match_table = tegra_isp5_of_match,
|
|
#endif
|
|
#ifdef CONFIG_PM
|
|
.pm = &nvhost_module_pm_ops,
|
|
#endif
|
|
},
|
|
};
|
|
|
|
module_platform_driver(isp5_driver);
|