123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * Copyright (c) 2018-2019 Synopsys, Inc. and/or its affiliates.
- *
- * Synopsys DesignWare MIPI CSI-2 Host controller driver.
- * Platform driver
- *
- * Author: Luis Oliveira <luis.oliveira@synopsys.com>
- */
- #include "dw-csi-data.h"
- #include "dw-dphy-data.h"
- #include "dw-csi-plat.h"
- #include "bm_csi_hw.h"
- const struct mipi_dt csi_dt[] = {
- {
- .hex = CSI_2_YUV420_8,
- .name = "YUV420_8bits",
- }, {
- .hex = CSI_2_YUV420_10,
- .name = "YUV420_10bits",
- }, {
- .hex = CSI_2_YUV420_8_LEG,
- .name = "YUV420_8bits_LEGACY",
- }, {
- .hex = CSI_2_YUV420_8_SHIFT,
- .name = "YUV420_8bits_SHIFT",
- }, {
- .hex = CSI_2_YUV420_10_SHIFT,
- .name = "YUV420_10bits_SHIFT",
- }, {
- .hex = CSI_2_YUV422_8,
- .name = "YUV442_8bits",
- }, {
- .hex = CSI_2_YUV422_10,
- .name = "YUV442_10bits",
- }, {
- .hex = CSI_2_RGB444,
- .name = "RGB444",
- }, {
- .hex = CSI_2_RGB555,
- .name = "RGB555",
- }, {
- .hex = CSI_2_RGB565,
- .name = "RGB565",
- }, {
- .hex = CSI_2_RGB666,
- .name = "RGB666",
- }, {
- .hex = CSI_2_RGB888,
- .name = "RGB888",
- }, {
- .hex = CSI_2_RAW6,
- .name = "RAW6",
- }, {
- .hex = CSI_2_RAW7,
- .name = "RAW7",
- }, {
- .hex = CSI_2_RAW8,
- .name = "RAW8",
- }, {
- .hex = CSI_2_RAW10,
- .name = "RAW10",
- }, {
- .hex = CSI_2_RAW12,
- .name = "RAW12",
- }, {
- .hex = CSI_2_RAW14,
- .name = "RAW14",
- }, {
- .hex = CSI_2_RAW16,
- .name = "RAW16",
- },
- };
- static struct mipi_fmt *
- find_dw_mipi_csi_format(uint32_t mbus_code)
- {
- unsigned int i;
- pr_info("%s entered mbus: 0x%x\n", __func__, mbus_code);
- for (i = 0; i < ARRAY_SIZE(dw_mipi_csi_formats); i++)
- if (mbus_code == dw_mipi_csi_formats[i].mbus_code) {
- pr_info("Found mbus 0x%x\n", dw_mipi_csi_formats[i].mbus_code);
- return &dw_mipi_csi_formats[i];
- }
- return NULL;
- }
- static int dw_mipi_csi_enum_mbus_code(int index, uint32_t *code)
- {
- if (index != 0)
- return -EINVAL;
- *code = dw_mipi_csi_formats[index].mbus_code;
- return 0;
- }
- static struct mipi_fmt *
- dw_mipi_csi_try_format(uint32_t mbus_code)
- {
- struct mipi_fmt *fmt;
- fmt = find_dw_mipi_csi_format(mbus_code);
- if (!fmt)
- fmt = &dw_mipi_csi_formats[0];
- return fmt;
- }
- struct mipi_fmt *
- dw_mipi_csi_get_format(struct dw_csi *dev)
- {
- dev_info(dev->dev,
- "%s got v4l2_mbus_pixelcode. 0x%x\n", __func__,
- dev->fmt->mbus_code);
- dev_info(dev->dev,
- "%s got width. 0x%x\n", __func__,
- dev->fmt->width);
- dev_info(dev->dev,
- "%s got height. 0x%x\n", __func__,
- dev->fmt->height);
- return dev->fmt;
- }
- static int
- dw_mipi_csi_set_fmt(struct platform_device *pdev,
- uint32_t mbus_code, uint32_t width, uint32_t height)
- {
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *dev = &drvdata->csi_dev;
- struct mipi_fmt *dev_fmt = NULL;
- int i;
- dev_info(dev->dev,
- "%s got mbus_pixelcode. 0x%x\n", __func__,
- mbus_code);
- dev_fmt = dw_mipi_csi_try_format(mbus_code);
- dev_info(dev->dev,
- "%s got v4l2_mbus_pixelcode. 0x%x\n", __func__,
- dev_fmt->mbus_code);
- if (!dev_fmt)
- return -EINVAL;
- if (dev_fmt) {
- dev->fmt->mbus_code = dev_fmt->mbus_code;
- dev->fmt->width = width;
- dev->fmt->height = height;
- dw_mipi_csi_set_ipi_fmt(dev);
- }
- dev_info(dev->dev, "Width: %d, Height: %d of Demo\n", width, height);
- if (width > 0 && height > 0) {
- dw_mipi_csi_fill_timings(dev, width, height);
- /*
- demo_writel(dev,
- DEMO_ACTIVE_WIDTH, fmt->format.width);
- demo_writel(dev,
- DEMO_ACTIVE_HEIGHT, fmt->format.height);
- */
- dev_vdbg(dev->dev,
- "(core/demosaic) : width=%d/%d, height=%d/%d\n",
- dev->hw.htotal - (dev->hw.hbp
- + dev->hw.hsd
- + dev->hw.hsa),
- width,
- dev->hw.vactive,
- height);
- dev_info(dev->dev,
- "(core/demosaic) : width=%d/%d, height=%d/%d\n",
- dev->hw.htotal - (dev->hw.hbp
- + dev->hw.hsd
- + dev->hw.hsa),
- width,
- dev->hw.vactive,
- height);
- } else {
- dev_vdbg(dev->dev, "%s unacceptable values 0x%x.\n",
- __func__, width);
- dev_vdbg(dev->dev, "%s unacceptable values 0x%x.\n",
- __func__, height);
- dev_info(dev->dev, "%s unacceptable values 0x%x.\n",
- __func__, width);
- dev_info(dev->dev, "%s unacceptable values 0x%x.\n",
- __func__, height);
- return -EINVAL;
- }
- for (i = 0; i < ARRAY_SIZE(csi_dt); i++)
- if (csi_dt[i].hex == dev->ipi_dt) {
- dev_vdbg(dev->dev, "Using data type %s\n",
- csi_dt[i].name);
- dev_info(dev->dev, "Using data type %s\n",
- csi_dt[i].name);
- }
- return 0;
- }
- static int
- dw_mipi_csi_get_fmt(struct platform_device *pdev,
- struct mipi_fmt *fmt)
- {
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *dev = &drvdata->csi_dev;
- struct mipi_fmt *mf = dw_mipi_csi_get_format(dev);
- if (!mf)
- return -EINVAL;
- mutex_lock(&dev->lock);
- *fmt = *mf;
- mutex_unlock(&dev->lock);
- return 0;
- }
- int dw_mipi_csi_s_power(struct dw_csi *dev, int on)
- {
- dev_info(dev->dev, "%s: on=%d\n", __func__, on);
- if (on) {
- dw_mipi_csi_hw_stdby(dev);
- dw_mipi_csi_start(dev);
- } else {
- phy_power_off(dev->phy);
- dw_mipi_csi_mask_irq_power_off(dev);
- /* reset data type */
- dev->ipi_dt = 0x0;
- }
- return 0;
- }
- int dw_mipi_csi_log_status(struct dw_csi *dev)
- {
- dw_mipi_csi_dump(dev);
- return 0;
- }
- #if IS_ENABLED(CONFIG_VIDEO_ADV_DEBUG)
- int
- dw_mipi_csi_g_register(struct v4l2_subdev *sd, uint32_t reg)
- {
- struct bm_csi_drvdata *drvdata = platform_get_drvdata(pdev);
- struct dw_csi *dev = &drvdata->csi_dev;
- dev_vdbg(dev->dev, "%s: reg=%llu\n", __func__, reg);
- reg->val = dw_mipi_csi_read(dev, reg);
- return 0;
- }
- #endif
- #if 0
- static int dw_mipi_csi_init_cfg(struct v4l2_subdev *sd,
- struct v4l2_subdev_pad_config *cfg)
- {
- struct v4l2_mbus_framefmt *format =
- v4l2_subdev_get_try_format(sd, cfg, 0);
- format->colorspace = V4L2_COLORSPACE_SRGB;
- format->code = MEDIA_BUS_FMT_RGB888_1X24;
- format->field = V4L2_FIELD_NONE;
- return 0;
- }
- #endif
- static irqreturn_t dw_mipi_csi_irq1(int irq, void *dev_id)
- {
- struct dw_csi *csi_dev = dev_id;
- dw_mipi_csi_irq_handler(csi_dev);
- return IRQ_HANDLED;
- }
- void dw_csi_soc_reset(void __iomem *io_mem)
- {
- #define VISYS_SW_RST 0x100
- uint32_t reg_val = 0;
- reg_val = readl(io_mem + VISYS_SW_RST);
- reg_val &= ~(1 << 16);
- writel(reg_val, io_mem + VISYS_SW_RST);
- reg_val |= 1 << 16;
- writel(reg_val, io_mem + VISYS_SW_RST);
- }
- static const struct of_device_id dw_mipi_csi_of_match[];
- int dw_csi_probe(struct platform_device *pdev)
- {
- struct device *dev = &pdev->dev;
- struct dw_csi *csi;
- struct dw_dphy_rx *dphy;
- struct dw_csih_pdata *pdata;
- struct bm_csi_drvdata *drvdata;
- int ret;
- if (!IS_ENABLED(CONFIG_OF))
- dev_vdbg(dev, "Probing started\n");
- /* Resource allocation */
- drvdata = platform_get_drvdata(pdev);
- csi = &drvdata->csi_dev;
- dphy = drvdata->dphy;
- pdata = &drvdata->csi_pdata;
- mutex_init(&csi->lock);
- spin_lock_init(&csi->slock);
- csi->dev = dev;
- /*set csi phy*/
- csi->phy = dphy->phy;
- csi->base_address = drvdata->base;
- if (IS_ERR(csi->base_address)) {
- dev_err(dev, "base address not set.\n");
- return PTR_ERR(csi->base_address);
- }
- csi->ctrl_irq_number = drvdata->irq_num;
- if (csi->ctrl_irq_number < 0) {
- dev_err(dev, "irq number %d not set.\n", csi->ctrl_irq_number);
- ret = csi->ctrl_irq_number;
- goto end;
- }
- ret = devm_request_irq(dev, csi->ctrl_irq_number,
- dw_mipi_csi_irq1, IRQF_SHARED,
- dev_name(dev), csi);
- if (ret) {
- dev_err(dev, "irq csi %d failed\n", pdata->id);
- goto end;
- }
- csi->fmt = &dw_mipi_csi_formats[0];
- csi->fmt->mbus_code = dw_mipi_csi_formats[0].mbus_code;
- /*
- to do pad init
- */
- csi->hw.num_lanes = pdata->lanes;
- csi->hw.pclk = pdata->pclk;
- csi->hw.fps = pdata->fps;
- csi->hw.dphy_freq = pdata->hs_freq;
- //csi soc reset
- dw_csi_soc_reset(drvdata->reset);
- #if IS_ENABLED(CONFIG_DWC_MIPI_TC_DPHY_GEN3)
- dw_csi_create_capabilities_sysfs(pdev);
- #endif
- dw_mipi_csi_get_version(csi);
- dw_mipi_csi_specific_mappings(csi);
- dw_mipi_csi_mask_irq_power_off(csi);
- dev_info(dev, "DW MIPI CSI-2 Host registered successfully HW v%u.%u\n",
- csi->hw_version_major, csi->hw_version_minor);
- ret = phy_init(csi->phy);
- if (ret) {
- dev_err(&csi->phy->dev, "phy init failed --> %d\n", ret);
- goto end;
- }
- return 0;
- end:
- return ret;
- }
- int dw_csi_remove(struct platform_device *pdev)
- {
- struct bm_csi_drvdata *drvdata;
- drvdata = platform_get_drvdata(pdev);
- dw_csi_remove_capabilities_sysfs(pdev);
- //struct dw_csi *mipi_csi = &drvdata->csi_dev;
- //csi soc reset
- dw_csi_soc_reset(drvdata->reset);
- dev_info(&pdev->dev, "DW MIPI CSI-2 Host module removed\n");
- return 0;
- }
- MODULE_LICENSE("GPL v2");
- MODULE_AUTHOR("Luis Oliveira <luis.oliveira@synopsys.com>");
- MODULE_DESCRIPTION("Synopsys DesignWare MIPI CSI-2 Host Platform driver");
|