bm_csi_driver.c 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557
  1. /*
  2. * Copyright (C) 2021 Alibaba Group Holding Limited
  3. * Author: liuyitong <yitong.lyt@alibaba-inc.com>
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License version 2 as
  7. * published by the Free Software Foundation.
  8. */
  9. #include <asm/io.h>
  10. #include <linux/cdev.h>
  11. #include <linux/module.h>
  12. #include <linux/platform_device.h>
  13. #include <linux/delay.h>
  14. #include <linux/clk.h>
  15. #include <linux/io.h>
  16. #include <linux/mm.h>
  17. #include <linux/timer.h>
  18. #include <linux/kernel.h>
  19. #include <linux/init.h>
  20. #include <linux/ioctl.h>
  21. #include <linux/poll.h>
  22. #include <linux/workqueue.h>
  23. #include <linux/slab.h>
  24. #include <linux/proc_fs.h>
  25. #include <linux/debugfs.h>
  26. #include <linux/miscdevice.h>
  27. #include <linux/uaccess.h>
  28. #include <linux/interrupt.h>
  29. #include <linux/pm_runtime.h>
  30. #include <linux/of.h>
  31. #include <linux/mfd/syscon.h>
  32. #include "bm_printk.h"
  33. #include "bm_csi_ioctl.h"
  34. #include "bm_csi_hw.h"
  35. #include "bm_csi_dphy.h"
  36. #define BM_DRIVER_NAME "bm_csi"
  37. #define BM_DRIVER_MAXCNT 3
  38. static struct class *bm_driver_class;
  39. static unsigned int bm_driver_major = 0;
  40. static unsigned int bm_driver_minor = 0;
  41. static unsigned int device_register_index = 0;
  42. #define check_retval(x)\
  43. do {\
  44. if ((x))\
  45. return -EIO;\
  46. } while (0)
  47. extern unsigned csi_poll(struct file *file, struct poll_table_struct *wait);
  48. static unsigned int bm_csi_poll(struct file * filp, struct poll_table_struct *wait)
  49. {
  50. return csi_poll(filp, wait);
  51. }
  52. void bm_csi_work(struct work_struct *work)
  53. {
  54. }
  55. irqreturn_t bm_csi_irq(int irq, void *dev_id)
  56. {
  57. bm_info("enter %s\n", __func__);
  58. return IRQ_HANDLED;
  59. }
  60. static int bm_csi_runtime_suspend(struct device *dev)
  61. {
  62. struct bm_csi_drvdata *pdriver_dev = dev_get_drvdata(dev);
  63. bm_info("enter %s\n", __func__);
  64. if (pdriver_dev->pclk != NULL) {
  65. clk_disable_unprepare(pdriver_dev->pclk);
  66. }
  67. if (pdriver_dev->pixclk!= NULL) {
  68. clk_disable_unprepare(pdriver_dev->pixclk);
  69. }
  70. if (pdriver_dev->cfg_clk0!= NULL) {
  71. clk_disable_unprepare(pdriver_dev->cfg_clk0);
  72. }
  73. if (pdriver_dev->cfg_clk1!= NULL) {
  74. clk_disable_unprepare(pdriver_dev->cfg_clk1);
  75. }
  76. if (pdriver_dev->cfg_clk2!= NULL) {
  77. clk_disable_unprepare(pdriver_dev->cfg_clk2);
  78. }
  79. pr_info("exit %s\n", __func__);
  80. return 0;
  81. }
  82. static int bm_csi_runtime_resume(struct device *dev)
  83. {
  84. int ret = 0;
  85. struct bm_csi_drvdata *pdriver_dev = dev_get_drvdata(dev);
  86. bm_info("enter %s\n", __func__);
  87. if (pdriver_dev->pclk != NULL) {
  88. ret = clk_prepare_enable(pdriver_dev->pclk);
  89. if (ret < 0) {
  90. dev_err(dev, "could not prepare or enable csi pclk\n");
  91. clk_disable_unprepare(pdriver_dev->pclk);
  92. return -1;
  93. }
  94. }
  95. if (pdriver_dev->pixclk!= NULL) {
  96. ret = clk_prepare_enable(pdriver_dev->pixclk);
  97. if (ret < 0) {
  98. dev_err(dev, "could not prepare or enable pixclk\n");
  99. clk_disable_unprepare(pdriver_dev->pixclk);
  100. return -1;
  101. }
  102. }
  103. if (pdriver_dev->cfg_clk0 != NULL) {
  104. ret = clk_prepare_enable(pdriver_dev->cfg_clk0);
  105. if (ret < 0) {
  106. dev_err(dev, "could not prepare or enable cfg_clk0\n");
  107. clk_disable_unprepare(pdriver_dev->cfg_clk0);
  108. return -1;
  109. }
  110. }
  111. if (pdriver_dev->cfg_clk1 != NULL) {
  112. ret = clk_prepare_enable(pdriver_dev->cfg_clk1);
  113. if (ret < 0) {
  114. dev_err(dev, "could not prepare or enable cfg_clk1\n");
  115. clk_disable_unprepare(pdriver_dev->cfg_clk1);
  116. return -1;
  117. }
  118. }
  119. if (pdriver_dev->cfg_clk2 != NULL) {
  120. ret = clk_prepare_enable(pdriver_dev->cfg_clk2);
  121. if (ret < 0) {
  122. dev_err(dev, "could not prepare or enable cfg_clk2\n");
  123. clk_disable_unprepare(pdriver_dev->cfg_clk2);
  124. return -1;
  125. }
  126. }
  127. pr_info("%s csi Enabled clock\n", __func__);
  128. return 0;
  129. }
  130. static const struct dev_pm_ops bm_csi_runtime_pm_ops = {
  131. SET_RUNTIME_PM_OPS(bm_csi_runtime_suspend, bm_csi_runtime_resume, NULL)
  132. };
  133. static int bm_csi_open(struct inode * inode, struct file * file)
  134. {
  135. int ret = 0;
  136. struct bm_csi_drvdata *drvdata;
  137. struct device *dev;
  138. bm_info("enter %s\n", __func__);
  139. bm_info("open mipi-csi dev\n");
  140. drvdata = container_of(inode->i_cdev, struct bm_csi_drvdata, cdev);
  141. file->private_data = drvdata;
  142. dev = &drvdata->pdev->dev;
  143. drvdata->csi_power_on_sta = 0;
  144. memset(&drvdata->csi_dev.hw, 0, sizeof(drvdata->csi_dev.hw));
  145. drvdata->csi_dev.hw.ipi_mode = CAMERA_TIMING;
  146. drvdata->csi_dev.hw.ipi_color_mode = COLOR16;
  147. memset(&drvdata->csi_dev.error_mask, 0, sizeof(drvdata->csi_dev.error_mask));
  148. bm_info("open mipi-csi dev\n");
  149. if (pm_runtime_get_sync(dev)) {
  150. ret = bm_csi_runtime_resume(dev);
  151. if (ret)
  152. pr_err("fail to resume csi %s %d\n", __func__, __LINE__);
  153. }
  154. return 0;
  155. };
  156. static long bm_csi_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
  157. {
  158. long ret = 0;
  159. struct bm_csi_drvdata *drvdata;
  160. bm_info("enter %s\n", __func__);
  161. drvdata = file->private_data;
  162. if (drvdata == NULL) {
  163. bm_err("%s:file private is null point error\n", __func__);
  164. return -ENOMEM;
  165. }
  166. mutex_lock(&drvdata->mutex);
  167. switch (cmd) {
  168. case BMCSI_IOC_WRITE_REG:
  169. ret = bm_csi_write_reg(drvdata, (void *)arg);
  170. break;
  171. case BMCSI_IOC_READ_REG:
  172. ret = bm_csi_read_reg(drvdata, (void *)arg);
  173. break;
  174. case BMCSI_IOC_READ_ARRAY:
  175. ret = bm_csi_read_array(drvdata, (void *)arg);
  176. break;
  177. case BMCSI_IOC_S_RESET:
  178. ret = bm_csi_reset(drvdata, (void *)arg);
  179. break;
  180. case BMCSI_IOC_S_POWER:
  181. ret = bm_csi_set_power(drvdata, (void *)arg);
  182. break;
  183. case BMCSI_IOC_G_POWER:
  184. ret = bm_csi_get_power(drvdata, (void *)arg);
  185. break;
  186. case BMCSI_IOC_S_CLOCK:
  187. ret = bm_csi_set_clock(drvdata, (void *)arg);
  188. break;
  189. case BMCSI_IOC_G_CLOCK:
  190. ret = bm_csi_get_clock(drvdata, (void *)arg);
  191. break;
  192. case BMCSI_IOC_S_STREAM:
  193. ret = bm_csi_set_stream(drvdata, (void *)arg);
  194. break;
  195. case BMCSI_IOC_G_STREAM:
  196. ret = bm_csi_get_stream(drvdata, (void *)arg);
  197. break;
  198. case BMCSI_IOC_S_FMT:
  199. ret = bm_csi_set_fmt(drvdata, (void *)arg);
  200. break;
  201. case BMCSI_IOC_G_FMT:
  202. ret = bm_csi_get_fmt(drvdata, (void *)arg);
  203. break;
  204. case BMCSI_IOC_S_VC_SELECT:
  205. ret = bm_csi_set_vc_select(drvdata, (void *)arg);
  206. break;
  207. case BMCSI_IOC_G_VC_SELECT:
  208. ret = bm_csi_get_vc_select(drvdata, (void *)arg);
  209. break;
  210. case BMCSI_IOC_IPI_START:
  211. ret = bm_csi_ipi_enable(drvdata, (void *)arg);
  212. break;
  213. case BMCSI_IOC_IPI_STOP:
  214. ret = bm_csi_ipi_disable(drvdata, (void *)arg);
  215. break;
  216. case BMCSI_IOC_S_LANE_CFG:
  217. ret = bm_csi_set_lane_cfg(drvdata, (void *)arg);
  218. break;
  219. case BMCSI_IOC_S_HSA_CFG:
  220. ret = bm_csi_set_hsa(drvdata, (void *)arg);
  221. break;
  222. case BMCSI_IOC_S_HBP_CFG:
  223. ret = bm_csi_set_hbp(drvdata, (void *)arg);
  224. break;
  225. case BMCSI_IOC_S_HSD_CFG:
  226. ret = bm_csi_set_hsd(drvdata, (void *)arg);
  227. break;
  228. case BMCSI_IOC_SET_PIXCLK:
  229. ret = bm_csi_set_pixclk(drvdata, (void *)arg);
  230. break;
  231. case BMCSI_IOC_GET_PIXCLK:
  232. ret = bm_csi_get_pixclk(drvdata, (void *)arg);
  233. break;
  234. case BMCSI_IOC_GET_ERROR:
  235. ret = bm_csi_get_error(drvdata, (void *)arg);
  236. break;
  237. case BMCSI_IOC_MAX:
  238. break;
  239. default:
  240. ret = -EPERM;
  241. bm_err("%s: unsupported command %d", __func__, cmd);
  242. break;
  243. }
  244. mutex_unlock(&drvdata->mutex);
  245. return ret;
  246. };
  247. static int bm_csi_release(struct inode * inode, struct file * file)
  248. {
  249. int ret = 0;
  250. struct bm_csi_drvdata *drvdata;
  251. struct device *dev;
  252. bm_info("enter %s\n", __func__);
  253. drvdata = container_of(inode->i_cdev, struct bm_csi_drvdata, cdev);
  254. file->private_data = drvdata;
  255. dev = &drvdata->pdev->dev;
  256. bm_info("release mipi-csi dev\n");
  257. ret = bm_csi_dis_power(drvdata);
  258. if (ret) {
  259. pr_info("fail to disable csi power, %s %d\n", __func__, __LINE__);
  260. }
  261. ret = pm_runtime_put_sync(dev);
  262. if (ret) {
  263. pr_info("fail to resume csi %s %d\n", __func__, __LINE__);
  264. }
  265. return 0;
  266. };
  267. static int bm_csi_mmap(struct file *pFile, struct vm_area_struct *vma)
  268. {
  269. bm_info("enter %s\n", __func__);
  270. return 0;
  271. };
  272. struct file_operations bm_csi_fops = {
  273. .owner = THIS_MODULE,
  274. .open = bm_csi_open,
  275. .release = bm_csi_release,
  276. .unlocked_ioctl = bm_csi_ioctl,
  277. .mmap = bm_csi_mmap,
  278. .poll = bm_csi_poll,
  279. };
  280. static int bm_csi_probe(struct platform_device *pdev)
  281. {
  282. int ret = 0;
  283. struct bm_csi_drvdata *drvdata;
  284. struct resource *iores_mem;
  285. unsigned int dphyglueiftester= 0;
  286. unsigned int sysreg_mipi_csi_ctrl = 0;
  287. struct device_node *np = pdev->dev.of_node;
  288. u32 value;
  289. bm_info("enter %s\n", __func__);
  290. pdev->id = device_register_index;
  291. if (pdev->id >= BM_DRIVER_MAXCNT) {
  292. bm_err("%s:pdev id is %d error\n", __func__, pdev->id);
  293. return -EINVAL;
  294. }
  295. drvdata = devm_kzalloc(&pdev->dev,sizeof(struct bm_csi_drvdata), GFP_KERNEL);
  296. if (drvdata == NULL) {
  297. bm_err("%s:alloc struct drvdata error\n", __func__);
  298. return -ENOMEM;
  299. }
  300. memset(drvdata, 0, sizeof(*drvdata));
  301. iores_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  302. drvdata->base = devm_ioremap_resource(&pdev->dev, iores_mem);
  303. bm_info("%s: [%s%d]: drvdata->base=0x%px, phy_addr base=0x%llx\n", __func__,
  304. BM_DRIVER_NAME, pdev->id, drvdata->base, iores_mem->start);
  305. /*
  306. if (iores_mem->start == 0xffe4010000) {
  307. drvdata->visys_clk_reg = syscon_regmap_lookup_by_phandle(np, "visys-regmap");
  308. if (IS_ERR(drvdata->visys_clk_reg)) {
  309. drvdata->visys_clk_reg = NULL;
  310. dev_err(&pdev->dev, "cannot find regmap for visys clk register\n");
  311. }
  312. drvdata->csia_reg = syscon_regmap_lookup_by_phandle(np, "csia-regmap");
  313. if (IS_ERR(drvdata->csia_reg)) {
  314. drvdata->csia_reg = NULL;
  315. dev_err(&pdev->dev, "cannot find regmap for csia register\n");
  316. }
  317. }
  318. */
  319. const char *phy_name;
  320. ret = of_property_read_string(np, "phy_name", &phy_name);
  321. if (strcmp(phy_name, "CSI_B") == 0) {
  322. bm_info("mipi is b phy\n");
  323. drvdata->phy_id = MIPI_B_PHY;
  324. } else if(strcmp(phy_name, "CSI_A") == 0) {
  325. bm_info("mipi is a phy\n");
  326. drvdata->phy_id = MIPI_A_PHY;
  327. } else if(strcmp(phy_name, "CSI_4LANE") == 0) {
  328. bm_info("mipi is 4lane phy\n");
  329. drvdata->phy_id = MIPI_4LANE_PHY;
  330. }
  331. drvdata->reset = NULL;
  332. drvdata->device_idx = pdev->id;
  333. mutex_init(&drvdata->mutex);
  334. drvdata->irq_num = platform_get_irq(pdev, 0);
  335. bm_info("%s:[%s%d]: pdriver_dev->irq_num=%d\n", __func__, "BM_CSI", pdev->id, drvdata->irq_num);
  336. drvdata->pdev = pdev;
  337. /*parse clk info from dts*/
  338. drvdata->pclk = devm_clk_get(&pdev->dev, "pclk");
  339. if (IS_ERR(drvdata->pclk)) {
  340. dev_err(&pdev->dev, "failed to get pclk");
  341. drvdata->pclk = NULL;
  342. }
  343. drvdata->pixclk = devm_clk_get(&pdev->dev, "pixclk");
  344. if (IS_ERR(drvdata->pixclk)) {
  345. dev_err(&pdev->dev, "failed to get pixclk");
  346. drvdata->pixclk = NULL;
  347. }
  348. drvdata->cfg_clk0 = devm_clk_get(&pdev->dev, "cfg_clk0");
  349. if (IS_ERR(drvdata->cfg_clk0)) {
  350. dev_err(&pdev->dev, "failed to get cfg_clk0");
  351. drvdata->cfg_clk0 = NULL;
  352. }
  353. drvdata->cfg_clk1 = devm_clk_get(&pdev->dev, "cfg_clk1");
  354. if (IS_ERR(drvdata->cfg_clk1)) {
  355. dev_err(&pdev->dev, "failed to get cfg_clk1");
  356. drvdata->cfg_clk1 = NULL;
  357. }
  358. drvdata->cfg_clk2 = devm_clk_get(&pdev->dev, "cfg_clk2");
  359. if (IS_ERR(drvdata->cfg_clk2)) {
  360. dev_err(&pdev->dev, "failed to get cfg_clk2");
  361. drvdata->cfg_clk2 = NULL;
  362. }
  363. platform_set_drvdata(pdev, drvdata);
  364. if (pdev->id == 0) {
  365. if (bm_driver_major == 0) {
  366. ret = alloc_chrdev_region(&drvdata->devt, 0, BM_DRIVER_MAXCNT, BM_DRIVER_NAME);
  367. if (ret != 0) {
  368. bm_err("%s:alloc_chrdev_region error\n", __func__);
  369. return ret;
  370. }
  371. bm_driver_major = MAJOR(drvdata->devt);
  372. bm_driver_minor = MINOR(drvdata->devt);
  373. } else {
  374. drvdata->devt = MKDEV(bm_driver_major, bm_driver_minor);
  375. ret = register_chrdev_region(drvdata->devt, BM_DRIVER_MAXCNT, BM_DRIVER_NAME);
  376. if (ret) {
  377. bm_err("%s:register_chrdev_region error\n", __func__);
  378. return ret;
  379. }
  380. }
  381. bm_driver_class = class_create(THIS_MODULE, BM_DRIVER_NAME);
  382. if (IS_ERR(bm_driver_class)) {
  383. bm_err("%s[%d]:class_create error!\n", __func__, __LINE__);
  384. return -EINVAL;
  385. }
  386. }
  387. drvdata->devt = MKDEV(bm_driver_major, bm_driver_minor + pdev->id);
  388. cdev_init(&drvdata->cdev, &bm_csi_fops);
  389. ret = cdev_add(&drvdata->cdev, drvdata->devt, 1);
  390. if ( ret ) {
  391. bm_err("%s[%d]:cdev_add error!\n", __func__, __LINE__);
  392. return ret;
  393. } else {
  394. bm_info("%s[%d]:cdev_add OK, major=%d, minor=%d\n", __func__, __LINE__,
  395. bm_driver_major, bm_driver_minor + pdev->id);
  396. }
  397. drvdata->class = bm_driver_class;
  398. device_create(drvdata->class, NULL, drvdata->devt,
  399. drvdata, "%s%d", BM_DRIVER_NAME, pdev->id);
  400. /*read version*/
  401. value = readl(drvdata->base + 0x0);
  402. bm_info("offset=04, value is:0x%08x\n", value);
  403. device_property_read_u32(&pdev->dev, "dphyglueiftester", &dphyglueiftester);
  404. bm_info("dphyglueiftester is:0x%x\n", dphyglueiftester);
  405. device_property_read_u32(&pdev->dev, "sysreg_mipi_csi_ctrl", &sysreg_mipi_csi_ctrl);
  406. bm_info("sysreg_mipi_csi_ctrl is:0x%x\n", sysreg_mipi_csi_ctrl);
  407. pm_runtime_enable(&pdev->dev);
  408. ret = pm_runtime_get_sync(&pdev->dev);
  409. if (ret < 0) {
  410. dev_err(&pdev->dev, "fail to resume csi\n");
  411. }
  412. dw_dphy_rx_probe(pdev, dphyglueiftester, sysreg_mipi_csi_ctrl);
  413. dw_csi_probe(pdev);
  414. ret = pm_runtime_put_sync(&pdev->dev);
  415. if (ret < 0) {
  416. dev_err(&pdev->dev, "fail to suspend csi\n");
  417. }
  418. device_register_index++;
  419. bm_info("exit %s:[%s%d]\n", __func__, BM_DRIVER_NAME, pdev->id);
  420. return 0;
  421. }
  422. static int bm_csi_remove(struct platform_device *pdev)
  423. {
  424. struct bm_csi_drvdata *drvdata;
  425. bm_info("enter %s\n", __func__);
  426. dw_dphy_rx_remove(pdev);
  427. dw_csi_remove(pdev);
  428. device_register_index--;
  429. drvdata = platform_get_drvdata(pdev);
  430. free_irq(drvdata->irq_num, drvdata);
  431. cdev_del(&drvdata->cdev);
  432. device_destroy(drvdata->class, drvdata->devt);
  433. unregister_chrdev_region(drvdata->devt, BM_DRIVER_MAXCNT);
  434. mutex_destroy(&drvdata->mutex);
  435. if (device_register_index == 0) {
  436. class_destroy(drvdata->class);
  437. }
  438. devm_kfree(&pdev->dev, drvdata);
  439. bm_info("exit %s\n", __func__);
  440. return 0;
  441. }
  442. static const struct of_device_id bm_csi_of_match[] = {
  443. { .compatible = "thead,light-bm-csi", },
  444. { /* sentinel */ },
  445. };
  446. MODULE_DEVICE_TABLE(of, bm_csi_of_match);
  447. static struct platform_driver bm_csi_driver = {
  448. .probe = bm_csi_probe,
  449. .remove = bm_csi_remove,
  450. .driver = {
  451. .name = BM_DRIVER_NAME,
  452. .owner = THIS_MODULE,
  453. .of_match_table = of_match_ptr(bm_csi_of_match),
  454. .pm = &bm_csi_runtime_pm_ops,
  455. }
  456. };
  457. static int __init bm_csi_init_module(void)
  458. {
  459. int ret = 0;
  460. bm_info("enter %s\n", __func__);
  461. ret = platform_driver_register(&bm_csi_driver);
  462. if (ret) {
  463. bm_err("register platform driver failed.\n");
  464. return ret;
  465. }
  466. return ret;
  467. }
  468. static void __exit bm_csi_exit_module(void)
  469. {
  470. bm_info("enter %s\n", __func__);
  471. platform_driver_unregister(&bm_csi_driver);
  472. }
  473. module_init(bm_csi_init_module);
  474. module_exit(bm_csi_exit_module);
  475. MODULE_AUTHOR("Liu Yitong");
  476. MODULE_DESCRIPTION("BAREMETAL-CSI");
  477. MODULE_LICENSE("GPL");