cam_common_util.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2017-2021, The Linux Foundation. All rights reserved.
  4. * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  5. */
  6. #include <linux/string.h>
  7. #include <linux/types.h>
  8. #include <linux/slab.h>
  9. #include <linux/timer.h>
  10. #include <linux/completion.h>
  11. #include <linux/module.h>
  12. #include <linux/iopoll.h>
  13. #include <linux/moduleparam.h>
  14. #include "cam_common_util.h"
  15. #include "cam_debug_util.h"
  16. #include "cam_presil_hw_access.h"
  17. #include "cam_hw.h"
  18. #if IS_REACHABLE(CONFIG_QCOM_VA_MINIDUMP)
  19. #include <soc/qcom/minidump.h>
  20. static struct cam_common_mini_dump_dev_info g_minidump_dev_info;
  21. #endif
  22. #define CAM_PRESIL_POLL_DELAY 20
  23. static struct cam_common_inject_evt_info g_inject_evt_info;
  24. static uint timeout_multiplier = 1;
  25. module_param(timeout_multiplier, uint, 0644);
  26. typedef int (*cam_common_evt_inject_cmd_parse_handler)(
  27. struct cam_common_inject_evt_param *inject_params,
  28. uint32_t param_counter, char *token);
  29. int cam_common_util_get_string_index(const char **strings,
  30. uint32_t num_strings, const char *matching_string, uint32_t *index)
  31. {
  32. int i;
  33. for (i = 0; i < num_strings; i++) {
  34. if (strnstr(strings[i], matching_string, strlen(strings[i]))) {
  35. CAM_DBG(CAM_UTIL, "matched %s : %d\n",
  36. matching_string, i);
  37. *index = i;
  38. return 0;
  39. }
  40. }
  41. return -EINVAL;
  42. }
  43. uint32_t cam_common_util_remove_duplicate_arr(int32_t *arr, uint32_t num)
  44. {
  45. int i, j;
  46. uint32_t wr_idx = 1;
  47. if (!arr) {
  48. CAM_ERR(CAM_UTIL, "Null input array");
  49. return 0;
  50. }
  51. for (i = 1; i < num; i++) {
  52. for (j = 0; j < wr_idx ; j++) {
  53. if (arr[i] == arr[j])
  54. break;
  55. }
  56. if (j == wr_idx)
  57. arr[wr_idx++] = arr[i];
  58. }
  59. return wr_idx;
  60. }
  61. unsigned long cam_common_wait_for_completion_timeout(
  62. struct completion *complete,
  63. unsigned long timeout_jiffies)
  64. {
  65. unsigned long wait_jiffies;
  66. unsigned long rem_jiffies;
  67. if (!complete) {
  68. CAM_ERR(CAM_UTIL, "Null complete pointer");
  69. return 0;
  70. }
  71. if (timeout_multiplier < 1)
  72. timeout_multiplier = 1;
  73. wait_jiffies = timeout_jiffies * timeout_multiplier;
  74. rem_jiffies = wait_for_completion_timeout(complete, wait_jiffies);
  75. return rem_jiffies;
  76. }
  77. int cam_common_read_poll_timeout(
  78. void __iomem *addr,
  79. unsigned long delay,
  80. unsigned long timeout,
  81. uint32_t mask,
  82. uint32_t check_val,
  83. uint32_t *status)
  84. {
  85. unsigned long wait_time_us;
  86. int rc = -EINVAL;
  87. if (!addr || !status) {
  88. CAM_ERR(CAM_UTIL, "Invalid param addr: %pK status: %pK",
  89. addr, status);
  90. return rc;
  91. }
  92. if (timeout_multiplier < 1)
  93. timeout_multiplier = 1;
  94. wait_time_us = timeout * timeout_multiplier;
  95. if (false == cam_presil_mode_enabled()) {
  96. rc = readl_poll_timeout(addr, *status, (*status & mask) == check_val, delay,
  97. wait_time_us);
  98. } else {
  99. rc = cam_presil_readl_poll_timeout(addr, mask,
  100. wait_time_us/(CAM_PRESIL_POLL_DELAY * 1000), CAM_PRESIL_POLL_DELAY);
  101. }
  102. return rc;
  103. }
  104. int cam_common_modify_timer(struct timer_list *timer, int32_t timeout_val)
  105. {
  106. if (!timer) {
  107. CAM_ERR(CAM_UTIL, "Invalid reference to system timer");
  108. return -EINVAL;
  109. }
  110. if (timeout_multiplier < 1)
  111. timeout_multiplier = 1;
  112. CAM_DBG(CAM_UTIL, "Starting timer to fire in %d ms. (jiffies=%lu)\n",
  113. (timeout_val * timeout_multiplier), jiffies);
  114. mod_timer(timer,
  115. (jiffies + msecs_to_jiffies(timeout_val * timeout_multiplier)));
  116. return 0;
  117. }
  118. void cam_common_util_thread_switch_delay_detect(
  119. const char *token, ktime_t scheduled_time, uint32_t threshold)
  120. {
  121. uint64_t diff;
  122. ktime_t cur_time;
  123. struct timespec64 cur_ts;
  124. struct timespec64 scheduled_ts;
  125. cur_time = ktime_get();
  126. diff = ktime_ms_delta(cur_time, scheduled_time);
  127. if (diff > threshold) {
  128. scheduled_ts = ktime_to_timespec64(scheduled_time);
  129. cur_ts = ktime_to_timespec64(cur_time);
  130. CAM_WARN_RATE_LIMIT_CUSTOM(CAM_UTIL, 1, 1,
  131. "%s delay detected %ld:%06ld cur %ld:%06ld diff %ld: threshold %d",
  132. token, scheduled_ts.tv_sec,
  133. scheduled_ts.tv_nsec/NSEC_PER_USEC,
  134. cur_ts.tv_sec, cur_ts.tv_nsec/NSEC_PER_USEC,
  135. diff, threshold);
  136. }
  137. }
  138. #if IS_REACHABLE(CONFIG_QCOM_VA_MINIDUMP)
  139. static void cam_common_mini_dump_handler(void *dst, unsigned long len)
  140. {
  141. int i = 0;
  142. uint8_t *waddr;
  143. unsigned long bytes_written = 0;
  144. unsigned long remain_len = len;
  145. struct cam_common_mini_dump_data *md;
  146. if (len < sizeof(*md)) {
  147. CAM_WARN(CAM_UTIL, "Insufficient len %lu", len);
  148. return;
  149. }
  150. md = (struct cam_common_mini_dump_data *)dst;
  151. waddr = (uint8_t *)md + sizeof(*md);
  152. remain_len -= sizeof(*md);
  153. for (i = 0; i < CAM_COMMON_MINI_DUMP_DEV_NUM; i++) {
  154. if (!g_minidump_dev_info.dump_cb[i])
  155. continue;
  156. memcpy(md->name[i], g_minidump_dev_info.name[i],
  157. strlen(g_minidump_dev_info.name[i]));
  158. md->waddr[i] = (void *)waddr;
  159. bytes_written = g_minidump_dev_info.dump_cb[i](
  160. (void *)waddr, remain_len);
  161. md->size[i] = bytes_written;
  162. if (bytes_written >= len) {
  163. CAM_WARN(CAM_UTIL, "No more space to dump");
  164. goto nomem;
  165. }
  166. remain_len -= bytes_written;
  167. waddr += bytes_written;
  168. }
  169. return;
  170. nomem:
  171. for (; i >=0; i--)
  172. CAM_WARN(CAM_UTIL, "%s: Dumped len: %lu", md->name[i], md->size[i]);
  173. }
  174. static int cam_common_md_notify_handler(struct notifier_block *this,
  175. unsigned long event, void *ptr)
  176. {
  177. struct va_md_entry cbentry;
  178. int rc = 0;
  179. cbentry.vaddr = 0x0;
  180. strlcpy(cbentry.owner, "Camera", sizeof(cbentry.owner));
  181. cbentry.size = CAM_COMMON_MINI_DUMP_SIZE;
  182. cbentry.cb = cam_common_mini_dump_handler;
  183. rc = qcom_va_md_add_region(&cbentry);
  184. if (rc) {
  185. CAM_ERR(CAM_UTIL, "Va Region add falied %d", rc);
  186. return NOTIFY_STOP_MASK;
  187. }
  188. return NOTIFY_OK;
  189. }
  190. static struct notifier_block cam_common_md_notify_blk = {
  191. .notifier_call = cam_common_md_notify_handler,
  192. .priority = INT_MAX,
  193. };
  194. int cam_common_register_mini_dump_cb(
  195. cam_common_mini_dump_cb mini_dump_cb,
  196. uint8_t *dev_name)
  197. {
  198. int rc = 0;
  199. if (g_minidump_dev_info.num_devs >= CAM_COMMON_MINI_DUMP_DEV_NUM) {
  200. CAM_ERR(CAM_UTIL, "No free index available");
  201. return -EINVAL;
  202. }
  203. if (!mini_dump_cb || !dev_name) {
  204. CAM_ERR(CAM_UTIL, "Invalid params");
  205. return -EINVAL;
  206. }
  207. g_minidump_dev_info.dump_cb[g_minidump_dev_info.num_devs] =
  208. mini_dump_cb;
  209. scnprintf(g_minidump_dev_info.name[g_minidump_dev_info.num_devs],
  210. CAM_COMMON_MINI_DUMP_DEV_NAME_LEN, dev_name);
  211. g_minidump_dev_info.num_devs++;
  212. if (!g_minidump_dev_info.is_registered) {
  213. rc = qcom_va_md_register("Camera", &cam_common_md_notify_blk);
  214. if (rc) {
  215. CAM_ERR(CAM_UTIL, "Camera VA minidump register failed");
  216. goto end;
  217. }
  218. g_minidump_dev_info.is_registered = true;
  219. }
  220. end:
  221. return rc;
  222. }
  223. #endif
  224. void *cam_common_user_dump_clock(
  225. void *dump_struct, uint8_t *addr_ptr)
  226. {
  227. struct cam_hw_info *hw_info = NULL;
  228. uint64_t *addr = NULL;
  229. hw_info = (struct cam_hw_info *)dump_struct;
  230. if (!hw_info || !addr_ptr) {
  231. CAM_ERR(CAM_ISP, "HW info or address pointer NULL");
  232. return addr;
  233. }
  234. addr = (uint64_t *)addr_ptr;
  235. *addr++ = hw_info->soc_info.applied_src_clk_rate;
  236. return addr;
  237. }
  238. int cam_common_user_dump_helper(
  239. void *cmd_args,
  240. void *(*func)(void *dump_struct, uint8_t *addr_ptr),
  241. void *dump_struct,
  242. size_t size,
  243. const char *tag, ...)
  244. {
  245. uint8_t *dst;
  246. uint8_t *addr, *start;
  247. void *returned_ptr;
  248. struct cam_common_hw_dump_args *dump_args;
  249. struct cam_common_hw_dump_header *hdr;
  250. va_list args;
  251. void*(*func_ptr)(void *dump_struct, uint8_t *addr_ptr);
  252. dump_args = (struct cam_common_hw_dump_args *)cmd_args;
  253. if (!dump_args->cpu_addr || !dump_args->buf_len) {
  254. CAM_ERR(CAM_UTIL,
  255. "Invalid params %pK %zu",
  256. (void *)dump_args->cpu_addr,
  257. dump_args->buf_len);
  258. return -EINVAL;
  259. }
  260. if (dump_args->buf_len <= dump_args->offset) {
  261. CAM_WARN(CAM_UTIL,
  262. "Dump offset overshoot offset %zu buf_len %zu",
  263. dump_args->offset, dump_args->buf_len);
  264. return -ENOSPC;
  265. }
  266. dst = (uint8_t *)dump_args->cpu_addr + dump_args->offset;
  267. hdr = (struct cam_common_hw_dump_header *)dst;
  268. va_start(args, tag);
  269. vscnprintf(hdr->tag, CAM_COMMON_HW_DUMP_TAG_MAX_LEN, tag, args);
  270. va_end(args);
  271. hdr->word_size = size;
  272. addr = (uint8_t *)(dst + sizeof(struct cam_common_hw_dump_header));
  273. start = addr;
  274. func_ptr = func;
  275. returned_ptr = func_ptr(dump_struct, addr);
  276. if (IS_ERR(returned_ptr))
  277. return PTR_ERR(returned_ptr);
  278. addr = (uint8_t *)returned_ptr;
  279. hdr->size = addr - start;
  280. CAM_DBG(CAM_UTIL, "hdr size: %d, word size: %d, addr: %x, start: %x",
  281. hdr->size, hdr->word_size, addr, start);
  282. dump_args->offset += hdr->size +
  283. sizeof(struct cam_common_hw_dump_header);
  284. return 0;
  285. }
  286. int cam_common_register_evt_inject_cb(cam_common_evt_inject_cb evt_inject_cb,
  287. enum cam_common_evt_inject_hw_id hw_id)
  288. {
  289. int rc = 0;
  290. if (g_inject_evt_info.num_hw_registered >= CAM_COMMON_EVT_INJECT_HW_MAX) {
  291. CAM_ERR(CAM_UTIL, "No free index available");
  292. return -EINVAL;
  293. }
  294. if (!evt_inject_cb || hw_id >= CAM_COMMON_EVT_INJECT_HW_MAX) {
  295. CAM_ERR(CAM_UTIL, "Invalid params evt_inject_cb %s hw_id: %d",
  296. CAM_IS_NULL_TO_STR(evt_inject_cb), hw_id);
  297. return -EINVAL;
  298. }
  299. g_inject_evt_info.evt_inject_cb[hw_id] = evt_inject_cb;
  300. g_inject_evt_info.num_hw_registered++;
  301. CAM_DBG(CAM_UTIL, "Evt inject cb registered for HW_id: %d, total registered: %d", hw_id,
  302. g_inject_evt_info.num_hw_registered);
  303. return rc;
  304. }
  305. void cam_common_release_evt_params(int32_t dev_hdl)
  306. {
  307. struct list_head *pos = NULL, *pos_next = NULL;
  308. struct cam_common_inject_evt_param *inject_params;
  309. if (!g_inject_evt_info.is_list_initialised)
  310. return;
  311. if (list_empty(&g_inject_evt_info.active_evt_ctx_list)) {
  312. CAM_DBG(CAM_UTIL, "Event injection list is initialized but empty");
  313. return;
  314. }
  315. list_for_each_safe(pos, pos_next, &g_inject_evt_info.active_evt_ctx_list) {
  316. inject_params = list_entry(pos, struct cam_common_inject_evt_param, list);
  317. if (inject_params->dev_hdl == dev_hdl) {
  318. CAM_INFO(CAM_UTIL, "entry deleted for %d dev hdl", dev_hdl);
  319. list_del(pos);
  320. kfree(inject_params);
  321. }
  322. }
  323. }
  324. static inline int cam_common_evt_inject_get_hw_id(uint8_t *hw_id, char *token)
  325. {
  326. if (strcmp(token, CAM_COMMON_IFE_NODE) == 0)
  327. *hw_id = CAM_COMMON_EVT_INJECT_HW_ISP;
  328. else if (strcmp(token, CAM_COMMON_ICP_NODE) == 0)
  329. *hw_id = CAM_COMMON_EVT_INJECT_HW_ICP;
  330. else if (strcmp(token, CAM_COMMON_JPEG_NODE) == 0)
  331. *hw_id = CAM_COMMON_EVT_INJECT_HW_JPEG;
  332. else {
  333. CAM_ERR(CAM_UTIL, "Invalid camera hardware [ %s ]", token);
  334. return -EINVAL;
  335. }
  336. return 0;
  337. }
  338. static inline int cam_common_evt_inject_get_str_id_type(uint8_t *id_type, char *token)
  339. {
  340. if (!strcmp(token, CAM_COMMON_EVT_INJECT_BUFFER_ERROR))
  341. *id_type = CAM_COMMON_EVT_INJECT_BUFFER_ERROR_TYPE;
  342. else if (!strcmp(token, CAM_COMMON_EVT_INJECT_NOTIFY_EVENT))
  343. *id_type = CAM_COMMON_EVT_INJECT_NOTIFY_EVENT_TYPE;
  344. else {
  345. CAM_ERR(CAM_UTIL, "Invalid string id: %s", token);
  346. return -EINVAL;
  347. }
  348. return 0;
  349. }
  350. static int cam_common_evt_inject_parse_buffer_error_evt_params(
  351. struct cam_common_inject_evt_param *inject_params,
  352. uint32_t param_counter, char *token)
  353. {
  354. struct cam_hw_inject_buffer_error_param *buf_err_params =
  355. &inject_params->evt_params.u.buf_err_evt;
  356. int rc = 0;
  357. switch (param_counter) {
  358. case SYNC_ERROR_CAUSE:
  359. if (kstrtou32(token, 0, &buf_err_params->sync_error)) {
  360. CAM_ERR(CAM_UTIL, "Invalid event type %s", token);
  361. rc = -EINVAL;
  362. }
  363. break;
  364. default:
  365. CAM_ERR(CAM_UTIL, "Invalid extra parameters: %s", token);
  366. rc = -EINVAL;
  367. }
  368. return rc;
  369. }
  370. static int cam_common_evt_inject_parse_node_evt_params(
  371. struct cam_common_inject_evt_param *inject_params,
  372. uint32_t param_counter, char *token)
  373. {
  374. struct cam_hw_inject_node_evt_param *node_params =
  375. &inject_params->evt_params.u.evt_notify.u.node_evt_params;
  376. int rc = 0;
  377. switch (param_counter) {
  378. case EVENT_TYPE:
  379. if (kstrtou32(token, 0, &node_params->event_type)) {
  380. CAM_ERR(CAM_UTIL, "Invalid event type %s", token);
  381. rc = -EINVAL;
  382. }
  383. break;
  384. case EVENT_CAUSE:
  385. if (kstrtou32(token, 0, &node_params->event_cause)) {
  386. CAM_ERR(CAM_UTIL, "Invalid event cause %s", token);
  387. rc = -EINVAL;
  388. }
  389. break;
  390. default:
  391. CAM_ERR(CAM_UTIL, "Invalid extra parameters: %s", token);
  392. rc = -EINVAL;
  393. }
  394. return rc;
  395. }
  396. static int cam_common_evt_inject_parse_pf_params(
  397. struct cam_common_inject_evt_param *inject_params,
  398. uint32_t param_counter, char *token)
  399. {
  400. struct cam_hw_inject_pf_evt_param *pf_params =
  401. &inject_params->evt_params.u.evt_notify.u.pf_evt_params;
  402. int rc = 0;
  403. switch (param_counter) {
  404. case PF_PARAM_CTX_FOUND:
  405. if (kstrtobool(token, &pf_params->ctx_found)) {
  406. CAM_ERR(CAM_UTIL, "Invalid context found value %s", token);
  407. rc = -EINVAL;
  408. }
  409. break;
  410. default:
  411. CAM_ERR(CAM_UTIL, "Invalid extra parameters %s", token);
  412. rc = -EINVAL;
  413. }
  414. return rc;
  415. }
  416. static int cam_common_evt_inject_parse_err_evt_params(
  417. struct cam_common_inject_evt_param *inject_params,
  418. uint32_t param_counter, char *token)
  419. {
  420. struct cam_hw_inject_err_evt_param *err_params =
  421. &inject_params->evt_params.u.evt_notify.u.err_evt_params;
  422. int rc = 0;
  423. switch (param_counter) {
  424. case ERR_PARAM_ERR_TYPE:
  425. if (kstrtou32(token, 0, &err_params->err_type)) {
  426. CAM_ERR(CAM_UTIL, "Invalid error type %s", token);
  427. rc = -EINVAL;
  428. }
  429. break;
  430. case ERR_PARAM_ERR_CODE:
  431. if (kstrtou32(token, 0, &err_params->err_code)) {
  432. CAM_ERR(CAM_UTIL, "Invalid error code %s", token);
  433. rc = -EINVAL;
  434. }
  435. break;
  436. default:
  437. CAM_ERR(CAM_UTIL, "Invalid extra parameters: %s", token);
  438. rc = -EINVAL;
  439. }
  440. return rc;
  441. }
  442. static int cam_common_evt_inject_parse_event_notify(
  443. struct cam_common_inject_evt_param *inject_params,
  444. uint32_t param_counter, char *token)
  445. {
  446. int rc = 0;
  447. switch (param_counter) {
  448. case EVT_NOTIFY_TYPE:
  449. if (kstrtou32(token, 0,
  450. &inject_params->evt_params.u.evt_notify.evt_notify_type)) {
  451. CAM_ERR(CAM_UTIL, "Invalid Event notify type %s", token);
  452. rc = -EINVAL;
  453. }
  454. break;
  455. default:
  456. CAM_ERR(CAM_UTIL, "Invalid extra parameters: %s", token);
  457. rc = -EINVAL;
  458. }
  459. return rc;
  460. }
  461. static int cam_common_evt_inject_parse_common_params(
  462. struct cam_common_inject_evt_param *inject_params,
  463. uint32_t param_counter, char *token)
  464. {
  465. int rc = 0;
  466. struct cam_hw_inject_evt_param *evt_param = &inject_params->evt_params;
  467. switch (param_counter) {
  468. case STRING_ID:
  469. rc = cam_common_evt_inject_get_str_id_type(&evt_param->inject_id, token);
  470. break;
  471. case HW_NAME:
  472. rc = cam_common_evt_inject_get_hw_id(&inject_params->hw_id, token);
  473. break;
  474. case DEV_HDL:
  475. if (kstrtos32(token, 0, &inject_params->dev_hdl)) {
  476. CAM_ERR(CAM_UTIL, "Invalid device handle %s", token);
  477. rc = -EINVAL;
  478. }
  479. break;
  480. case REQ_ID:
  481. if (kstrtou64(token, 0, &evt_param->req_id)) {
  482. CAM_ERR(CAM_UTIL, "Invalid request id %s", token);
  483. rc = -EINVAL;
  484. }
  485. break;
  486. default:
  487. CAM_ERR(CAM_UTIL, "Invalid extra parameter: %s", token);
  488. rc = -EINVAL;
  489. }
  490. return rc;
  491. }
  492. static int cam_common_evt_inject_generic_command_parser(
  493. struct cam_common_inject_evt_param *inject_params,
  494. char **msg, uint32_t max_params, cam_common_evt_inject_cmd_parse_handler cmd_parse_cb)
  495. {
  496. char *token = NULL;
  497. int rc = 0, param_counter = 0;
  498. token = strsep(msg, ":");
  499. while (token != NULL) {
  500. rc = cmd_parse_cb(inject_params, param_counter, token);
  501. if (rc) {
  502. CAM_ERR(CAM_UTIL, "Parsed Command failed rc: %d", rc);
  503. return rc;
  504. }
  505. param_counter++;
  506. if (param_counter == max_params)
  507. break;
  508. token = strsep(msg, ":");
  509. }
  510. if (param_counter < max_params) {
  511. CAM_ERR(CAM_UTIL,
  512. "Insufficient parameters passed for total parameters: %u",
  513. param_counter);
  514. return -EINVAL;
  515. }
  516. return rc;
  517. }
  518. static int cam_common_evt_inject_set(const char *kmessage,
  519. const struct kernel_param *kp)
  520. {
  521. struct cam_common_inject_evt_param *inject_params = NULL;
  522. struct cam_hw_inject_evt_param *hw_evt_params = NULL;
  523. cam_common_evt_inject_cmd_parse_handler parse_handler = NULL;
  524. int rc = 0;
  525. char tmp_buff[CAM_COMMON_EVT_INJECT_BUFFER_LEN];
  526. char *msg = NULL;
  527. uint32_t param_output = 0;
  528. inject_params = kzalloc(sizeof(struct cam_common_inject_evt_param), GFP_KERNEL);
  529. if (!inject_params) {
  530. CAM_ERR(CAM_UTIL, "no free memory");
  531. return -ENOMEM;
  532. }
  533. rc = strscpy(tmp_buff, kmessage, CAM_COMMON_EVT_INJECT_BUFFER_LEN);
  534. if (rc == -E2BIG)
  535. goto free;
  536. CAM_INFO(CAM_UTIL, "parsing input param for cam event injection: %s", tmp_buff);
  537. msg = tmp_buff;
  538. hw_evt_params = &inject_params->evt_params;
  539. rc = cam_common_evt_inject_generic_command_parser(inject_params, &msg,
  540. COMMON_PARAM_MAX, cam_common_evt_inject_parse_common_params);
  541. if (rc) {
  542. CAM_ERR(CAM_UTIL, "Fail to parse common params %d", rc);
  543. goto free;
  544. }
  545. switch (hw_evt_params->inject_id) {
  546. case CAM_COMMON_EVT_INJECT_NOTIFY_EVENT_TYPE:
  547. rc = cam_common_evt_inject_generic_command_parser(inject_params, &msg,
  548. EVT_NOTIFY_PARAM_MAX, cam_common_evt_inject_parse_event_notify);
  549. if (rc) {
  550. CAM_ERR(CAM_UTIL, "Fail to parse event notify type param %d", rc);
  551. goto free;
  552. }
  553. switch (hw_evt_params->u.evt_notify.evt_notify_type) {
  554. case V4L_EVENT_CAM_REQ_MGR_ERROR:
  555. parse_handler = cam_common_evt_inject_parse_err_evt_params;
  556. param_output = ERR_PARAM_MAX;
  557. break;
  558. case V4L_EVENT_CAM_REQ_MGR_NODE_EVENT:
  559. parse_handler = cam_common_evt_inject_parse_node_evt_params;
  560. param_output = NODE_PARAM_MAX;
  561. break;
  562. case V4L_EVENT_CAM_REQ_MGR_PF_ERROR:
  563. parse_handler = cam_common_evt_inject_parse_pf_params;
  564. param_output = PF_PARAM_MAX;
  565. break;
  566. default:
  567. CAM_ERR(CAM_UTIL, "Invalid event notification type: %u",
  568. hw_evt_params->u.evt_notify.evt_notify_type);
  569. goto free;
  570. }
  571. break;
  572. case CAM_COMMON_EVT_INJECT_BUFFER_ERROR_TYPE:
  573. parse_handler = cam_common_evt_inject_parse_buffer_error_evt_params;
  574. param_output = BUFFER_ERROR_PARAM_MAX;
  575. break;
  576. default:
  577. CAM_ERR(CAM_UTIL, "Invalid Injection id: %u", hw_evt_params->inject_id);
  578. }
  579. rc = cam_common_evt_inject_generic_command_parser(inject_params, &msg,
  580. param_output, parse_handler);
  581. if (rc) {
  582. CAM_ERR(CAM_UTIL, "Command Parsed failed with Inject id: %u rc: %d",
  583. hw_evt_params->inject_id, rc);
  584. goto free;
  585. }
  586. if (g_inject_evt_info.evt_inject_cb[inject_params->hw_id]) {
  587. rc = g_inject_evt_info.evt_inject_cb[inject_params->hw_id](inject_params);
  588. if (rc)
  589. goto free;
  590. } else {
  591. CAM_ERR(CAM_UTIL, "Handler for HW_id [%hhu] not registered", inject_params->hw_id);
  592. goto free;
  593. }
  594. if (!g_inject_evt_info.is_list_initialised) {
  595. INIT_LIST_HEAD(&g_inject_evt_info.active_evt_ctx_list);
  596. g_inject_evt_info.is_list_initialised = true;
  597. }
  598. list_add(&inject_params->list, &g_inject_evt_info.active_evt_ctx_list);
  599. return rc;
  600. free:
  601. kfree(inject_params);
  602. return rc;
  603. }
  604. static int cam_common_evt_inject_get(char *buffer,
  605. const struct kernel_param *kp)
  606. {
  607. uint8_t hw_name[16], string_id[16];
  608. uint16_t buff_max_size = CAM_COMMON_EVT_INJECT_MODULE_PARAM_MAX_LENGTH;
  609. struct cam_common_inject_evt_param *inject_params = NULL;
  610. struct cam_hw_inject_evt_param *evt_params = NULL;
  611. uint32_t ret = 0;
  612. if (!g_inject_evt_info.is_list_initialised)
  613. return scnprintf(buffer, buff_max_size, "uninitialised");
  614. if (list_empty(&g_inject_evt_info.active_evt_ctx_list))
  615. return scnprintf(buffer, buff_max_size, "Active err inject list is empty");
  616. list_for_each_entry(inject_params, &g_inject_evt_info.active_evt_ctx_list, list) {
  617. evt_params = &inject_params->evt_params;
  618. switch (inject_params->hw_id) {
  619. case CAM_COMMON_EVT_INJECT_HW_ISP:
  620. strscpy(hw_name, CAM_COMMON_IFE_NODE, sizeof(hw_name));
  621. break;
  622. case CAM_COMMON_EVT_INJECT_HW_ICP:
  623. strscpy(hw_name, CAM_COMMON_ICP_NODE, sizeof(hw_name));
  624. break;
  625. case CAM_COMMON_EVT_INJECT_HW_JPEG:
  626. strscpy(hw_name, CAM_COMMON_JPEG_NODE, sizeof(hw_name));
  627. break;
  628. default:
  629. ret += scnprintf(buffer+ret, buff_max_size, "Undefined HW id\n");
  630. goto undefined_param;
  631. }
  632. switch (evt_params->inject_id) {
  633. case CAM_COMMON_EVT_INJECT_BUFFER_ERROR_TYPE:
  634. strscpy(string_id, CAM_COMMON_EVT_INJECT_BUFFER_ERROR, sizeof(string_id));
  635. break;
  636. case CAM_COMMON_EVT_INJECT_NOTIFY_EVENT_TYPE:
  637. strscpy(string_id, CAM_COMMON_EVT_INJECT_NOTIFY_EVENT, sizeof(string_id));
  638. break;
  639. default:
  640. ret += scnprintf(buffer+ret, buff_max_size, "Undefined string id\n");
  641. goto undefined_param;
  642. }
  643. ret += scnprintf(buffer+ret, buff_max_size,
  644. "string_id: %s hw_name: %s dev_hdl: %d req_id: %llu ",
  645. string_id, hw_name,
  646. inject_params->dev_hdl, evt_params->req_id);
  647. if (buff_max_size > ret) {
  648. buff_max_size -= ret;
  649. } else {
  650. CAM_WARN(CAM_UTIL, "out buff max limit reached");
  651. break;
  652. }
  653. if (evt_params->inject_id ==
  654. CAM_COMMON_EVT_INJECT_BUFFER_ERROR_TYPE) {
  655. ret += scnprintf(buffer+ret, buff_max_size,
  656. "sync_error: %u\n", evt_params->u.buf_err_evt.sync_error);
  657. } else {
  658. switch (evt_params->u.evt_notify.evt_notify_type) {
  659. case V4L_EVENT_CAM_REQ_MGR_ERROR: {
  660. struct cam_hw_inject_err_evt_param *err_evt_params =
  661. &evt_params->u.evt_notify.u.err_evt_params;
  662. ret += scnprintf(buffer+ret, buff_max_size,
  663. "Error event: error type: %u error code: %u\n",
  664. err_evt_params->err_type, err_evt_params->err_code);
  665. break;
  666. }
  667. case V4L_EVENT_CAM_REQ_MGR_NODE_EVENT: {
  668. struct cam_hw_inject_node_evt_param *node_evt_params =
  669. &evt_params->u.evt_notify.u.node_evt_params;
  670. ret += scnprintf(buffer+ret, buff_max_size,
  671. "Node event: event type: %u event cause: %u\n",
  672. node_evt_params->event_type, node_evt_params->event_cause);
  673. break;
  674. }
  675. case V4L_EVENT_CAM_REQ_MGR_PF_ERROR: {
  676. struct cam_hw_inject_pf_evt_param *pf_evt_params =
  677. &evt_params->u.evt_notify.u.pf_evt_params;
  678. ret += scnprintf(buffer+ret, buff_max_size,
  679. "PF event: ctx found %hhu\n",
  680. pf_evt_params->ctx_found);
  681. break;
  682. }
  683. default:
  684. ret += scnprintf(buffer+ret, buff_max_size,
  685. "Undefined notification event\n");
  686. }
  687. }
  688. undefined_param:
  689. CAM_DBG(CAM_UTIL, "output buffer: %s", buffer);
  690. if (buff_max_size > ret) {
  691. buff_max_size -= ret;
  692. } else {
  693. CAM_WARN(CAM_UTIL, "out buff max limit reached");
  694. break;
  695. }
  696. }
  697. return ret;
  698. }
  699. static const struct kernel_param_ops cam_common_evt_inject = {
  700. .set = cam_common_evt_inject_set,
  701. .get = cam_common_evt_inject_get
  702. };
  703. module_param_cb(cam_event_inject, &cam_common_evt_inject, NULL, 0644);