xrp_host_common.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482
  1. /*
  2. * Copyright (c) 2016 - 2018 Cadence Design Systems Inc.
  3. *
  4. * Permission is hereby granted, free of charge, to any person obtaining
  5. * a copy of this software and associated documentation files (the
  6. * "Software"), to deal in the Software without restriction, including
  7. * without limitation the rights to use, copy, modify, merge, publish,
  8. * distribute, sublicense, and/or sell copies of the Software, and to
  9. * permit persons to whom the Software is furnished to do so, subject to
  10. * the following conditions:
  11. *
  12. * The above copyright notice and this permission notice shall be included
  13. * in all copies or substantial portions of the Software.
  14. *
  15. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  16. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  17. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
  18. * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
  19. * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
  20. * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
  21. * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  22. */
  23. #include <stdint.h>
  24. #include <stdio.h>
  25. #include <string.h>
  26. #include "xrp_api.h"
  27. #include "xrp_host_common.h"
  28. #include "dsp_common.h"
  29. /* Device API. */
  30. void xrp_retain_device(struct xrp_device *device)
  31. {
  32. DSP_PRINT(DEBUG," ref %d\n",device->ref.count);
  33. retain_refcounted(device);
  34. }
  35. void xrp_release_device(struct xrp_device *device)
  36. {
  37. DSP_PRINT(DEBUG,"ref %d\n",device->ref.count);
  38. if (last_release_refcounted(device)) {
  39. xrp_impl_release_device(device);
  40. free(device);
  41. }
  42. }
  43. /* Buffer API. */
  44. struct xrp_buffer *xrp_create_buffer(struct xrp_device *device,
  45. size_t size, void *host_ptr,
  46. enum xrp_status *status)
  47. {
  48. struct xrp_buffer *buf;
  49. if (!host_ptr && !device) {
  50. set_status(status, XRP_STATUS_FAILURE);
  51. return NULL;
  52. }
  53. buf = alloc_refcounted(sizeof(*buf));
  54. if (!buf) {
  55. set_status(status, XRP_STATUS_FAILURE);
  56. return NULL;
  57. }
  58. if (!host_ptr) {
  59. enum xrp_status s;
  60. buf->type = XRP_BUFFER_TYPE_DEVICE;
  61. xrp_impl_create_device_buffer(device, buf, size, &s);
  62. if (s != XRP_STATUS_SUCCESS) {
  63. free(buf);
  64. buf = NULL;
  65. }
  66. set_status(status, s);
  67. } else {
  68. buf->type = XRP_BUFFER_TYPE_HOST;
  69. buf->ptr = host_ptr;
  70. buf->size = size;
  71. set_status(status, XRP_STATUS_SUCCESS);
  72. }
  73. // printf("%s,Debug V:%llx,P:%llx\n",__FUNCTION__,buf->ptr,buf->phy_addr);
  74. return buf;
  75. }
  76. void xrp_retain_buffer(struct xrp_buffer *buffer)
  77. {
  78. retain_refcounted(buffer);
  79. }
  80. void xrp_release_buffer(struct xrp_buffer *buffer)
  81. {
  82. DSP_PRINT(DEBUG,"ref:%d\n",buffer->ref.count);
  83. if (last_release_refcounted(buffer)) {
  84. // printf("%s,ref:%d\n",__FUNCTION__,buffer->ref.count);
  85. if (buffer->type == XRP_BUFFER_TYPE_DEVICE)
  86. xrp_impl_release_device_buffer(buffer);
  87. free(buffer);
  88. }
  89. }
  90. void *xrp_map_buffer(struct xrp_buffer *buffer, size_t offset, size_t size,
  91. enum xrp_access_flags map_flags, enum xrp_status *status)
  92. {
  93. if (offset <= buffer->size &&
  94. size <= buffer->size - offset) {
  95. retain_refcounted(buffer);
  96. (void)++buffer->map_count;
  97. buffer->map_flags |= map_flags;
  98. set_status(status, XRP_STATUS_SUCCESS);
  99. return (char *)buffer->ptr + offset;
  100. }
  101. set_status(status, XRP_STATUS_FAILURE);
  102. return NULL;
  103. }
  104. void xrp_unmap_buffer(struct xrp_buffer *buffer, void *p,
  105. enum xrp_status *status)
  106. {
  107. if (p >= buffer->ptr &&
  108. (size_t)((char *)p - (char *)buffer->ptr) <= buffer->size) {
  109. (void)--buffer->map_count;
  110. xrp_release_buffer(buffer);
  111. set_status(status, XRP_STATUS_SUCCESS);
  112. } else {
  113. set_status(status, XRP_STATUS_FAILURE);
  114. }
  115. }
  116. void xrp_buffer_get_info(struct xrp_buffer *buffer, enum xrp_buffer_info info,
  117. void *out, size_t out_sz, enum xrp_status *status)
  118. {
  119. enum xrp_status s = XRP_STATUS_FAILURE;
  120. size_t sz;
  121. void *ptr;
  122. switch (info) {
  123. case XRP_BUFFER_SIZE_SIZE_T:
  124. sz = sizeof(buffer->size);
  125. ptr = &buffer->size;
  126. break;
  127. case XRP_BUFFER_HOST_POINTER_PTR:
  128. if (buffer->type != XRP_BUFFER_TYPE_HOST) {
  129. static void *p = NULL;
  130. ptr = &p;
  131. } else {
  132. ptr = &buffer->ptr;
  133. }
  134. sz = sizeof(void *);
  135. break;
  136. case XRP_BUFFER_PHY_ADDR:
  137. ptr = &buffer->phy_addr;
  138. sz = sizeof(void *);
  139. break;
  140. case XRP_BUFFER_USER_ADDR:
  141. ptr = &buffer->ptr;
  142. sz = sizeof(void *);
  143. break;
  144. default:
  145. goto out;
  146. }
  147. if (sz == out_sz) {
  148. memcpy(out, ptr, sz);
  149. s = XRP_STATUS_SUCCESS;
  150. }
  151. out:
  152. set_status(status, s);
  153. }
  154. /* Buffer group API. */
  155. struct xrp_buffer_group *xrp_create_buffer_group(enum xrp_status *status)
  156. {
  157. struct xrp_buffer_group *group = alloc_refcounted(sizeof(*group));
  158. if (group) {
  159. xrp_mutex_init(&group->mutex);
  160. set_status(status, XRP_STATUS_SUCCESS);
  161. } else {
  162. set_status(status, XRP_STATUS_FAILURE);
  163. }
  164. return group;
  165. }
  166. void xrp_retain_buffer_group(struct xrp_buffer_group *group)
  167. {
  168. retain_refcounted(group);
  169. }
  170. void xrp_release_buffer_group(struct xrp_buffer_group *group)
  171. {
  172. if (last_release_refcounted(group)) {
  173. size_t i;
  174. xrp_mutex_lock(&group->mutex);
  175. for (i = 0; i < group->n_buffers; ++i)
  176. xrp_release_buffer(group->buffer[i].buffer);
  177. xrp_mutex_unlock(&group->mutex);
  178. xrp_mutex_destroy(&group->mutex);
  179. free(group->buffer);
  180. free(group);
  181. }
  182. }
  183. size_t xrp_add_buffer_to_group(struct xrp_buffer_group *group,
  184. struct xrp_buffer *buffer,
  185. enum xrp_access_flags access_flags,
  186. enum xrp_status *status)
  187. {
  188. size_t n_buffers;
  189. xrp_mutex_lock(&group->mutex);
  190. if (group->n_buffers == group->capacity) {
  191. struct xrp_buffer_group_record *r =
  192. realloc(group->buffer,
  193. sizeof(struct xrp_buffer_group_record) *
  194. ((group->capacity + 2) * 2));
  195. if (r == NULL) {
  196. xrp_mutex_unlock(&group->mutex);
  197. set_status(status, XRP_STATUS_FAILURE);
  198. return -1;
  199. }
  200. group->buffer = r;
  201. group->capacity = (group->capacity + 2) * 2;
  202. }
  203. xrp_retain_buffer(buffer);
  204. group->buffer[group->n_buffers].buffer = buffer;
  205. group->buffer[group->n_buffers].access_flags = access_flags;
  206. n_buffers = group->n_buffers++;
  207. xrp_mutex_unlock(&group->mutex);
  208. set_status(status, XRP_STATUS_SUCCESS);
  209. return n_buffers;
  210. }
  211. void xrp_set_buffer_in_group(struct xrp_buffer_group *group,
  212. size_t index,
  213. struct xrp_buffer *buffer,
  214. enum xrp_access_flags access_flags,
  215. enum xrp_status *status)
  216. {
  217. struct xrp_buffer *old_buffer;
  218. xrp_retain_buffer(buffer);
  219. xrp_mutex_lock(&group->mutex);
  220. if (index < group->n_buffers) {
  221. old_buffer = group->buffer[index].buffer;
  222. group->buffer[index].buffer = buffer;
  223. group->buffer[index].access_flags = access_flags;
  224. set_status(status, XRP_STATUS_SUCCESS);
  225. } else {
  226. old_buffer = buffer;
  227. set_status(status, XRP_STATUS_FAILURE);
  228. }
  229. xrp_mutex_unlock(&group->mutex);
  230. xrp_release_buffer(old_buffer);
  231. }
  232. struct xrp_buffer *xrp_get_buffer_from_group(struct xrp_buffer_group *group,
  233. size_t idx,
  234. enum xrp_status *status)
  235. {
  236. struct xrp_buffer *buffer = NULL;
  237. xrp_mutex_lock(&group->mutex);
  238. if (idx < group->n_buffers) {
  239. buffer = group->buffer[idx].buffer;
  240. // xrp_retain_buffer(buffer); temp fix for buffer ref;
  241. set_status(status, XRP_STATUS_SUCCESS);
  242. } else {
  243. set_status(status, XRP_STATUS_FAILURE);
  244. }
  245. xrp_mutex_unlock(&group->mutex);
  246. return buffer;
  247. }
  248. void xrp_buffer_group_get_info(struct xrp_buffer_group *group,
  249. enum xrp_buffer_group_info info, size_t idx,
  250. void *out, size_t out_sz,
  251. enum xrp_status *status)
  252. {
  253. enum xrp_status s = XRP_STATUS_FAILURE;
  254. size_t sz;
  255. void *ptr;
  256. xrp_mutex_lock(&group->mutex);
  257. switch (info) {
  258. case XRP_BUFFER_GROUP_BUFFER_FLAGS_ENUM:
  259. if (idx >= group->n_buffers)
  260. goto out;
  261. sz = sizeof(group->buffer[idx].access_flags);
  262. ptr = &group->buffer[idx].access_flags;
  263. break;
  264. case XRP_BUFFER_GROUP_SIZE_SIZE_T:
  265. sz = sizeof(group->n_buffers);
  266. ptr = &group->n_buffers;
  267. break;
  268. default:
  269. goto out;
  270. }
  271. if (sz == out_sz) {
  272. memcpy(out, ptr, sz);
  273. s = XRP_STATUS_SUCCESS;
  274. }
  275. out:
  276. xrp_mutex_unlock(&group->mutex);
  277. set_status(status, s);
  278. }
  279. /* Queue API. */
  280. struct xrp_queue *xrp_create_queue(struct xrp_device *device,
  281. enum xrp_status *status)
  282. {
  283. return xrp_create_ns_queue(device, NULL, status);
  284. }
  285. struct xrp_queue *xrp_create_ns_queue(struct xrp_device *device,
  286. const void *nsid,
  287. enum xrp_status *status)
  288. {
  289. return xrp_create_nsp_queue(device, nsid, 0, status);
  290. }
  291. struct xrp_queue *xrp_create_nsp_queue(struct xrp_device *device,
  292. const void *nsid,
  293. int priority,
  294. enum xrp_status *status)
  295. {
  296. struct xrp_queue *queue;
  297. xrp_retain_device(device);
  298. queue = alloc_refcounted(sizeof(*queue));
  299. if (!queue) {
  300. xrp_release_device(device);
  301. set_status(status, XRP_STATUS_FAILURE);
  302. return NULL;
  303. }
  304. queue->device = device;
  305. if (nsid) {
  306. queue->use_nsid = 1;
  307. memcpy(queue->nsid, nsid, XRP_NAMESPACE_ID_SIZE);
  308. }
  309. queue->priority = priority;
  310. xrp_impl_create_queue(queue, status);
  311. return queue;
  312. }
  313. void xrp_retain_queue(struct xrp_queue *queue)
  314. {
  315. retain_refcounted(queue);
  316. }
  317. void xrp_release_queue(struct xrp_queue *queue)
  318. {
  319. DSP_PRINT(DEBUG," ref %d\n",queue->ref.count);
  320. if (last_release_refcounted(queue)) {
  321. xrp_impl_release_queue(queue);
  322. xrp_release_device(queue->device);
  323. free(queue);
  324. }
  325. }
  326. /* Event API. */
  327. void xrp_retain_event(struct xrp_event *event)
  328. {
  329. retain_refcounted(event);
  330. }
  331. void xrp_release_event(struct xrp_event *event)
  332. {
  333. DSP_PRINT(TRACE,"event %p ref:%d\n",event,event->ref.count);
  334. if (last_release_refcounted(event)) {
  335. xrp_impl_release_event(event);
  336. xrp_release_queue(event->queue);
  337. free(event);
  338. }
  339. }
  340. void xrp_event_status(struct xrp_event *event, enum xrp_status *status)
  341. {
  342. set_status(status, event->status);
  343. }
  344. /* Communication API */
  345. void xrp_run_command_sync(struct xrp_queue *queue,
  346. const void *in_data, size_t in_data_size,
  347. void *out_data, size_t out_data_size,
  348. struct xrp_buffer_group *buffer_group,
  349. enum xrp_status *status)
  350. {
  351. struct xrp_event *evt;
  352. enum xrp_status s;
  353. xrp_enqueue_command(queue, in_data, in_data_size,
  354. out_data, out_data_size,
  355. buffer_group, &evt, &s);
  356. if (s != XRP_STATUS_SUCCESS) {
  357. set_status(status, s);
  358. return;
  359. }
  360. xrp_wait(evt, NULL);
  361. xrp_event_status(evt, status);
  362. xrp_release_event(evt);
  363. }
  364. /*reproter 机制的buffer 需要从用户态去allocated 通知DSP ,并且需要pingpong*/
  365. struct xrp_report *xrp_create_reporter(struct xrp_device *device,size_t size)
  366. {
  367. struct xrp_report *report;
  368. enum xrp_status status;
  369. report = alloc_refcounted(sizeof(*report));
  370. if (!report) {
  371. // set_status(status, XRP_STATUS_FAILURE);
  372. return NULL;
  373. }
  374. xrp_impl_create_report(device,report,size,&status);
  375. if(XRP_STATUS_FAILURE ==status)
  376. {
  377. free(report);
  378. return NULL;
  379. }
  380. return report;
  381. }
  382. int xrp_release_reporter(struct xrp_device *device,struct xrp_report *report)
  383. {
  384. enum xrp_status status;
  385. if (!report) {
  386. // set_status(status, XRP_STATUS_FAILURE);
  387. return 0;
  388. }
  389. if(last_release_refcounted(report))
  390. {
  391. xrp_impl_release_report(device,report,&status);
  392. }
  393. if(XRP_STATUS_FAILURE ==status)
  394. {
  395. DSP_PRINT(WARNING,"release report fail\n");
  396. return -1;
  397. }
  398. free(report);
  399. return 0;
  400. }
  401. // struct xrp_report *xrp_add_report_itme(struct xrp_report *report,size_t size,enum xrp_status *status)
  402. // {
  403. // void xrp_impl_add_report_item(struct xrp_report *report,
  404. // int (*cb)(void*context,void*data),
  405. // void* context,
  406. // size_t data_size,
  407. // enum xrp_status *status)
  408. // }