bitstreamfeeder.c 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516
  1. // SPDX-License-Identifier: LGPL-2.1 OR BSD-3-Clause
  2. /*
  3. * Copyright (c) 2019, Chips&Media
  4. * All rights reserved.
  5. *
  6. * Redistribution and use in source and binary forms, with or without
  7. * modification, are permitted provided that the following conditions are met:
  8. *
  9. * 1. Redistributions of source code must retain the above copyright notice, this
  10. * list of conditions and the following disclaimer.
  11. * 2. Redistributions in binary form must reproduce the above copyright notice,
  12. * this list of conditions and the following disclaimer in the documentation
  13. * and/or other materials provided with the distribution.
  14. *
  15. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
  16. * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  17. * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  18. * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR
  19. * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  20. * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  21. * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  22. * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  24. * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25. */
  26. #include <stdio.h>
  27. #include <stdarg.h>
  28. #include <time.h>
  29. #include "vpuapifunc.h"
  30. #include "main_helper.h"
  31. typedef struct {
  32. FeedingMethod method;
  33. Uint8* remainData;
  34. Uint32 remainDataSize;
  35. void* actualFeeder;
  36. Uint32 coreIdx;
  37. Uint32 room;
  38. Uint32 fillingMode;
  39. BOOL eos;
  40. DecHandle decHandle;
  41. EndianMode endian;
  42. BSFeederHook observer;
  43. void* observerArg;
  44. vpu_buffer_t bitBuffer;
  45. int sequenceHeaderSize;
  46. } BitstreamFeeder;
  47. void* BitstreamFeeder_GetActualFeeder(void *feeder)
  48. {
  49. BitstreamFeeder* handle = (BitstreamFeeder*) feeder;
  50. return handle->actualFeeder;
  51. }
  52. static void BitstreamFeeder_DummyObserver(
  53. void* handle,
  54. void* es,
  55. Uint32 size,
  56. void* arg
  57. )
  58. {
  59. UNREFERENCED_PARAMETER(handle);
  60. UNREFERENCED_PARAMETER(es);
  61. UNREFERENCED_PARAMETER(size);
  62. UNREFERENCED_PARAMETER(arg);
  63. }
  64. extern void* BSFeederFixedSize_Create(
  65. const char* path,
  66. CodStd codecId
  67. );
  68. extern BOOL BSFeederFixedSize_Destroy(
  69. void* feeder
  70. );
  71. extern Int32 BSFeederFixedSize_Act(
  72. void* feeder,
  73. BSChunk* chunk
  74. );
  75. extern BOOL BSFeederFixedSize_Rewind(
  76. void* feeder
  77. );
  78. extern void BSFeederFixedSize_SetFeedingSize(
  79. void* feeder,
  80. Uint32 feedingSize
  81. );
  82. extern void* BSFeederFrameSize_Create(
  83. const char* path,
  84. CodStd codec
  85. );
  86. extern BOOL BSFeederFrameSize_Destroy(
  87. void* feeder
  88. );
  89. extern Int32 BSFeederFrameSize_Act(
  90. void* feeder,
  91. BSChunk* packet
  92. );
  93. extern BOOL BSFeederFrameSize_Rewind(
  94. void* feeder
  95. );
  96. extern void* BSFeederSizePlusEs_Create(
  97. const char* path,
  98. CodStd codecId
  99. );
  100. extern BOOL BSFeederSizePlusEs_Destroy(
  101. void* feeder
  102. );
  103. extern Int32 BSFeederSizePlusEs_Act(
  104. void* feeder,
  105. BSChunk* chunk
  106. );
  107. extern BOOL BSFeederSizePlusEs_Rewind(
  108. void* feeder
  109. );
  110. extern Int32 BSFeederFrameSize_GetStandard(
  111. void* feeder
  112. );
  113. extern void* BSFeederBuffer_Create(
  114. const char* path,
  115. CodStd codecId
  116. );
  117. extern BOOL BSFeederBuffer_Destroy(
  118. void* feeder
  119. );
  120. extern Int32 BSFeederBuffer_Act(
  121. void* feeder,
  122. BSChunk* chunk
  123. );
  124. extern BOOL BSFeederBuffer_Rewind(
  125. void* feeder
  126. );
  127. extern void BSFeederBuffer_SetFeedingSize(
  128. void* feeder,
  129. Uint32 feedingSize
  130. );
  131. /**
  132. * Abstract Bitstream Feeader Functions
  133. */
  134. void* BitstreamFeeder_Create(
  135. Uint32 coreIdx,
  136. const char* path,
  137. CodStd codecId,
  138. FeedingMethod method,
  139. EndianMode endian
  140. )
  141. {
  142. /*lint -esym(438, ap) */
  143. BitstreamFeeder* handle = NULL;
  144. void* feeder = NULL;
  145. switch (method) {
  146. case FEEDING_METHOD_FIXED_SIZE:
  147. feeder = BSFeederFixedSize_Create(path, codecId);
  148. break;
  149. case FEEDING_METHOD_FRAME_SIZE:
  150. feeder = BSFeederFrameSize_Create(path, codecId);
  151. break;
  152. case FEEDING_METHOD_SIZE_PLUS_ES:
  153. feeder = BSFeederSizePlusEs_Create(path, codecId);
  154. break;
  155. #ifdef USE_FEEDING_METHOD_BUFFER
  156. case FEEDING_METHOD_BUFFER:
  157. feeder = BSFeederBuffer_Create(path, codecId);
  158. break;
  159. #endif
  160. default:
  161. feeder = NULL;
  162. break;
  163. }
  164. if (feeder != NULL) {
  165. if ((handle=(BitstreamFeeder*)osal_malloc(sizeof(BitstreamFeeder))) == NULL) {
  166. VLOG(ERR, "%s:%d Failed to allocate memory\n", __FUNCTION__, __LINE__);
  167. return NULL;
  168. }
  169. handle->actualFeeder = feeder;
  170. handle->method = method;
  171. handle->remainData = NULL;
  172. handle->remainDataSize = 0;
  173. handle->fillingMode = (method == FEEDING_METHOD_FIXED_SIZE) ? BSF_FILLING_RINGBUFFER : BSF_FILLING_LINEBUFFER;
  174. handle->eos = FALSE;
  175. handle->observer = (BSFeederHook)BitstreamFeeder_DummyObserver;
  176. handle->observerArg = NULL;
  177. handle->endian = endian;
  178. handle->coreIdx = coreIdx;
  179. }
  180. return handle;
  181. /*lint +esym(438, ap) */
  182. }
  183. void BitstreamFeeder_SetFillMode(
  184. BSFeeder feeder,
  185. Uint32 mode
  186. )
  187. {
  188. BitstreamFeeder* bsf = (BitstreamFeeder*)feeder;
  189. switch (mode) {
  190. case BSF_FILLING_AUTO:
  191. bsf->fillingMode = (bsf->method == FEEDING_METHOD_FIXED_SIZE) ? BSF_FILLING_RINGBUFFER : BSF_FILLING_LINEBUFFER;
  192. break;
  193. case BSF_FILLING_RINGBUFFER:
  194. case BSF_FILLING_LINEBUFFER:
  195. case BSF_FILLING_RINGBUFFER_WITH_ENDFLAG:
  196. bsf->fillingMode = mode;
  197. break;
  198. default:
  199. VLOG(INFO, "%s Not supported mode %d\n", __FUNCTION__, mode);
  200. break;
  201. }
  202. }
  203. BOOL BitstreamFeeder_SetFeedingSize(
  204. BSFeeder feeder,
  205. Uint32 size
  206. )
  207. {
  208. BitstreamFeeder* bsf = (BitstreamFeeder*)feeder;
  209. BOOL ret = FALSE;
  210. if (bsf->method == FEEDING_METHOD_FIXED_SIZE) {
  211. BSFeederFixedSize_SetFeedingSize(bsf->actualFeeder, size);
  212. ret = TRUE;
  213. }
  214. return ret;
  215. }
  216. Uint32 BitstreamFeeder_Act(
  217. BSFeeder feeder,
  218. vpu_buffer_t* bsBuffer,
  219. PhysicalAddress wrPtr,
  220. Uint32 room,
  221. PhysicalAddress* newWrPtr
  222. )
  223. {
  224. BitstreamFeeder* bsf = (BitstreamFeeder*)feeder;
  225. Int32 feedingSize = 0;
  226. BSChunk chunk = {0};
  227. EndianMode endian;
  228. if (bsf == NULL) {
  229. VLOG(ERR, "%s:%d Null handle\n", __FUNCTION__, __LINE__);
  230. return 0;
  231. }
  232. endian = bsf->endian;
  233. if (bsf->remainData == NULL) {
  234. chunk.size = bsBuffer->size;
  235. chunk.data = osal_malloc(chunk.size);
  236. chunk.eos = FALSE;
  237. if (chunk.data == NULL) {
  238. VLOG(ERR, "%s:%d failed to allocate memory\n", __FUNCTION__, __LINE__);
  239. return 0;
  240. }
  241. switch (bsf->method) {
  242. case FEEDING_METHOD_FIXED_SIZE:
  243. feedingSize = BSFeederFixedSize_Act(bsf->actualFeeder, &chunk);
  244. break;
  245. case FEEDING_METHOD_FRAME_SIZE:
  246. feedingSize = BSFeederFrameSize_Act(bsf->actualFeeder, &chunk);
  247. break;
  248. case FEEDING_METHOD_SIZE_PLUS_ES:
  249. feedingSize = BSFeederSizePlusEs_Act(bsf->actualFeeder, &chunk);
  250. break;
  251. #ifdef USE_FEEDING_METHOD_BUFFER
  252. case FEEDING_METHOD_BUFFER:
  253. feedingSize = BSFeederBuffer_Act(bsf->actualFeeder, &chunk);
  254. break;
  255. #endif
  256. default:
  257. VLOG(ERR, "%s:%d Invalid method(%d)\n", __FUNCTION__, __LINE__, bsf->method);
  258. osal_free(chunk.data);
  259. return 0;
  260. }
  261. }
  262. else {
  263. chunk.data = bsf->remainData;
  264. feedingSize = bsf->remainDataSize;
  265. }
  266. bsf->observer((void*)bsf, chunk.data, feedingSize, bsf->observerArg);
  267. if (feedingSize < 0) {
  268. VLOG(ERR, "feeding size is negative value: %d\n", feedingSize);
  269. osal_free(chunk.data);
  270. return 0;
  271. }
  272. if (feedingSize > 0) {
  273. Uint32 rightSize=0, leftSize=feedingSize;
  274. PhysicalAddress base = bsBuffer->phys_addr;
  275. Uint32 size = bsBuffer->size;
  276. if ((Int32)room < feedingSize) {
  277. bsf->remainData = chunk.data;
  278. bsf->remainDataSize = feedingSize;
  279. return 0;
  280. }
  281. if (bsf->fillingMode == BSF_FILLING_RINGBUFFER || bsf->fillingMode == BSF_FILLING_RINGBUFFER_WITH_ENDFLAG) {
  282. if ((wrPtr+feedingSize) >= (base+size)) {
  283. PhysicalAddress endAddr = base+size;
  284. rightSize = endAddr-wrPtr;
  285. leftSize = (wrPtr+feedingSize) - endAddr;
  286. if (rightSize > 0) {
  287. VpuWriteMem(bsf->coreIdx, wrPtr, (unsigned char*)chunk.data, rightSize, (int)endian);
  288. VLOG(TRACE, "<%s:%d> WRPTR: %p SIZE: %x\n", __FUNCTION__, __LINE__, wrPtr, rightSize);
  289. }
  290. wrPtr = base;
  291. }
  292. }
  293. VpuWriteMem(bsf->coreIdx, wrPtr, (unsigned char*)chunk.data+rightSize, leftSize, (int)endian);
  294. *newWrPtr = wrPtr + leftSize;
  295. }
  296. bsf->eos = chunk.eos;
  297. bsf->sequenceHeaderSize = chunk.seqHeaderSize;
  298. osal_free(chunk.data);
  299. bsf->remainData = NULL;
  300. bsf->remainDataSize = 0;
  301. return feedingSize;
  302. }
  303. BOOL BitstreamFeeder_IsEos(
  304. BSFeeder feeder
  305. )
  306. {
  307. BitstreamFeeder* bsf = (BitstreamFeeder*)feeder;
  308. if (bsf == NULL) {
  309. VLOG(ERR, "%s:%d Null handle\n", __FUNCTION__, __LINE__);
  310. return FALSE;
  311. }
  312. return bsf->eos;
  313. }
  314. Uint32 BitstreamFeeder_GetSeqHeaderSize(
  315. BSFeeder feeder
  316. )
  317. {
  318. BitstreamFeeder* bsf = (BitstreamFeeder*)feeder;
  319. if (bsf == NULL) {
  320. VLOG(ERR, "%s:%d Null handle\n", __FUNCTION__, __LINE__);
  321. return FALSE;
  322. }
  323. return bsf->sequenceHeaderSize;
  324. }
  325. Int32 BitstreamFeeder_GetStandard(
  326. BSFeeder feeder
  327. )
  328. {
  329. BitstreamFeeder* bsf = (BitstreamFeeder*)feeder;
  330. Int32 standard = -1;
  331. if (bsf == NULL) {
  332. VLOG(ERR, "%s:%d Null handle\n", __FUNCTION__, __LINE__);
  333. return FALSE;
  334. }
  335. switch (bsf->method) {
  336. case FEEDING_METHOD_FRAME_SIZE:
  337. standard = BSFeederFrameSize_GetStandard(bsf->actualFeeder);
  338. break;
  339. case FEEDING_METHOD_FIXED_SIZE:
  340. case FEEDING_METHOD_SIZE_PLUS_ES:
  341. #ifdef USE_FEEDING_METHOD_BUFFER
  342. case FEEDING_METHOD_BUFFER:
  343. #endif
  344. default:
  345. VLOG(ERR, "%s:%d Invalid return value (%d), method(%d)\n", __FUNCTION__, __LINE__, -1, bsf->method);
  346. break;
  347. }
  348. return standard;
  349. }
  350. void BitstreamFeeder_Stop(
  351. BSFeeder feeder
  352. )
  353. {
  354. BitstreamFeeder* bsf = (BitstreamFeeder*)feeder;
  355. if (bsf == NULL) {
  356. VLOG(ERR, "%s:%d Null handle\n", __FUNCTION__, __LINE__);
  357. return;
  358. }
  359. }
  360. BOOL BitstreamFeeder_Destroy(
  361. BSFeeder feeder
  362. )
  363. {
  364. BitstreamFeeder* bsf = (BitstreamFeeder*)feeder;
  365. if (bsf == NULL) {
  366. return FALSE;
  367. }
  368. switch (bsf->method) {
  369. case FEEDING_METHOD_FIXED_SIZE:
  370. BSFeederFixedSize_Destroy(bsf->actualFeeder);
  371. break;
  372. case FEEDING_METHOD_FRAME_SIZE:
  373. BSFeederFrameSize_Destroy(bsf->actualFeeder);
  374. break;
  375. case FEEDING_METHOD_SIZE_PLUS_ES:
  376. BSFeederSizePlusEs_Destroy(bsf->actualFeeder);
  377. break;
  378. #ifdef USE_FEEDING_METHOD_BUFFER
  379. case FEEDING_METHOD_BUFFER:
  380. BSFeederBuffer_Destroy(bsf->actualFeeder);
  381. break;
  382. #endif
  383. default:
  384. VLOG(ERR, "%s:%d Invalid method(%d)\n", __FUNCTION__, __LINE__, bsf->method);
  385. break;
  386. }
  387. if (bsf->remainData) {
  388. osal_free(bsf->remainData);
  389. }
  390. osal_free(bsf);
  391. return TRUE;
  392. }
  393. BOOL BitstreamFeeder_Rewind(
  394. BSFeeder feeder
  395. )
  396. {
  397. BitstreamFeeder* bsf = (BitstreamFeeder*)feeder;
  398. BOOL success = FALSE;
  399. if (bsf == NULL) {
  400. VLOG(ERR, "%s:%d handle is NULL\n", __FUNCTION__, __LINE__);
  401. return success;
  402. }
  403. switch (bsf->method) {
  404. case FEEDING_METHOD_FIXED_SIZE:
  405. success = BSFeederFixedSize_Rewind(bsf->actualFeeder);
  406. break;
  407. case FEEDING_METHOD_FRAME_SIZE:
  408. success = BSFeederFrameSize_Rewind(bsf->actualFeeder);
  409. break;
  410. case FEEDING_METHOD_SIZE_PLUS_ES:
  411. success = BSFeederSizePlusEs_Rewind(bsf->actualFeeder);
  412. break;
  413. #ifdef USE_FEEDING_METHOD_BUFFER
  414. case FEEDING_METHOD_BUFFER:
  415. #endif
  416. default:
  417. VLOG(ERR, "%s:%d Invalid method(%d)\n", __FUNCTION__, __LINE__, bsf->method);
  418. break;
  419. }
  420. if (success == TRUE) {
  421. bsf->eos = FALSE;
  422. }
  423. return success;
  424. }
  425. BOOL BitstreamFeeder_SetHook(
  426. BSFeeder feeder,
  427. BSFeederHook hookFunc,
  428. void* hookArg
  429. )
  430. {
  431. BitstreamFeeder* bsf = (BitstreamFeeder*)feeder;
  432. if (bsf == NULL) {
  433. VLOG(ERR, "%s:%d handle is NULL\n", __FUNCTION__, __LINE__);
  434. return FALSE;
  435. }
  436. if (hookFunc == NULL) {
  437. bsf->observer = (BSFeederHook)BitstreamFeeder_DummyObserver;
  438. }
  439. else {
  440. bsf->observer = hookFunc;
  441. }
  442. bsf->observerArg = hookArg;
  443. return TRUE;
  444. }