123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412 |
- /*
- * Copyright (C) 2021 Alibaba Group Holding Limited
- * Author: liuyitong <yitong.lyt@alibaba-inc.com>
- *
- * 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 <asm/io.h>
- #include <linux/cdev.h>
- #include <linux/module.h>
- #include <linux/platform_device.h>
- #include <linux/delay.h>
- #include <linux/clk.h>
- #include <linux/io.h>
- #include <linux/mm.h>
- #include <linux/timer.h>
- #include <linux/kernel.h>
- #include <linux/init.h>
- #include <linux/ioctl.h>
- #include <linux/poll.h>
- #include <linux/workqueue.h>
- #include <linux/slab.h>
- #include <linux/proc_fs.h>
- #include <linux/debugfs.h>
- #include <linux/miscdevice.h>
- #include <linux/uaccess.h>
- #include <linux/interrupt.h>
- #include <linux/of.h>
- #include <linux/regmap.h>
- #include "bm_printk.h"
- #include "bm_csi_ioctl.h"
- #include "bm_csi_hw.h"
- #include "dw-dphy-rx.h"
- #include "bm_csi_dphy.h"
- #define check_retval(x)\
- do {\
- if ((x))\
- return -EIO;\
- } while (0)
- struct csi_format_context {
- uint32_t format;
- uint32_t width;
- uint32_t height;
- };
- int bm_csi_write_reg(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct bm_csi_reg_t reg;
- check_retval(copy_from_user(®, args, sizeof(reg)));
- writel(reg.value, drvdata->base + reg.offset);
- bm_info("%s addr 0x%08x val 0x%08x\n", __func__, reg.offset, reg.value);
- return 0;
- }
- int bm_csi_read_reg(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct bm_csi_reg_t reg;
- check_retval(copy_from_user(®, args, sizeof(reg)));
- reg.value = readl(drvdata->base + reg.offset);
- check_retval(copy_to_user(args, ®, sizeof(reg)));
- bm_info("%s addr 0x%08x val 0x%08x\n", __func__, reg.offset, reg.value);
- return 0;
- }
- int bm_csi_read_array(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- int index = 0;
- int cnt = 0;
- uint32_t value = 0;
- struct bm_csi_reg_arry_t array;
- check_retval(copy_from_user(&array, args, sizeof(struct bm_csi_reg_arry_t)));
- cnt = array.words;
- for (index = 0; index < cnt; index++) {
- value = readl(drvdata->base + array.start_addr + index * 4);
- check_retval(copy_to_user(&(array.buf[index]), &value, sizeof(value)));
- }
- return 0;
- }
- int bm_csi_reset(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- bm_info("%s: csi reset success\n", __func__);
- dw_csi_soc_reset();
- dw_mipi_csi_reset(&drvdata->csi_dev);
- dw_dphy_reset(drvdata->dphy->phy);
- return 0;
- }
- int bm_csi_en_power(struct bm_csi_drvdata *drvdata)
- {
- bm_info("%s: csi set power\n", __func__);
- drvdata->csi_power_on_sta = 1;
- dw_mipi_csi_s_power(&drvdata->csi_dev, drvdata->csi_power_on_sta);
- return 0;
- }
- int bm_csi_dis_power(struct bm_csi_drvdata *drvdata)
- {
- bm_info("%s: csi set power\n", __func__);
- drvdata->csi_power_on_sta = 0;
- dw_mipi_csi_s_power(&drvdata->csi_dev, drvdata->csi_power_on_sta);
- return 0;
- }
- static int bm_csi_can_enable(struct bm_csi_drvdata *drvdata)
- {
- return 1;
- u32 csia_pixclk = 0;
- u32 csia_rst = 0;
- u32 csia_shutdown = 0;
- if (drvdata->csia_reg == NULL || drvdata->visys_clk_reg == NULL) {
- return 1;
- }
- regmap_read(drvdata->visys_clk_reg, 0xa0, &csia_pixclk);
- regmap_read(drvdata->csia_reg, 0x40 + R_CSI2_DPHY_RSTZ, &csia_rst);
- regmap_read(drvdata->csia_reg, 0x40 + R_CSI2_DPHY_SHUTDOWNZ, &csia_shutdown);
- if (csia_pixclk & (1 << 9) && (csia_rst | csia_shutdown)) {
- return 0;
- }
- return 1;
- }
- int bm_csi_set_power(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- bm_info("%s: csi set power\n", __func__);
- check_retval(copy_from_user(&drvdata->csi_power_on_sta, args, sizeof(drvdata->csi_power_on_sta)));
- if (!bm_csi_can_enable(drvdata)) {
- printk("can't enable csi power!!!!!!!!!!!!!\n");
- return -1;
- }
- dw_mipi_csi_s_power(&drvdata->csi_dev, drvdata->csi_power_on_sta);
- return 0;
- }
- int bm_csi_get_power(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- bm_info("%s: csi get power\n", __func__);
- check_retval(copy_to_user(args, &drvdata->csi_power_on_sta, sizeof(drvdata->csi_power_on_sta)));
- return 0;
- }
- int bm_csi_set_clock(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct dw_dphy_rx *dphy = drvdata->dphy;
- bm_info("%s: \n", __func__);
- check_retval(copy_from_user(&dphy->dphy_freq, args, sizeof(dphy->dphy_freq)));
- return 0;
- }
- int bm_csi_get_clock(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct dw_dphy_rx *dphy = drvdata->dphy;
- bm_info("%s: \n", __func__);
- check_retval(copy_to_user(args, &dphy->dphy_freq, sizeof(dphy->dphy_freq)));
- return 0;
- }
- int bm_csi_set_pixclk(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- uint32_t freq_hz = 0;
- bm_info("%s: \n", __func__);
- check_retval(copy_from_user(&freq_hz, args, sizeof(freq_hz)));
- return dw_csi_set_pixclk(freq_hz);
- }
- int bm_csi_get_pixclk(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- uint32_t freq_hz = 0;
- bm_info("%s: \n", __func__);
- dw_csi_get_pixclk(&freq_hz);
- check_retval(copy_to_user(args, &freq_hz, sizeof(freq_hz)));
- return 0;
- }
- int bm_csi_get_error(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- bm_info("%s: \n", __func__);
- struct dw_csi_err_mask *error_mask = &drvdata->csi_dev.error_mask;
- check_retval(copy_to_user(args, error_mask, sizeof(struct dw_csi_err_mask)));
- return 0;
- }
- int bm_csi_set_stream(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- bm_info("%s: \n", __func__);
- return 0;
- }
- int bm_csi_get_stream(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- bm_info("%s: \n", __func__);
- check_retval(copy_to_user(args, &drvdata->csi_power_on_sta, sizeof(drvdata->csi_power_on_sta)));
- return 0;
- }
- int bm_csi_set_fmt(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- u8 dt = 0;
- //struct csi_format_context fmt;
- bm_info("%s: \n", __func__);
- check_retval(copy_from_user(&dt, args, sizeof(dt)));
- /*
- csi_dev->fmt->mbus_code = fmt.format;
- csi_dev->fmt->width = fmt.width;
- csi_dev->fmt->height = fmt.height;
- */
- csi_dev->ipi_dt = dt;
- dw_mipi_csi_set_ipi_fmt(csi_dev);
- /*
- if(fmt.height > 0 && fmt.width > 0) {
- csi_dev->hw.ipi_color_mode = COLOR16;
- csi_dev->hw.ipi_auto_flush = 1;
- csi_dev->hw.ipi_adv_features = LINE_EVENT_SELECTION(EVSELAUTO);
- csi_dev->hw.htotal = fmt.width + csi_dev->hw.hsa + csi_dev->hw.hbp + csi_dev->hw.hsd;
- csi_dev->hw.vactive = fmt.height;
- csi_dev->hw.output = 0;
- }
- */
- return 0;
- }
- int bm_csi_get_fmt(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- struct csi_format_context fmt;
- bm_info("%s: \n", __func__);
- fmt.format = csi_dev->fmt->mbus_code;
- fmt.height = csi_dev->fmt->height;
- fmt.width = csi_dev->fmt->width;
- check_retval(copy_to_user(args, &fmt, sizeof(fmt)));
- return 0;
- }
- int bm_csi_set_vc_select(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct csi_vc_select_context vc;
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- bm_info("%s: \n", __func__);
- check_retval(copy_from_user(&vc, args, sizeof(vc)));
- if (vc.ipi_idx == 1) {
- csi_dev->hw.virtual_ch = vc.vc_ch;
- } else if (vc.ipi_idx == 2) {
- csi_dev->hw.ipi2_virtual_ch = vc.vc_ch;
- } else if (vc.ipi_idx == 3) {
- csi_dev->hw.ipi3_virtual_ch = vc.vc_ch;
- }
- return 0;
- }
- int bm_csi_ipi_enable(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- int ipi_idx;
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- bm_info("%s: \n", __func__);
- if (!bm_csi_can_enable(drvdata)) {
- printk("can't enable csi ipi!!!!!!!!!!!!!\n");
- return -1;
- }
- check_retval(copy_from_user(&ipi_idx, args, sizeof(ipi_idx)));
- if (ipi_idx == 1) {
- csi_dev->hw.ipi1_en = true;
- } else if (ipi_idx == 2) {
- csi_dev->hw.ipi2_en = true;
- } else if (ipi_idx == 3) {
- csi_dev->hw.ipi3_en = true;
- }
- dw_mipi_csi_start(csi_dev);
- return 0;
- }
- int bm_csi_ipi_disable(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- int ipi_idx;
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- bm_info("%s: \n", __func__);
- check_retval(copy_from_user(&ipi_idx, args, sizeof(ipi_idx)));
- if (ipi_idx == 1) {
- csi_dev->hw.ipi1_en = 0;
- } else if (ipi_idx == 2) {
- csi_dev->hw.ipi2_en = 0;
- } else if (ipi_idx == 3) {
- csi_dev->hw.ipi3_en = 0;
- }
- dw_mipi_csi_stop(csi_dev);
- return 0;
- }
- int bm_csi_get_vc_select(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct csi_vc_select_context vc;
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- bm_info("%s: \n", __func__);
- if (vc.ipi_idx == 1) {
- vc.vc_ch = csi_dev->hw.virtual_ch;
- } else if (vc.ipi_idx == 2) {
- vc.vc_ch = csi_dev->hw.ipi2_virtual_ch;
- } else if (vc.ipi_idx == 3) {
- vc.vc_ch = csi_dev->hw.ipi3_virtual_ch;
- }
- check_retval(copy_to_user(args, &vc, sizeof(vc)));
- return 0;
- }
- int bm_csi_set_lane_cfg(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- bm_info("%s: \n", __func__);
- check_retval(copy_from_user(&csi_dev->hw.num_lanes, args, sizeof(csi_dev->hw.num_lanes)));
- return 0;
- }
- typedef struct {
- int ipi_idx;
- int val;
- } dw_csi_hsx_cfg_t;
- int bm_csi_set_hsa(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- dw_csi_hsx_cfg_t cfg;
- bm_info("%s: \n", __func__);
- check_retval(copy_from_user(&cfg, args, sizeof(cfg)));
- if (cfg.ipi_idx == 1) {
- csi_dev->hw.hsa = cfg.val;
- } else if(cfg.ipi_idx == 2) {
- csi_dev->hw.ipi2_hsa = cfg.val;
- } else if(cfg.ipi_idx == 3) {
- csi_dev->hw.ipi3_hsa = cfg.val;
- } else {
- return -1;
- }
- return 0;
- }
- int bm_csi_set_hbp(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- dw_csi_hsx_cfg_t cfg;
- bm_info("%s: \n", __func__);
- check_retval(copy_from_user(&cfg, args, sizeof(cfg)));
- if (cfg.ipi_idx == 1) {
- csi_dev->hw.hbp = cfg.val;
- } else if(cfg.ipi_idx == 2) {
- csi_dev->hw.ipi2_hbp = cfg.val;
- } else if(cfg.ipi_idx == 3) {
- csi_dev->hw.ipi3_hbp = cfg.val;
- } else {
- return -1;
- }
- return 0;
- }
- int bm_csi_set_hsd(struct bm_csi_drvdata *drvdata, void *__user args)
- {
- struct dw_csi *csi_dev = &drvdata->csi_dev;
- dw_csi_hsx_cfg_t cfg;
- bm_info("%s: \n", __func__);
- check_retval(copy_from_user(&cfg, args, sizeof(cfg)));
- if (cfg.ipi_idx == 1) {
- csi_dev->hw.hsd = cfg.val;
- } else if(cfg.ipi_idx == 2) {
- csi_dev->hw.ipi2_hsd = cfg.val;
- } else if(cfg.ipi_idx == 3) {
- csi_dev->hw.ipi3_hsd = cfg.val;
- } else {
- return -1;
- }
- return 0;
- }
|