cam_compat.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2014-2021, The Linux Foundation. All rights reserved.
  4. * Copyright (c) 2022-2023 Qualcomm Innovation Center, Inc. All rights reserved.
  5. */
  6. #include <linux/dma-mapping.h>
  7. #include <linux/dma-buf.h>
  8. #include <linux/of_address.h>
  9. #include <linux/slab.h>
  10. #include <soc/qcom/rpmh.h>
  11. #include "cam_compat.h"
  12. #include "cam_debug_util.h"
  13. #include "cam_cpas_api.h"
  14. #include "camera_main.h"
  15. #include "cam_eeprom_dev.h"
  16. #include "cam_eeprom_core.h"
  17. #if IS_ENABLED(CONFIG_SPECTRA_USE_RPMH_DRV_API)
  18. #define CAM_RSC_DRV_IDENTIFIER "cam_rsc"
  19. const struct device *cam_cpas_get_rsc_dev_for_drv(uint32_t index)
  20. {
  21. const struct device *rsc_dev;
  22. rsc_dev = rpmh_get_device(CAM_RSC_DRV_IDENTIFIER, index);
  23. if (!rsc_dev) {
  24. CAM_ERR(CAM_CPAS, "Invalid dev for index: %u", index);
  25. return NULL;
  26. }
  27. return rsc_dev;
  28. }
  29. int cam_cpas_start_drv_for_dev(const struct device *dev)
  30. {
  31. int rc = 0;
  32. if (!dev) {
  33. CAM_ERR(CAM_CPAS, "Invalid dev for DRV enable");
  34. return -EINVAL;
  35. }
  36. rc = rpmh_drv_start(dev);
  37. if (rc) {
  38. CAM_ERR(CAM_CPAS, "[%s] Failed in DRV start", dev_name(dev));
  39. return rc;
  40. }
  41. return rc;
  42. }
  43. int cam_cpas_stop_drv_for_dev(const struct device *dev)
  44. {
  45. int rc = 0;
  46. if (!dev) {
  47. CAM_ERR(CAM_CPAS, "Invalid dev for DRV disable");
  48. return -EINVAL;
  49. }
  50. rc = rpmh_drv_stop(dev);
  51. if (rc) {
  52. CAM_ERR(CAM_CPAS, "[%s] Failed in DRV stop", dev_name(dev));
  53. return rc;
  54. }
  55. return rc;
  56. }
  57. int cam_cpas_drv_channel_switch_for_dev(const struct device *dev)
  58. {
  59. int rc = 0;
  60. if (!dev) {
  61. CAM_ERR(CAM_CPAS, "Invalid dev for DRV channel switch");
  62. return -EINVAL;
  63. }
  64. rc = rpmh_write_sleep_and_wake_no_child(dev);
  65. if (rc) {
  66. CAM_ERR(CAM_CPAS, "[%s] Failed in DRV channel switch", dev_name(dev));
  67. return rc;
  68. }
  69. return rc;
  70. }
  71. #else
  72. const struct device *cam_cpas_get_rsc_dev_for_drv(uint32_t index)
  73. {
  74. return NULL;
  75. }
  76. int cam_cpas_start_drv_for_dev(const struct device *dev)
  77. {
  78. return 0;
  79. }
  80. int cam_cpas_stop_drv_for_dev(const struct device *dev)
  81. {
  82. return 0;
  83. }
  84. int cam_cpas_drv_channel_switch_for_dev(const struct device *dev)
  85. {
  86. return 0;
  87. }
  88. #endif
  89. int cam_smmu_fetch_csf_version(struct cam_csf_version *csf_version)
  90. {
  91. #if KERNEL_VERSION(6, 0, 0) <= LINUX_VERSION_CODE
  92. struct csf_version csf_ver;
  93. int rc;
  94. /* Fetch CSF version from SMMU proxy driver */
  95. rc = smmu_proxy_get_csf_version(&csf_ver);
  96. if (rc) {
  97. CAM_ERR(CAM_SMMU,
  98. "Failed to get CSF version from SMMU proxy: %d", rc);
  99. return rc;
  100. }
  101. csf_version->arch_ver = csf_ver.arch_ver;
  102. csf_version->max_ver = csf_ver.max_ver;
  103. csf_version->min_ver = csf_ver.min_ver;
  104. #else
  105. /* This defaults to the legacy version */
  106. csf_version->arch_ver = 2;
  107. csf_version->max_ver = 0;
  108. csf_version->min_ver = 0;
  109. #endif
  110. return 0;
  111. }
  112. unsigned long cam_update_dma_map_attributes(unsigned long attrs)
  113. {
  114. #if KERNEL_VERSION(6, 0, 0) <= LINUX_VERSION_CODE
  115. attrs |= DMA_ATTR_QTI_SMMU_PROXY_MAP;
  116. #endif
  117. return attrs;
  118. }
  119. size_t cam_align_dma_buf_size(size_t len)
  120. {
  121. #if KERNEL_VERSION(6, 0, 0) <= LINUX_VERSION_CODE
  122. len = ALIGN(len, SMMU_PROXY_MEM_ALIGNMENT);
  123. #endif
  124. return len;
  125. }
  126. #if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 4, 0)
  127. int cam_reserve_icp_fw(struct cam_fw_alloc_info *icp_fw, size_t fw_length)
  128. {
  129. int rc = 0;
  130. struct device_node *of_node;
  131. struct device_node *mem_node;
  132. struct resource res;
  133. of_node = (icp_fw->fw_dev)->of_node;
  134. mem_node = of_parse_phandle(of_node, "memory-region", 0);
  135. if (!mem_node) {
  136. rc = -ENOMEM;
  137. CAM_ERR(CAM_SMMU, "FW memory carveout not found");
  138. goto end;
  139. }
  140. rc = of_address_to_resource(mem_node, 0, &res);
  141. of_node_put(mem_node);
  142. if (rc < 0) {
  143. CAM_ERR(CAM_SMMU, "Unable to get start of FW mem carveout");
  144. goto end;
  145. }
  146. icp_fw->fw_hdl = res.start;
  147. icp_fw->fw_kva = ioremap_wc(icp_fw->fw_hdl, fw_length);
  148. if (!icp_fw->fw_kva) {
  149. CAM_ERR(CAM_SMMU, "Failed to map the FW.");
  150. rc = -ENOMEM;
  151. goto end;
  152. }
  153. memset_io(icp_fw->fw_kva, 0, fw_length);
  154. end:
  155. return rc;
  156. }
  157. void cam_unreserve_icp_fw(struct cam_fw_alloc_info *icp_fw, size_t fw_length)
  158. {
  159. iounmap(icp_fw->fw_kva);
  160. }
  161. int cam_ife_notify_safe_lut_scm(bool safe_trigger)
  162. {
  163. const uint32_t smmu_se_ife = 0;
  164. uint32_t camera_hw_version, rc = 0;
  165. rc = cam_cpas_get_cpas_hw_version(&camera_hw_version);
  166. if (!rc && qcom_scm_smmu_notify_secure_lut(smmu_se_ife, safe_trigger)) {
  167. switch (camera_hw_version) {
  168. case CAM_CPAS_TITAN_170_V100:
  169. case CAM_CPAS_TITAN_170_V110:
  170. case CAM_CPAS_TITAN_175_V100:
  171. CAM_ERR(CAM_ISP, "scm call to enable safe failed");
  172. rc = -EINVAL;
  173. break;
  174. default:
  175. break;
  176. }
  177. }
  178. return rc;
  179. }
  180. void cam_cpastop_scm_write(struct cam_cpas_hw_errata_wa *errata_wa)
  181. {
  182. int reg_val;
  183. qcom_scm_io_readl(errata_wa->data.reg_info.offset, &reg_val);
  184. reg_val |= errata_wa->data.reg_info.value;
  185. qcom_scm_io_writel(errata_wa->data.reg_info.offset, reg_val);
  186. }
  187. static int camera_platform_compare_dev(struct device *dev, const void *data)
  188. {
  189. return platform_bus_type.match(dev, (struct device_driver *) data);
  190. }
  191. static int camera_i2c_compare_dev(struct device *dev, const void *data)
  192. {
  193. return i2c_bus_type.match(dev, (struct device_driver *) data);
  194. }
  195. #else
  196. int cam_reserve_icp_fw(struct cam_fw_alloc_info *icp_fw, size_t fw_length)
  197. {
  198. int rc = 0;
  199. icp_fw->fw_kva = dma_alloc_coherent(icp_fw->fw_dev, fw_length,
  200. &icp_fw->fw_hdl, GFP_KERNEL);
  201. if (!icp_fw->fw_kva) {
  202. CAM_ERR(CAM_SMMU, "FW memory alloc failed");
  203. rc = -ENOMEM;
  204. }
  205. return rc;
  206. }
  207. void cam_unreserve_icp_fw(struct cam_fw_alloc_info *icp_fw, size_t fw_length)
  208. {
  209. dma_free_coherent(icp_fw->fw_dev, fw_length, icp_fw->fw_kva,
  210. icp_fw->fw_hdl);
  211. }
  212. int cam_ife_notify_safe_lut_scm(bool safe_trigger)
  213. {
  214. const uint32_t smmu_se_ife = 0;
  215. uint32_t camera_hw_version, rc = 0;
  216. struct scm_desc description = {
  217. .arginfo = SCM_ARGS(2, SCM_VAL, SCM_VAL),
  218. .args[0] = smmu_se_ife,
  219. .args[1] = safe_trigger,
  220. };
  221. rc = cam_cpas_get_cpas_hw_version(&camera_hw_version);
  222. if (!rc && scm_call2(SCM_SIP_FNID(0x15, 0x3), &description)) {
  223. switch (camera_hw_version) {
  224. case CAM_CPAS_TITAN_170_V100:
  225. case CAM_CPAS_TITAN_170_V110:
  226. case CAM_CPAS_TITAN_175_V100:
  227. CAM_ERR(CAM_ISP, "scm call to enable safe failed");
  228. rc = -EINVAL;
  229. break;
  230. default:
  231. break;
  232. }
  233. }
  234. return rc;
  235. }
  236. void cam_cpastop_scm_write(struct cam_cpas_hw_errata_wa *errata_wa)
  237. {
  238. int reg_val;
  239. reg_val = scm_io_read(errata_wa->data.reg_info.offset);
  240. reg_val |= errata_wa->data.reg_info.value;
  241. scm_io_write(errata_wa->data.reg_info.offset, reg_val);
  242. }
  243. static int camera_platform_compare_dev(struct device *dev, void *data)
  244. {
  245. return platform_bus_type.match(dev, (struct device_driver *) data);
  246. }
  247. static int camera_i2c_compare_dev(struct device *dev, void *data)
  248. {
  249. return i2c_bus_type.match(dev, (struct device_driver *) data);
  250. }
  251. #endif
  252. #if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)
  253. void cam_free_clear(const void * ptr)
  254. {
  255. kfree_sensitive(ptr);
  256. }
  257. #else
  258. void cam_free_clear(const void * ptr)
  259. {
  260. kzfree(ptr);
  261. }
  262. #endif
  263. bool cam_is_mink_api_available(void)
  264. {
  265. #if KERNEL_VERSION(6, 0, 0) <= LINUX_VERSION_CODE
  266. return true;
  267. #else
  268. return false;
  269. #endif
  270. }
  271. #if KERNEL_VERSION(6, 0, 0) <= LINUX_VERSION_CODE
  272. int cam_csiphy_notify_secure_mode(struct csiphy_device *csiphy_dev,
  273. bool protect, int32_t offset)
  274. {
  275. int rc = 0;
  276. struct Object client_env, sc_object;
  277. ITCDriverSensorInfo params = {0};
  278. struct cam_csiphy_secure_info *secure_info;
  279. if (offset >= CSIPHY_MAX_INSTANCES_PER_PHY) {
  280. CAM_ERR(CAM_CSIPHY, "Invalid CSIPHY offset");
  281. return -EINVAL;
  282. }
  283. rc = get_client_env_object(&client_env);
  284. if (rc) {
  285. CAM_ERR(CAM_CSIPHY, "Failed getting mink env object, rc: %d", rc);
  286. return rc;
  287. }
  288. rc = IClientEnv_open(client_env, CTrustedCameraDriver_UID, &sc_object);
  289. if (rc) {
  290. CAM_ERR(CAM_CSIPHY, "Failed getting mink sc_object, rc: %d", rc);
  291. return rc;
  292. }
  293. secure_info = &csiphy_dev->csiphy_info[offset].secure_info;
  294. params.csid_hw_idx_mask = secure_info->csid_hw_idx_mask;
  295. params.cdm_hw_idx_mask = secure_info->cdm_hw_idx_mask;
  296. params.vc_mask = secure_info->vc_mask;
  297. params.phy_lane_sel_mask =
  298. csiphy_dev->csiphy_info[offset].csiphy_phy_lane_sel_mask;
  299. params.protect = protect ? 1 : 0;
  300. rc = ITrustedCameraDriver_dynamicProtectSensor(sc_object, &params);
  301. if (rc) {
  302. CAM_ERR(CAM_CSIPHY, "Mink secure call failed, rc: %d", rc);
  303. return rc;
  304. }
  305. rc = Object_release(sc_object);
  306. if (rc) {
  307. CAM_ERR(CAM_CSIPHY, "Failed releasing secure camera object, rc: %d", rc);
  308. return rc;
  309. }
  310. rc = Object_release(client_env);
  311. if (rc) {
  312. CAM_ERR(CAM_CSIPHY, "Failed releasing mink env object, rc: %d", rc);
  313. return rc;
  314. }
  315. return 0;
  316. }
  317. #elif KERNEL_VERSION(5, 4, 0) <= LINUX_VERSION_CODE
  318. int cam_csiphy_notify_secure_mode(struct csiphy_device *csiphy_dev,
  319. bool protect, int32_t offset)
  320. {
  321. int rc = 0;
  322. /**
  323. * A check here is made if the target is using
  324. * an older version of the kernel driver (< 6.0)
  325. * with domain id feature present. In this case,
  326. * we are to fail this call, as the new mink call
  327. * is only supported on kernel driver versions 6.0
  328. * and above, and the new domain id scheme is not
  329. * backwards compatible with the older scheme.
  330. */
  331. if (csiphy_dev->domain_id_security) {
  332. CAM_ERR(CAM_CSIPHY,
  333. "Domain id support not present on current kernel driver: %d",
  334. LINUX_VERSION_CODE);
  335. return -EINVAL;
  336. }
  337. if (offset >= CSIPHY_MAX_INSTANCES_PER_PHY) {
  338. CAM_ERR(CAM_CSIPHY, "Invalid CSIPHY offset");
  339. rc = -EINVAL;
  340. } else if (qcom_scm_camera_protect_phy_lanes(protect,
  341. csiphy_dev->csiphy_info[offset].csiphy_cpas_cp_reg_mask)) {
  342. CAM_ERR(CAM_CSIPHY, "SCM call to hypervisor failed");
  343. rc = -EINVAL;
  344. }
  345. return rc;
  346. }
  347. #else
  348. int cam_csiphy_notify_secure_mode(struct csiphy_device *csiphy_dev,
  349. bool protect, int32_t offset)
  350. {
  351. int rc = 0;
  352. struct scm_desc description = {
  353. .arginfo = SCM_ARGS(2, SCM_VAL, SCM_VAL),
  354. .args[0] = protect,
  355. .args[1] = csiphy_dev->csiphy_info[offset]
  356. .csiphy_cpas_cp_reg_mask,
  357. };
  358. if (offset >= CSIPHY_MAX_INSTANCES_PER_PHY) {
  359. CAM_ERR(CAM_CSIPHY, "Invalid CSIPHY offset");
  360. rc = -EINVAL;
  361. } else if (scm_call2(SCM_SIP_FNID(0x18, 0x7), &description)) {
  362. CAM_ERR(CAM_CSIPHY, "SCM call to hypervisor failed");
  363. rc = -EINVAL;
  364. }
  365. return rc;
  366. }
  367. #endif
  368. /* Callback to compare device from match list before adding as component */
  369. static inline int camera_component_compare_dev(struct device *dev, void *data)
  370. {
  371. return dev == data;
  372. }
  373. /* Add component matches to list for master of aggregate driver */
  374. int camera_component_match_add_drivers(struct device *master_dev,
  375. struct component_match **match_list)
  376. {
  377. int i, rc = 0;
  378. struct platform_device *pdev = NULL;
  379. struct i2c_client *client = NULL;
  380. struct device *start_dev = NULL, *match_dev = NULL;
  381. if (!master_dev || !match_list) {
  382. CAM_ERR(CAM_UTIL, "Invalid parameters for component match add");
  383. rc = -EINVAL;
  384. goto end;
  385. }
  386. for (i = 0; i < ARRAY_SIZE(cam_component_platform_drivers); i++) {
  387. #if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 4, 0)
  388. struct device_driver const *drv =
  389. &cam_component_platform_drivers[i]->driver;
  390. const void *drv_ptr = (const void *)drv;
  391. #else
  392. struct device_driver *drv = &cam_component_platform_drivers[i]->driver;
  393. void *drv_ptr = (void *)drv;
  394. #endif
  395. start_dev = NULL;
  396. while ((match_dev = bus_find_device(&platform_bus_type,
  397. start_dev, drv_ptr, &camera_platform_compare_dev))) {
  398. put_device(start_dev);
  399. pdev = to_platform_device(match_dev);
  400. CAM_DBG(CAM_UTIL, "Adding matched component:%s", pdev->name);
  401. component_match_add(master_dev, match_list,
  402. camera_component_compare_dev, match_dev);
  403. start_dev = match_dev;
  404. }
  405. put_device(start_dev);
  406. }
  407. for (i = 0; i < ARRAY_SIZE(cam_component_i2c_drivers); i++) {
  408. #if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 4, 0)
  409. struct device_driver const *drv =
  410. &cam_component_i2c_drivers[i]->driver;
  411. const void *drv_ptr = (const void *)drv;
  412. #else
  413. struct device_driver *drv = &cam_component_i2c_drivers[i]->driver;
  414. void *drv_ptr = (void *)drv;
  415. #endif
  416. start_dev = NULL;
  417. while ((match_dev = bus_find_device(&i2c_bus_type,
  418. start_dev, drv_ptr, &camera_i2c_compare_dev))) {
  419. put_device(start_dev);
  420. client = to_i2c_client(match_dev);
  421. CAM_DBG(CAM_UTIL, "Adding matched component:%s", client->name);
  422. component_match_add(master_dev, match_list,
  423. camera_component_compare_dev, match_dev);
  424. start_dev = match_dev;
  425. }
  426. put_device(start_dev);
  427. }
  428. end:
  429. return rc;
  430. }
  431. #if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)
  432. #include <linux/qcom-iommu-util.h>
  433. void cam_check_iommu_faults(struct iommu_domain *domain,
  434. struct cam_smmu_pf_info *pf_info)
  435. {
  436. struct qcom_iommu_fault_ids fault_ids = {0, 0, 0};
  437. if (qcom_iommu_get_fault_ids(domain, &fault_ids))
  438. CAM_ERR(CAM_SMMU, "Cannot get smmu fault ids");
  439. else
  440. CAM_ERR(CAM_SMMU, "smmu fault ids bid:%d pid:%d mid:%d",
  441. fault_ids.bid, fault_ids.pid, fault_ids.mid);
  442. pf_info->bid = fault_ids.bid;
  443. pf_info->pid = fault_ids.pid;
  444. pf_info->mid = fault_ids.mid;
  445. }
  446. #else
  447. void cam_check_iommu_faults(struct iommu_domain *domain,
  448. struct cam_smmu_pf_info *pf_info)
  449. {
  450. struct iommu_fault_ids fault_ids = {0, 0, 0};
  451. if (iommu_get_fault_ids(domain, &fault_ids))
  452. CAM_ERR(CAM_SMMU, "Error: Can not get smmu fault ids");
  453. CAM_ERR(CAM_SMMU, "smmu fault ids bid:%d pid:%d mid:%d",
  454. fault_ids.bid, fault_ids.pid, fault_ids.mid);
  455. pf_info->bid = fault_ids.bid;
  456. pf_info->pid = fault_ids.pid;
  457. pf_info->mid = fault_ids.mid;
  458. }
  459. #endif
  460. static int inline cam_subdev_list_cmp(struct cam_subdev *entry_1, struct cam_subdev *entry_2)
  461. {
  462. if (entry_1->close_seq_prior > entry_2->close_seq_prior)
  463. return 1;
  464. else if (entry_1->close_seq_prior < entry_2->close_seq_prior)
  465. return -1;
  466. else
  467. return 0;
  468. }
  469. #if (KERNEL_VERSION(5, 18, 0) <= LINUX_VERSION_CODE)
  470. int cam_compat_util_get_dmabuf_va(struct dma_buf *dmabuf, uintptr_t *vaddr)
  471. {
  472. struct iosys_map mapping;
  473. int error_code = dma_buf_vmap(dmabuf, &mapping);
  474. if (error_code) {
  475. *vaddr = 0;
  476. } else {
  477. *vaddr = (mapping.is_iomem) ?
  478. (uintptr_t)mapping.vaddr_iomem : (uintptr_t)mapping.vaddr;
  479. CAM_DBG(CAM_MEM,
  480. "dmabuf=%p, *vaddr=%p, is_iomem=%d, vaddr_iomem=%p, vaddr=%p",
  481. dmabuf, *vaddr, mapping.is_iomem, mapping.vaddr_iomem, mapping.vaddr);
  482. }
  483. return error_code;
  484. }
  485. void cam_compat_util_put_dmabuf_va(struct dma_buf *dmabuf, void *vaddr)
  486. {
  487. struct iosys_map mapping = IOSYS_MAP_INIT_VADDR(vaddr);
  488. dma_buf_vunmap(dmabuf, &mapping);
  489. }
  490. #elif (KERNEL_VERSION(5, 15, 0) <= LINUX_VERSION_CODE)
  491. int cam_compat_util_get_dmabuf_va(struct dma_buf *dmabuf, uintptr_t *vaddr)
  492. {
  493. struct dma_buf_map mapping;
  494. int error_code = dma_buf_vmap(dmabuf, &mapping);
  495. if (error_code) {
  496. *vaddr = 0;
  497. } else {
  498. *vaddr = (mapping.is_iomem) ?
  499. (uintptr_t)mapping.vaddr_iomem : (uintptr_t)mapping.vaddr;
  500. CAM_DBG(CAM_MEM,
  501. "dmabuf=%p, *vaddr=%p, is_iomem=%d, vaddr_iomem=%p, vaddr=%p",
  502. dmabuf, *vaddr, mapping.is_iomem, mapping.vaddr_iomem, mapping.vaddr);
  503. }
  504. return error_code;
  505. }
  506. void cam_compat_util_put_dmabuf_va(struct dma_buf *dmabuf, void *vaddr)
  507. {
  508. struct dma_buf_map mapping = DMA_BUF_MAP_INIT_VADDR(vaddr);
  509. dma_buf_vunmap(dmabuf, &mapping);
  510. }
  511. #else
  512. int cam_compat_util_get_dmabuf_va(struct dma_buf *dmabuf, uintptr_t *vaddr)
  513. {
  514. int error_code = 0;
  515. void *addr = dma_buf_vmap(dmabuf);
  516. if (!addr) {
  517. *vaddr = 0;
  518. error_code = -ENOSPC;
  519. } else {
  520. *vaddr = (uintptr_t)addr;
  521. }
  522. return error_code;
  523. }
  524. void cam_compat_util_put_dmabuf_va(struct dma_buf *dmabuf, void *vaddr)
  525. {
  526. dma_buf_vunmap(dmabuf, vaddr);
  527. }
  528. #endif
  529. #if (KERNEL_VERSION(5, 15, 0) <= LINUX_VERSION_CODE)
  530. void cam_smmu_util_iommu_custom(struct device *dev,
  531. dma_addr_t discard_start, size_t discard_length)
  532. {
  533. }
  534. int cam_req_mgr_ordered_list_cmp(void *priv,
  535. const struct list_head *head_1, const struct list_head *head_2)
  536. {
  537. return cam_subdev_list_cmp(list_entry(head_1, struct cam_subdev, list),
  538. list_entry(head_2, struct cam_subdev, list));
  539. }
  540. void cam_i3c_driver_remove(struct i3c_device *client)
  541. {
  542. CAM_DBG(CAM_SENSOR, "I3C remove invoked for %s",
  543. (client ? dev_name(&client->dev) : "none"));
  544. }
  545. #else
  546. void cam_smmu_util_iommu_custom(struct device *dev,
  547. dma_addr_t discard_start, size_t discard_length)
  548. {
  549. iommu_dma_enable_best_fit_algo(dev);
  550. if (discard_start)
  551. iommu_dma_reserve_iova(dev, discard_start, discard_length);
  552. return;
  553. }
  554. int cam_req_mgr_ordered_list_cmp(void *priv,
  555. struct list_head *head_1, struct list_head *head_2)
  556. {
  557. return cam_subdev_list_cmp(list_entry(head_1, struct cam_subdev, list),
  558. list_entry(head_2, struct cam_subdev, list));
  559. }
  560. int cam_i3c_driver_remove(struct i3c_device *client)
  561. {
  562. CAM_DBG(CAM_SENSOR, "I3C remove invoked for %s",
  563. (client ? dev_name(&client->dev) : "none"));
  564. return 0;
  565. }
  566. #endif
  567. #if (KERNEL_VERSION(5, 15, 0) <= LINUX_VERSION_CODE && \
  568. KERNEL_VERSION(5, 18, 0) > LINUX_VERSION_CODE)
  569. long cam_dma_buf_set_name(struct dma_buf *dmabuf, const char *name)
  570. {
  571. long ret = 0;
  572. ret = dma_buf_set_name(dmabuf, name);
  573. return ret;
  574. }
  575. #else
  576. long cam_dma_buf_set_name(struct dma_buf *dmabuf, const char *name)
  577. {
  578. return 0;
  579. }
  580. #endif
  581. #if KERNEL_VERSION(5, 18, 0) <= LINUX_VERSION_CODE
  582. void cam_eeprom_spi_driver_remove(struct spi_device *sdev)
  583. {
  584. struct v4l2_subdev *sd = spi_get_drvdata(sdev);
  585. struct cam_eeprom_ctrl_t *e_ctrl;
  586. struct cam_eeprom_soc_private *soc_private;
  587. if (!sd) {
  588. CAM_ERR(CAM_EEPROM, "Subdevice is NULL");
  589. return;
  590. }
  591. e_ctrl = (struct cam_eeprom_ctrl_t *)v4l2_get_subdevdata(sd);
  592. if (!e_ctrl) {
  593. CAM_ERR(CAM_EEPROM, "eeprom device is NULL");
  594. return;
  595. }
  596. mutex_lock(&(e_ctrl->eeprom_mutex));
  597. cam_eeprom_shutdown(e_ctrl);
  598. mutex_unlock(&(e_ctrl->eeprom_mutex));
  599. mutex_destroy(&(e_ctrl->eeprom_mutex));
  600. cam_unregister_subdev(&(e_ctrl->v4l2_dev_str));
  601. kfree(e_ctrl->io_master_info.spi_client);
  602. e_ctrl->io_master_info.spi_client = NULL;
  603. soc_private =
  604. (struct cam_eeprom_soc_private *)e_ctrl->soc_info.soc_private;
  605. if (soc_private) {
  606. kfree(soc_private->power_info.gpio_num_info);
  607. soc_private->power_info.gpio_num_info = NULL;
  608. kfree(soc_private);
  609. soc_private = NULL;
  610. }
  611. v4l2_set_subdevdata(&e_ctrl->v4l2_dev_str.sd, NULL);
  612. kfree(e_ctrl);
  613. }
  614. int cam_compat_util_get_irq(struct cam_hw_soc_info *soc_info)
  615. {
  616. int rc = 0;
  617. soc_info->irq_num[0] = platform_get_irq(soc_info->pdev, 0);
  618. if (soc_info->irq_num[0] < 0) {
  619. rc = soc_info->irq_num[0];
  620. return rc;
  621. }
  622. return rc;
  623. }
  624. #else
  625. int cam_eeprom_spi_driver_remove(struct spi_device *sdev)
  626. {
  627. struct v4l2_subdev *sd = spi_get_drvdata(sdev);
  628. struct cam_eeprom_ctrl_t *e_ctrl;
  629. struct cam_eeprom_soc_private *soc_private;
  630. struct cam_hw_soc_info *soc_info;
  631. if (!sd) {
  632. CAM_ERR(CAM_EEPROM, "Subdevice is NULL");
  633. return -EINVAL;
  634. }
  635. e_ctrl = (struct cam_eeprom_ctrl_t *)v4l2_get_subdevdata(sd);
  636. if (!e_ctrl) {
  637. CAM_ERR(CAM_EEPROM, "eeprom device is NULL");
  638. return -EINVAL;
  639. }
  640. soc_info = &e_ctrl->soc_info;
  641. mutex_lock(&(e_ctrl->eeprom_mutex));
  642. cam_eeprom_shutdown(e_ctrl);
  643. mutex_unlock(&(e_ctrl->eeprom_mutex));
  644. mutex_destroy(&(e_ctrl->eeprom_mutex));
  645. cam_unregister_subdev(&(e_ctrl->v4l2_dev_str));
  646. kfree(e_ctrl->io_master_info.spi_client);
  647. e_ctrl->io_master_info.spi_client = NULL;
  648. soc_private =
  649. (struct cam_eeprom_soc_private *)e_ctrl->soc_info.soc_private;
  650. if (soc_private) {
  651. kfree(soc_private->power_info.gpio_num_info);
  652. soc_private->power_info.gpio_num_info = NULL;
  653. kfree(soc_private);
  654. soc_private = NULL;
  655. }
  656. v4l2_set_subdevdata(&e_ctrl->v4l2_dev_str.sd, NULL);
  657. kfree(e_ctrl);
  658. return 0;
  659. }
  660. int cam_compat_util_get_irq(struct cam_hw_soc_info *soc_info)
  661. {
  662. int rc = 0, i;
  663. for (i = 0; i < soc_info->irq_count; i++) {
  664. soc_info->irq_line[i] = platform_get_resource_byname(soc_info->pdev,
  665. IORESOURCE_IRQ, soc_info->irq_name[i]);
  666. if (!soc_info->irq_line[i]) {
  667. CAM_ERR(CAM_UTIL, "Failed to get IRQ line for irq: %s of %s",
  668. soc_info->irq_name[i], soc_info->dev_name);
  669. rc = -ENODEV;
  670. return rc;
  671. }
  672. soc_info->irq_num[i] = soc_info->irq_line[i]->start;
  673. }
  674. return rc;
  675. }
  676. #endif
  677. bool cam_secure_get_vfe_fd_port_config(void)
  678. {
  679. #if KERNEL_VERSION(6, 0, 0) <= LINUX_VERSION_CODE
  680. return false;
  681. #else
  682. return true;
  683. #endif
  684. }