cam_soc_icc.c 3.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2019, The Linux Foundation. All rights reserved.
  4. */
  5. #include <linux/interconnect.h>
  6. #include "cam_soc_bus.h"
  7. /**
  8. * struct cam_soc_bus_client_data : Bus client data
  9. *
  10. * @icc_data: Bus icc path information
  11. */
  12. struct cam_soc_bus_client_data {
  13. struct icc_path *icc_data;
  14. };
  15. int cam_soc_bus_client_update_request(void *client, unsigned int idx)
  16. {
  17. int rc = 0;
  18. uint64_t ab = 0, ib = 0;
  19. struct cam_soc_bus_client *bus_client =
  20. (struct cam_soc_bus_client *) client;
  21. struct cam_soc_bus_client_data *bus_client_data =
  22. (struct cam_soc_bus_client_data *) bus_client->client_data;
  23. if (idx >= bus_client->common_data->num_usecases) {
  24. CAM_ERR(CAM_UTIL, "Invalid vote level=%d, usecases=%d", idx,
  25. bus_client->common_data->num_usecases);
  26. rc = -EINVAL;
  27. goto end;
  28. }
  29. ab = bus_client->common_data->bw_pair[idx].ab;
  30. ib = bus_client->common_data->bw_pair[idx].ib;
  31. CAM_DBG(CAM_UTIL, "Bus client=[%s] index[%d]",
  32. bus_client->common_data->name, idx);
  33. rc = icc_set_bw(bus_client_data->icc_data, ab, ib);
  34. if (rc) {
  35. CAM_ERR(CAM_UTIL,
  36. "Update request failed, client[%s], idx: %d",
  37. bus_client->common_data->name, idx);
  38. goto end;
  39. }
  40. end:
  41. return rc;
  42. }
  43. int cam_soc_bus_client_update_bw(void *client, uint64_t ab, uint64_t ib)
  44. {
  45. struct cam_soc_bus_client *bus_client =
  46. (struct cam_soc_bus_client *) client;
  47. struct cam_soc_bus_client_data *bus_client_data =
  48. (struct cam_soc_bus_client_data *) bus_client->client_data;
  49. int rc = 0;
  50. CAM_DBG(CAM_UTIL, "Bus client=[%s] :ab[%llu] ib[%llu]",
  51. bus_client->common_data->name, ab, ib);
  52. rc = icc_set_bw(bus_client_data->icc_data, ab, ib);
  53. if (rc) {
  54. CAM_ERR(CAM_UTIL, "Update request failed, client[%s]",
  55. bus_client->common_data->name);
  56. goto end;
  57. }
  58. end:
  59. return rc;
  60. }
  61. int cam_soc_bus_client_register(struct platform_device *pdev,
  62. struct device_node *dev_node, void **client,
  63. struct cam_soc_bus_client_common_data *common_data)
  64. {
  65. struct cam_soc_bus_client *bus_client = NULL;
  66. struct cam_soc_bus_client_data *bus_client_data = NULL;
  67. int rc = 0;
  68. bus_client = kzalloc(sizeof(struct cam_soc_bus_client), GFP_KERNEL);
  69. if (!bus_client) {
  70. CAM_ERR(CAM_UTIL, "soc bus client is NULL");
  71. rc = -ENOMEM;
  72. goto end;
  73. }
  74. *client = bus_client;
  75. bus_client_data = kzalloc(sizeof(struct cam_soc_bus_client_data),
  76. GFP_KERNEL);
  77. if (!bus_client_data) {
  78. kfree(bus_client);
  79. *client = NULL;
  80. rc = -ENOMEM;
  81. goto end;
  82. }
  83. bus_client->client_data = bus_client_data;
  84. bus_client->common_data = common_data;
  85. bus_client_data->icc_data = icc_get(&pdev->dev,
  86. bus_client->common_data->src_id,
  87. bus_client->common_data->dst_id);
  88. if (!bus_client_data->icc_data) {
  89. CAM_ERR(CAM_UTIL, "failed in register bus client");
  90. rc = -EINVAL;
  91. goto error;
  92. }
  93. rc = icc_set_bw(bus_client_data->icc_data, 0, 0);
  94. if (rc) {
  95. CAM_ERR(CAM_UTIL, "Bus client update request failed, rc = %d",
  96. rc);
  97. goto fail_unregister_client;
  98. }
  99. CAM_DBG(CAM_UTIL, "Bus Client=[%s] : src=%d, dst=%d",
  100. bus_client->common_data->name, bus_client->common_data->src_id,
  101. bus_client->common_data->dst_id);
  102. return 0;
  103. fail_unregister_client:
  104. icc_put(bus_client_data->icc_data);
  105. error:
  106. kfree(bus_client_data);
  107. bus_client->client_data = NULL;
  108. kfree(bus_client);
  109. *client = NULL;
  110. end:
  111. return rc;
  112. }
  113. void cam_soc_bus_client_unregister(void **client)
  114. {
  115. struct cam_soc_bus_client *bus_client =
  116. (struct cam_soc_bus_client *) (*client);
  117. struct cam_soc_bus_client_data *bus_client_data =
  118. (struct cam_soc_bus_client_data *) bus_client->client_data;
  119. icc_put(bus_client_data->icc_data);
  120. kfree(bus_client_data);
  121. bus_client->client_data = NULL;
  122. kfree(bus_client);
  123. *client = NULL;
  124. }