bm_csi_hw.c 3.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155
  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 "dw-dphy-rx.h"
  34. #include "bm_csi_dphy.h"
  35. #define check_retval(x)\
  36. do {\
  37. if ((x))\
  38. return -EIO;\
  39. } while (0)
  40. int bm_csi_write_reg(struct bm_csi_drvdata *drvdata, void *__user args)
  41. {
  42. struct bm_csi_reg_t reg;
  43. check_retval(copy_from_user(&reg, args, sizeof(reg)));
  44. writel(reg.value, drvdata->base + reg.offset);
  45. bm_info("%s addr 0x%08x val 0x%08x\n", __func__, reg.offset, reg.value);
  46. return 0;
  47. }
  48. int bm_csi_read_reg(struct bm_csi_drvdata *drvdata, void *__user args)
  49. {
  50. struct bm_csi_reg_t reg;
  51. check_retval(copy_from_user(&reg, args, sizeof(reg)));
  52. reg.value = readl(drvdata->base + reg.offset);
  53. check_retval(copy_to_user(args, &reg, sizeof(reg)));
  54. bm_info("%s addr 0x%08x val 0x%08x\n", __func__, reg.offset, reg.value);
  55. return 0;
  56. }
  57. int bm_csi_init(struct bm_csi_drvdata *drvdata, void *__user args)
  58. {
  59. bm_info("%s: csi init\n", __func__);
  60. return 0;
  61. }
  62. int bm_csi_exit(struct bm_csi_drvdata *drvdata, void *__user args)
  63. {
  64. bm_info("%s: csi exit\n", __func__);
  65. return 0;
  66. }
  67. int bm_csi_reset(struct bm_csi_drvdata *drvdata, void *__user args)
  68. {
  69. bm_info("%s: csi reset success\n", __func__);
  70. dw_csi_soc_reset(drvdata->reset);
  71. //bm_csi_dphy_reset();
  72. return 0;
  73. }
  74. static int csi_power_on_sta = 0;
  75. int bm_csi_set_power(struct bm_csi_drvdata *drvdata, void *__user args)
  76. {
  77. bm_info("%s: csi set power\n", __func__);
  78. check_retval(copy_from_user(&csi_power_on_sta, args, sizeof(csi_power_on_sta)));
  79. dw_mipi_csi_s_power(&drvdata->csi_dev, csi_power_on_sta);
  80. return 0;
  81. }
  82. int bm_csi_get_power(struct bm_csi_drvdata *drvdata, void *__user args)
  83. {
  84. bm_info("%s: csi get power\n", __func__);
  85. check_retval(copy_to_user(args, &csi_power_on_sta, sizeof(csi_power_on_sta)));
  86. return 0;
  87. }
  88. int bm_csi_set_clock(struct bm_csi_drvdata *drvdata, void *__user args)
  89. {
  90. bm_info("%s: \n", __func__);
  91. check_retval(copy_to_user(args, &csi_power_on_sta, sizeof(csi_power_on_sta)));
  92. return 0;
  93. }
  94. int bm_csi_get_clock(struct bm_csi_drvdata *drvdata, void *__user args)
  95. {
  96. bm_info("%s: \n", __func__);
  97. return 0;
  98. }
  99. int bm_csi_set_stream(struct bm_csi_drvdata *drvdata, void *__user args)
  100. {
  101. bm_info("%s: \n", __func__);
  102. return 0;
  103. }
  104. int bm_csi_get_stream(struct bm_csi_drvdata *drvdata, void *__user args)
  105. {
  106. bm_info("%s: \n", __func__);
  107. return 0;
  108. }
  109. int bm_csi_set_fmt(struct bm_csi_drvdata *drvdata, void *__user args)
  110. {
  111. bm_info("%s: \n", __func__);
  112. return 0;
  113. }
  114. int bm_csi_get_fmt(struct bm_csi_drvdata *drvdata, void *__user args)
  115. {
  116. bm_info("%s: \n", __func__);
  117. return 0;
  118. }
  119. int bm_csi_set_vc_select(struct bm_csi_drvdata *drvdata, void *__user args)
  120. {
  121. bm_info("%s: \n", __func__);
  122. return 0;
  123. }
  124. int bm_csi_get_vc_select(struct bm_csi_drvdata *drvdata, void *__user args)
  125. {
  126. bm_info("%s: \n", __func__);
  127. return 0;
  128. }
  129. int bm_csi_set_lane_cfg(struct bm_csi_drvdata *drvdata, void *__user args)
  130. {
  131. bm_info("%s: \n", __func__);
  132. return 0;
  133. }