bm_csi_driver.c 8.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331
  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/of.h>
  30. #include "bm_printk.h"
  31. #include "bm_csi_ioctl.h"
  32. #include "bm_csi_hw.h"
  33. #include "bm_csi_dphy.h"
  34. //#include "dw-csi-plat.h"
  35. #define BM_DRIVER_NAME "vivcsi"
  36. #define BM_DRIVER_MAXCNT 3
  37. static struct class *bm_driver_class;
  38. static unsigned int bm_driver_major = 0;
  39. static unsigned int bm_driver_minor = 0;
  40. static unsigned int device_register_index = 0;
  41. #define check_retval(x)\
  42. do {\
  43. if ((x))\
  44. return -EIO;\
  45. } while (0)
  46. static unsigned int bm_csi_poll(struct file * filp, poll_table *wait)
  47. {
  48. return 0;
  49. }
  50. void bm_csi_work(struct work_struct *work)
  51. {
  52. }
  53. irqreturn_t bm_csi_irq(int irq, void *dev_id)
  54. {
  55. bm_info("enter %s\n", __func__);
  56. return IRQ_HANDLED;
  57. }
  58. static int bm_csi_open(struct inode * inode, struct file * file)
  59. {
  60. struct bm_csi_drvdata *drvdata;
  61. bm_info("enter %s\n", __func__);
  62. drvdata = container_of(inode->i_cdev, struct bm_csi_drvdata, cdev);
  63. file->private_data = drvdata;
  64. return 0;
  65. };
  66. static long bm_csi_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
  67. {
  68. long ret = 0;
  69. struct bm_csi_drvdata *drvdata;
  70. bm_info("enter %s\n", __func__);
  71. drvdata = file->private_data;
  72. if (drvdata == NULL) {
  73. bm_err("%s:file private is null point error\n", __func__);
  74. return -ENOMEM;
  75. }
  76. mutex_lock(&drvdata->mutex);
  77. switch (cmd) {
  78. case BMCSI_IOC_WRITE_REG:
  79. ret = bm_csi_write_reg(drvdata, (void *)arg);
  80. break;
  81. case BMCSI_IOC_READ_REG:
  82. ret = bm_csi_read_reg(drvdata, (void *)arg);
  83. break;
  84. case BMCSI_IOC_INIT:
  85. ret = bm_csi_init(drvdata, (void *)arg);
  86. break;
  87. case BMCSI_IOC_EXIT:
  88. ret = bm_csi_exit(drvdata, (void *)arg);
  89. break;
  90. case BMCSI_IOC_S_RESET:
  91. ret = bm_csi_reset(drvdata, (void *)arg);
  92. break;
  93. case BMCSI_IOC_S_POWER:
  94. ret = bm_csi_set_power(drvdata, (void *)arg);
  95. break;
  96. case BMCSI_IOC_G_POWER:
  97. ret = bm_csi_get_power(drvdata, (void *)arg);
  98. break;
  99. case BMCSI_IOC_S_CLOCK:
  100. ret = bm_csi_set_clock(drvdata, (void *)arg);
  101. break;
  102. case BMCSI_IOC_G_CLOCK:
  103. ret = bm_csi_get_clock(drvdata, (void *)arg);
  104. break;
  105. case BMCSI_IOC_S_STREAM:
  106. ret = bm_csi_set_stream(drvdata, (void *)arg);
  107. break;
  108. case BMCSI_IOC_G_STREAM:
  109. ret = bm_csi_get_stream(drvdata, (void *)arg);
  110. break;
  111. case BMCSI_IOC_S_FMT:
  112. ret = bm_csi_set_fmt(drvdata, (void *)arg);
  113. break;
  114. case BMCSI_IOC_G_FMT:
  115. ret = bm_csi_get_fmt(drvdata, (void *)arg);
  116. break;
  117. case BMCSI_IOC_S_VC_SELECT:
  118. ret = bm_csi_set_vc_select(drvdata, (void *)arg);
  119. break;
  120. case BMCSI_IOC_G_VC_SELECT:
  121. ret = bm_csi_get_vc_select(drvdata, (void *)arg);
  122. break;
  123. case BMCSI_IOC_S_LANE_CFG:
  124. ret = bm_csi_set_lane_cfg(drvdata, (void *)arg);
  125. break;
  126. case BMCSI_IOC_MAX:
  127. break;
  128. default:
  129. ret = -EPERM;
  130. bm_err("%s: unsupported command %d", __func__, cmd);
  131. break;
  132. }
  133. mutex_unlock(&drvdata->mutex);
  134. return ret;
  135. };
  136. static int bm_csi_release(struct inode * inode, struct file * file)
  137. {
  138. bm_info("enter %s\n", __func__);
  139. return 0;
  140. };
  141. static int bm_csi_mmap(struct file *pFile, struct vm_area_struct *vma)
  142. {
  143. bm_info("enter %s\n", __func__);
  144. return 0;
  145. };
  146. struct file_operations bm_csi_fops = {
  147. .owner = THIS_MODULE,
  148. .open = bm_csi_open,
  149. .release = bm_csi_release,
  150. .unlocked_ioctl = bm_csi_ioctl,
  151. .mmap = bm_csi_mmap,
  152. .poll = bm_csi_poll,
  153. };
  154. static int bm_csi_probe(struct platform_device *pdev)
  155. {
  156. int ret = 0;
  157. struct bm_csi_drvdata *drvdata;
  158. struct resource *iores_mem;
  159. void __iomem *visys_addr;
  160. u32 value;
  161. bm_info("enter %s\n", __func__);
  162. pdev->id = device_register_index;
  163. if (pdev->id >= BM_DRIVER_MAXCNT) {
  164. bm_err("%s:pdev id is %d error\n", __func__, pdev->id);
  165. return -EINVAL;
  166. }
  167. drvdata = devm_kzalloc(&pdev->dev,sizeof(struct bm_csi_drvdata), GFP_KERNEL);
  168. if (drvdata == NULL) {
  169. bm_err("%s:alloc struct drvdata error\n", __func__);
  170. return -ENOMEM;
  171. }
  172. iores_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  173. drvdata->base = devm_ioremap_resource(&pdev->dev, iores_mem);
  174. bm_info("%s: [%s%d]: drvdata->base=0x%px, phy_addr base=0x%llx\n", __func__,
  175. BM_DRIVER_NAME, pdev->id, drvdata->base, iores_mem->start);
  176. drvdata->device_idx = pdev->id;
  177. mutex_init(&drvdata->mutex);
  178. drvdata->irq_num = platform_get_irq(pdev, 0);
  179. bm_info("%s:[%s%d]: pdriver_dev->irq_num=%d\n", __func__, "BM_CSI", pdev->id, drvdata->irq_num);
  180. platform_set_drvdata(pdev, drvdata);
  181. if (pdev->id == 0) {
  182. if (bm_driver_major == 0) {
  183. ret = alloc_chrdev_region(&drvdata->devt, 0, BM_DRIVER_MAXCNT, BM_DRIVER_NAME);
  184. if (ret != 0) {
  185. bm_err("%s:alloc_chrdev_region error\n", __func__);
  186. return ret;
  187. }
  188. bm_driver_major = MAJOR(drvdata->devt);
  189. bm_driver_minor = MINOR(drvdata->devt);
  190. } else {
  191. drvdata->devt = MKDEV(bm_driver_major, bm_driver_minor);
  192. ret = register_chrdev_region(drvdata->devt, BM_DRIVER_MAXCNT, BM_DRIVER_NAME);
  193. if (ret) {
  194. bm_err("%s:register_chrdev_region error\n", __func__);
  195. return ret;
  196. }
  197. }
  198. bm_driver_class = class_create(THIS_MODULE, BM_DRIVER_NAME);
  199. if (IS_ERR(bm_driver_class)) {
  200. bm_err("%s[%d]:class_create error!\n", __func__, __LINE__);
  201. return -EINVAL;
  202. }
  203. }
  204. drvdata->devt = MKDEV(bm_driver_major, bm_driver_minor + pdev->id);
  205. cdev_init(&drvdata->cdev, &bm_csi_fops);
  206. ret = cdev_add(&drvdata->cdev, drvdata->devt, 1);
  207. if ( ret ) {
  208. bm_err("%s[%d]:cdev_add error!\n", __func__, __LINE__);
  209. return ret;
  210. } else {
  211. bm_info("%s[%d]:cdev_add OK, major=%d, minor=%d\n", __func__, __LINE__,
  212. bm_driver_major, bm_driver_minor + pdev->id);
  213. }
  214. drvdata->class = bm_driver_class;
  215. device_create(drvdata->class, NULL, drvdata->devt,
  216. drvdata, "%s%d", BM_DRIVER_NAME, pdev->id);
  217. /*read version*/
  218. value = readl(drvdata->base + 0x0);
  219. bm_info("offset=04, value is:0x%08x\n", value);
  220. //visys_addr = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  221. visys_addr = devm_platform_ioremap_resource(pdev, 1);
  222. dw_dphy_rx_probe(pdev, visys_addr);
  223. drvdata->reset = visys_addr;
  224. dw_csi_probe(pdev);
  225. device_register_index++;
  226. bm_info("exit %s:[%s%d]\n", __func__, BM_DRIVER_NAME, pdev->id);
  227. return 0;
  228. }
  229. static int bm_csi_remove(struct platform_device *pdev)
  230. {
  231. struct bm_csi_drvdata *drvdata;
  232. bm_info("enter %s\n", __func__);
  233. dw_dphy_rx_remove(pdev);
  234. dw_csi_remove(pdev);
  235. device_register_index--;
  236. drvdata = platform_get_drvdata(pdev);
  237. free_irq(drvdata->irq_num, drvdata);
  238. cdev_del(&drvdata->cdev);
  239. device_destroy(drvdata->class, drvdata->devt);
  240. unregister_chrdev_region(drvdata->devt, BM_DRIVER_MAXCNT);
  241. mutex_destroy(&drvdata->mutex);
  242. if (device_register_index == 0) {
  243. class_destroy(drvdata->class);
  244. }
  245. devm_kfree(&pdev->dev, drvdata);
  246. bm_info("exit %s\n", __func__);
  247. return 0;
  248. }
  249. static const struct of_device_id bm_csi_of_match[] = {
  250. { .compatible = "thead,light-bm-csi", },
  251. { /* sentinel */ },
  252. };
  253. static struct platform_driver bm_csi_driver = {
  254. .probe = bm_csi_probe,
  255. .remove = bm_csi_remove,
  256. .driver = {
  257. .name = BM_DRIVER_NAME,
  258. .owner = THIS_MODULE,
  259. .of_match_table = of_match_ptr(bm_csi_of_match),
  260. }
  261. };
  262. static int __init bm_csi_init_module(void)
  263. {
  264. int ret = 0;
  265. bm_info("enter %s\n", __func__);
  266. ret = platform_driver_register(&bm_csi_driver);
  267. if (ret) {
  268. bm_err("register platform driver failed.\n");
  269. return ret;
  270. }
  271. return ret;
  272. }
  273. static void __exit bm_csi_exit_module(void)
  274. {
  275. bm_info("enter %s\n", __func__);
  276. platform_driver_unregister(&bm_csi_driver);
  277. }
  278. module_init(bm_csi_init_module);
  279. module_exit(bm_csi_exit_module);
  280. MODULE_AUTHOR("Liu Yitong");
  281. MODULE_DESCRIPTION("BAREMETAL-CSI");
  282. MODULE_LICENSE("GPL");