cx18-mailbox.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748
  1. /*
  2. * cx18 mailbox functions
  3. *
  4. * Copyright (C) 2007 Hans Verkuil <hverkuil@xs4all.nl>
  5. * Copyright (C) 2008 Andy Walls <awalls@radix.net>
  6. *
  7. * This program is free software; you can redistribute it and/or modify
  8. * it under the terms of the GNU General Public License as published by
  9. * the Free Software Foundation; either version 2 of the License, or
  10. * (at your option) any later version.
  11. *
  12. * This program is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. * GNU General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
  20. * 02111-1307 USA
  21. */
  22. #include <stdarg.h>
  23. #include "cx18-driver.h"
  24. #include "cx18-io.h"
  25. #include "cx18-scb.h"
  26. #include "cx18-irq.h"
  27. #include "cx18-mailbox.h"
  28. #include "cx18-queue.h"
  29. #include "cx18-streams.h"
  30. static const char *rpu_str[] = { "APU", "CPU", "EPU", "HPU" };
  31. #define API_FAST (1 << 2) /* Short timeout */
  32. #define API_SLOW (1 << 3) /* Additional 300ms timeout */
  33. struct cx18_api_info {
  34. u32 cmd;
  35. u8 flags; /* Flags, see above */
  36. u8 rpu; /* Processing unit */
  37. const char *name; /* The name of the command */
  38. };
  39. #define API_ENTRY(rpu, x, f) { (x), (f), (rpu), #x }
  40. static const struct cx18_api_info api_info[] = {
  41. /* MPEG encoder API */
  42. API_ENTRY(CPU, CX18_CPU_SET_CHANNEL_TYPE, 0),
  43. API_ENTRY(CPU, CX18_EPU_DEBUG, 0),
  44. API_ENTRY(CPU, CX18_CREATE_TASK, 0),
  45. API_ENTRY(CPU, CX18_DESTROY_TASK, 0),
  46. API_ENTRY(CPU, CX18_CPU_CAPTURE_START, API_SLOW),
  47. API_ENTRY(CPU, CX18_CPU_CAPTURE_STOP, API_SLOW),
  48. API_ENTRY(CPU, CX18_CPU_CAPTURE_PAUSE, 0),
  49. API_ENTRY(CPU, CX18_CPU_CAPTURE_RESUME, 0),
  50. API_ENTRY(CPU, CX18_CPU_SET_CHANNEL_TYPE, 0),
  51. API_ENTRY(CPU, CX18_CPU_SET_STREAM_OUTPUT_TYPE, 0),
  52. API_ENTRY(CPU, CX18_CPU_SET_VIDEO_IN, 0),
  53. API_ENTRY(CPU, CX18_CPU_SET_VIDEO_RATE, 0),
  54. API_ENTRY(CPU, CX18_CPU_SET_VIDEO_RESOLUTION, 0),
  55. API_ENTRY(CPU, CX18_CPU_SET_FILTER_PARAM, 0),
  56. API_ENTRY(CPU, CX18_CPU_SET_SPATIAL_FILTER_TYPE, 0),
  57. API_ENTRY(CPU, CX18_CPU_SET_MEDIAN_CORING, 0),
  58. API_ENTRY(CPU, CX18_CPU_SET_INDEXTABLE, 0),
  59. API_ENTRY(CPU, CX18_CPU_SET_AUDIO_PARAMETERS, 0),
  60. API_ENTRY(CPU, CX18_CPU_SET_VIDEO_MUTE, 0),
  61. API_ENTRY(CPU, CX18_CPU_SET_AUDIO_MUTE, 0),
  62. API_ENTRY(CPU, CX18_CPU_SET_MISC_PARAMETERS, 0),
  63. API_ENTRY(CPU, CX18_CPU_SET_RAW_VBI_PARAM, API_SLOW),
  64. API_ENTRY(CPU, CX18_CPU_SET_CAPTURE_LINE_NO, 0),
  65. API_ENTRY(CPU, CX18_CPU_SET_COPYRIGHT, 0),
  66. API_ENTRY(CPU, CX18_CPU_SET_AUDIO_PID, 0),
  67. API_ENTRY(CPU, CX18_CPU_SET_VIDEO_PID, 0),
  68. API_ENTRY(CPU, CX18_CPU_SET_VER_CROP_LINE, 0),
  69. API_ENTRY(CPU, CX18_CPU_SET_GOP_STRUCTURE, 0),
  70. API_ENTRY(CPU, CX18_CPU_SET_SCENE_CHANGE_DETECTION, 0),
  71. API_ENTRY(CPU, CX18_CPU_SET_ASPECT_RATIO, 0),
  72. API_ENTRY(CPU, CX18_CPU_SET_SKIP_INPUT_FRAME, 0),
  73. API_ENTRY(CPU, CX18_CPU_SET_SLICED_VBI_PARAM, 0),
  74. API_ENTRY(CPU, CX18_CPU_SET_USERDATA_PLACE_HOLDER, 0),
  75. API_ENTRY(CPU, CX18_CPU_GET_ENC_PTS, 0),
  76. API_ENTRY(CPU, CX18_CPU_DE_SET_MDL_ACK, 0),
  77. API_ENTRY(CPU, CX18_CPU_DE_SET_MDL, API_FAST),
  78. API_ENTRY(CPU, CX18_CPU_DE_RELEASE_MDL, API_SLOW),
  79. API_ENTRY(APU, CX18_APU_START, 0),
  80. API_ENTRY(APU, CX18_APU_STOP, 0),
  81. API_ENTRY(APU, CX18_APU_RESETAI, 0),
  82. API_ENTRY(CPU, CX18_CPU_DEBUG_PEEK32, 0),
  83. API_ENTRY(0, 0, 0),
  84. };
  85. static const struct cx18_api_info *find_api_info(u32 cmd)
  86. {
  87. int i;
  88. for (i = 0; api_info[i].cmd; i++)
  89. if (api_info[i].cmd == cmd)
  90. return &api_info[i];
  91. return NULL;
  92. }
  93. /* Call with buf of n*11+1 bytes */
  94. static char *u32arr2hex(u32 data[], int n, char *buf)
  95. {
  96. char *p;
  97. int i;
  98. for (i = 0, p = buf; i < n; i++, p += 11) {
  99. /* kernel snprintf() appends '\0' always */
  100. snprintf(p, 12, " %#010x", data[i]);
  101. }
  102. *p = '\0';
  103. return buf;
  104. }
  105. static void dump_mb(struct cx18 *cx, struct cx18_mailbox *mb, char *name)
  106. {
  107. char argstr[MAX_MB_ARGUMENTS*11+1];
  108. if (!(cx18_debug & CX18_DBGFLG_API))
  109. return;
  110. CX18_DEBUG_API("%s: req %#010x ack %#010x cmd %#010x err %#010x args%s"
  111. "\n", name, mb->request, mb->ack, mb->cmd, mb->error,
  112. u32arr2hex(mb->args, MAX_MB_ARGUMENTS, argstr));
  113. }
  114. /*
  115. * Functions that run in a work_queue work handling context
  116. */
  117. static void epu_dma_done(struct cx18 *cx, struct cx18_in_work_order *order)
  118. {
  119. u32 handle, mdl_ack_count, id;
  120. struct cx18_mailbox *mb;
  121. struct cx18_mdl_ack *mdl_ack;
  122. struct cx18_stream *s;
  123. struct cx18_buffer *buf;
  124. int i;
  125. mb = &order->mb;
  126. handle = mb->args[0];
  127. s = cx18_handle_to_stream(cx, handle);
  128. if (s == NULL) {
  129. CX18_WARN("Got DMA done notification for unknown/inactive"
  130. " handle %d, %s mailbox seq no %d\n", handle,
  131. (order->flags & CX18_F_EWO_MB_STALE_UPON_RECEIPT) ?
  132. "stale" : "good", mb->request);
  133. return;
  134. }
  135. mdl_ack_count = mb->args[2];
  136. mdl_ack = order->mdl_ack;
  137. for (i = 0; i < mdl_ack_count; i++, mdl_ack++) {
  138. id = mdl_ack->id;
  139. /*
  140. * Simple integrity check for processing a stale (and possibly
  141. * inconsistent mailbox): make sure the buffer id is in the
  142. * valid range for the stream.
  143. *
  144. * We go through the trouble of dealing with stale mailboxes
  145. * because most of the time, the mailbox data is still valid and
  146. * unchanged (and in practice the firmware ping-pongs the
  147. * two mdl_ack buffers so mdl_acks are not stale).
  148. *
  149. * There are occasions when we get a half changed mailbox,
  150. * which this check catches for a handle & id mismatch. If the
  151. * handle and id do correspond, the worst case is that we
  152. * completely lost the old buffer, but pick up the new buffer
  153. * early (but the new mdl_ack is guaranteed to be good in this
  154. * case as the firmware wouldn't point us to a new mdl_ack until
  155. * it's filled in).
  156. *
  157. * cx18_queue_get buf() will detect the lost buffers
  158. * and send them back to q_free for fw rotation eventually.
  159. */
  160. if ((order->flags & CX18_F_EWO_MB_STALE_UPON_RECEIPT) &&
  161. !(id >= s->mdl_offset &&
  162. id < (s->mdl_offset + s->buffers))) {
  163. CX18_WARN("Fell behind! Ignoring stale mailbox with "
  164. " inconsistent data. Lost buffer for mailbox "
  165. "seq no %d\n", mb->request);
  166. break;
  167. }
  168. buf = cx18_queue_get_buf(s, id, mdl_ack->data_used);
  169. CX18_DEBUG_HI_DMA("DMA DONE for %s (buffer %d)\n", s->name, id);
  170. if (buf == NULL) {
  171. CX18_WARN("Could not find buf %d for stream %s\n",
  172. id, s->name);
  173. /* Put as many buffers as possible back into fw use */
  174. cx18_stream_load_fw_queue(s);
  175. continue;
  176. }
  177. if (s->type == CX18_ENC_STREAM_TYPE_TS && s->dvb.enabled) {
  178. CX18_DEBUG_HI_DMA("TS recv bytesused = %d\n",
  179. buf->bytesused);
  180. dvb_dmx_swfilter(&s->dvb.demux, buf->buf,
  181. buf->bytesused);
  182. }
  183. /* Put as many buffers as possible back into fw use */
  184. cx18_stream_load_fw_queue(s);
  185. /* Put back TS buffer, since it was removed from all queues */
  186. if (s->type == CX18_ENC_STREAM_TYPE_TS)
  187. cx18_stream_put_buf_fw(s, buf);
  188. }
  189. wake_up(&cx->dma_waitq);
  190. if (s->id != -1)
  191. wake_up(&s->waitq);
  192. }
  193. static void epu_debug(struct cx18 *cx, struct cx18_in_work_order *order)
  194. {
  195. char *p;
  196. char *str = order->str;
  197. CX18_DEBUG_INFO("%x %s\n", order->mb.args[0], str);
  198. p = strchr(str, '.');
  199. if (!test_bit(CX18_F_I_LOADED_FW, &cx->i_flags) && p && p > str)
  200. CX18_INFO("FW version: %s\n", p - 1);
  201. }
  202. static void epu_cmd(struct cx18 *cx, struct cx18_in_work_order *order)
  203. {
  204. switch (order->rpu) {
  205. case CPU:
  206. {
  207. switch (order->mb.cmd) {
  208. case CX18_EPU_DMA_DONE:
  209. epu_dma_done(cx, order);
  210. break;
  211. case CX18_EPU_DEBUG:
  212. epu_debug(cx, order);
  213. break;
  214. default:
  215. CX18_WARN("Unknown CPU to EPU mailbox command %#0x\n",
  216. order->mb.cmd);
  217. break;
  218. }
  219. break;
  220. }
  221. case APU:
  222. CX18_WARN("Unknown APU to EPU mailbox command %#0x\n",
  223. order->mb.cmd);
  224. break;
  225. default:
  226. break;
  227. }
  228. }
  229. static
  230. void free_in_work_order(struct cx18 *cx, struct cx18_in_work_order *order)
  231. {
  232. atomic_set(&order->pending, 0);
  233. }
  234. void cx18_in_work_handler(struct work_struct *work)
  235. {
  236. struct cx18_in_work_order *order =
  237. container_of(work, struct cx18_in_work_order, work);
  238. struct cx18 *cx = order->cx;
  239. epu_cmd(cx, order);
  240. free_in_work_order(cx, order);
  241. }
  242. /*
  243. * Functions that run in an interrupt handling context
  244. */
  245. static void mb_ack_irq(struct cx18 *cx, struct cx18_in_work_order *order)
  246. {
  247. struct cx18_mailbox __iomem *ack_mb;
  248. u32 ack_irq, req;
  249. switch (order->rpu) {
  250. case APU:
  251. ack_irq = IRQ_EPU_TO_APU_ACK;
  252. ack_mb = &cx->scb->apu2epu_mb;
  253. break;
  254. case CPU:
  255. ack_irq = IRQ_EPU_TO_CPU_ACK;
  256. ack_mb = &cx->scb->cpu2epu_mb;
  257. break;
  258. default:
  259. CX18_WARN("Unhandled RPU (%d) for command %x ack\n",
  260. order->rpu, order->mb.cmd);
  261. return;
  262. }
  263. req = order->mb.request;
  264. /* Don't ack if the RPU has gotten impatient and timed us out */
  265. if (req != cx18_readl(cx, &ack_mb->request) ||
  266. req == cx18_readl(cx, &ack_mb->ack)) {
  267. CX18_DEBUG_WARN("Possibly falling behind: %s self-ack'ed our "
  268. "incoming %s to EPU mailbox (sequence no. %u) "
  269. "while processing\n",
  270. rpu_str[order->rpu], rpu_str[order->rpu], req);
  271. order->flags |= CX18_F_EWO_MB_STALE_WHILE_PROC;
  272. return;
  273. }
  274. cx18_writel(cx, req, &ack_mb->ack);
  275. cx18_write_reg_expect(cx, ack_irq, SW2_INT_SET, ack_irq, ack_irq);
  276. return;
  277. }
  278. static int epu_dma_done_irq(struct cx18 *cx, struct cx18_in_work_order *order)
  279. {
  280. u32 handle, mdl_ack_offset, mdl_ack_count;
  281. struct cx18_mailbox *mb;
  282. mb = &order->mb;
  283. handle = mb->args[0];
  284. mdl_ack_offset = mb->args[1];
  285. mdl_ack_count = mb->args[2];
  286. if (handle == CX18_INVALID_TASK_HANDLE ||
  287. mdl_ack_count == 0 || mdl_ack_count > CX18_MAX_MDL_ACKS) {
  288. if ((order->flags & CX18_F_EWO_MB_STALE) == 0)
  289. mb_ack_irq(cx, order);
  290. return -1;
  291. }
  292. cx18_memcpy_fromio(cx, order->mdl_ack, cx->enc_mem + mdl_ack_offset,
  293. sizeof(struct cx18_mdl_ack) * mdl_ack_count);
  294. if ((order->flags & CX18_F_EWO_MB_STALE) == 0)
  295. mb_ack_irq(cx, order);
  296. return 1;
  297. }
  298. static
  299. int epu_debug_irq(struct cx18 *cx, struct cx18_in_work_order *order)
  300. {
  301. u32 str_offset;
  302. char *str = order->str;
  303. str[0] = '\0';
  304. str_offset = order->mb.args[1];
  305. if (str_offset) {
  306. cx18_setup_page(cx, str_offset);
  307. cx18_memcpy_fromio(cx, str, cx->enc_mem + str_offset, 252);
  308. str[252] = '\0';
  309. cx18_setup_page(cx, SCB_OFFSET);
  310. }
  311. if ((order->flags & CX18_F_EWO_MB_STALE) == 0)
  312. mb_ack_irq(cx, order);
  313. return str_offset ? 1 : 0;
  314. }
  315. static inline
  316. int epu_cmd_irq(struct cx18 *cx, struct cx18_in_work_order *order)
  317. {
  318. int ret = -1;
  319. switch (order->rpu) {
  320. case CPU:
  321. {
  322. switch (order->mb.cmd) {
  323. case CX18_EPU_DMA_DONE:
  324. ret = epu_dma_done_irq(cx, order);
  325. break;
  326. case CX18_EPU_DEBUG:
  327. ret = epu_debug_irq(cx, order);
  328. break;
  329. default:
  330. CX18_WARN("Unknown CPU to EPU mailbox command %#0x\n",
  331. order->mb.cmd);
  332. break;
  333. }
  334. break;
  335. }
  336. case APU:
  337. CX18_WARN("Unknown APU to EPU mailbox command %#0x\n",
  338. order->mb.cmd);
  339. break;
  340. default:
  341. break;
  342. }
  343. return ret;
  344. }
  345. static inline
  346. struct cx18_in_work_order *alloc_in_work_order_irq(struct cx18 *cx)
  347. {
  348. int i;
  349. struct cx18_in_work_order *order = NULL;
  350. for (i = 0; i < CX18_MAX_IN_WORK_ORDERS; i++) {
  351. /*
  352. * We only need "pending" atomic to inspect its contents,
  353. * and need not do a check and set because:
  354. * 1. Any work handler thread only clears "pending" and only
  355. * on one, particular work order at a time, per handler thread.
  356. * 2. "pending" is only set here, and we're serialized because
  357. * we're called in an IRQ handler context.
  358. */
  359. if (atomic_read(&cx->in_work_order[i].pending) == 0) {
  360. order = &cx->in_work_order[i];
  361. atomic_set(&order->pending, 1);
  362. break;
  363. }
  364. }
  365. return order;
  366. }
  367. void cx18_api_epu_cmd_irq(struct cx18 *cx, int rpu)
  368. {
  369. struct cx18_mailbox __iomem *mb;
  370. struct cx18_mailbox *order_mb;
  371. struct cx18_in_work_order *order;
  372. int submit;
  373. switch (rpu) {
  374. case CPU:
  375. mb = &cx->scb->cpu2epu_mb;
  376. break;
  377. case APU:
  378. mb = &cx->scb->apu2epu_mb;
  379. break;
  380. default:
  381. return;
  382. }
  383. order = alloc_in_work_order_irq(cx);
  384. if (order == NULL) {
  385. CX18_WARN("Unable to find blank work order form to schedule "
  386. "incoming mailbox command processing\n");
  387. return;
  388. }
  389. order->flags = 0;
  390. order->rpu = rpu;
  391. order_mb = &order->mb;
  392. /* mb->cmd and mb->args[0] through mb->args[2] */
  393. cx18_memcpy_fromio(cx, &order_mb->cmd, &mb->cmd, 4 * sizeof(u32));
  394. /* mb->request and mb->ack. N.B. we want to read mb->ack last */
  395. cx18_memcpy_fromio(cx, &order_mb->request, &mb->request,
  396. 2 * sizeof(u32));
  397. if (order_mb->request == order_mb->ack) {
  398. CX18_DEBUG_WARN("Possibly falling behind: %s self-ack'ed our "
  399. "incoming %s to EPU mailbox (sequence no. %u)"
  400. "\n",
  401. rpu_str[rpu], rpu_str[rpu], order_mb->request);
  402. if (cx18_debug & CX18_DBGFLG_WARN)
  403. dump_mb(cx, order_mb, "incoming");
  404. order->flags = CX18_F_EWO_MB_STALE_UPON_RECEIPT;
  405. }
  406. /*
  407. * Individual EPU command processing is responsible for ack-ing
  408. * a non-stale mailbox as soon as possible
  409. */
  410. submit = epu_cmd_irq(cx, order);
  411. if (submit > 0) {
  412. queue_work(cx->in_work_queue, &order->work);
  413. }
  414. }
  415. /*
  416. * Functions called from a non-interrupt, non work_queue context
  417. */
  418. static int cx18_api_call(struct cx18 *cx, u32 cmd, int args, u32 data[])
  419. {
  420. const struct cx18_api_info *info = find_api_info(cmd);
  421. u32 state, irq, req, ack, err;
  422. struct cx18_mailbox __iomem *mb;
  423. u32 __iomem *xpu_state;
  424. wait_queue_head_t *waitq;
  425. struct mutex *mb_lock;
  426. unsigned long int t0, timeout, ret;
  427. int i;
  428. char argstr[MAX_MB_ARGUMENTS*11+1];
  429. DEFINE_WAIT(w);
  430. if (info == NULL) {
  431. CX18_WARN("unknown cmd %x\n", cmd);
  432. return -EINVAL;
  433. }
  434. if (cx18_debug & CX18_DBGFLG_API) { /* only call u32arr2hex if needed */
  435. if (cmd == CX18_CPU_DE_SET_MDL) {
  436. if (cx18_debug & CX18_DBGFLG_HIGHVOL)
  437. CX18_DEBUG_HI_API("%s\tcmd %#010x args%s\n",
  438. info->name, cmd,
  439. u32arr2hex(data, args, argstr));
  440. } else
  441. CX18_DEBUG_API("%s\tcmd %#010x args%s\n",
  442. info->name, cmd,
  443. u32arr2hex(data, args, argstr));
  444. }
  445. switch (info->rpu) {
  446. case APU:
  447. waitq = &cx->mb_apu_waitq;
  448. mb_lock = &cx->epu2apu_mb_lock;
  449. irq = IRQ_EPU_TO_APU;
  450. mb = &cx->scb->epu2apu_mb;
  451. xpu_state = &cx->scb->apu_state;
  452. break;
  453. case CPU:
  454. waitq = &cx->mb_cpu_waitq;
  455. mb_lock = &cx->epu2cpu_mb_lock;
  456. irq = IRQ_EPU_TO_CPU;
  457. mb = &cx->scb->epu2cpu_mb;
  458. xpu_state = &cx->scb->cpu_state;
  459. break;
  460. default:
  461. CX18_WARN("Unknown RPU (%d) for API call\n", info->rpu);
  462. return -EINVAL;
  463. }
  464. mutex_lock(mb_lock);
  465. /*
  466. * Wait for an in-use mailbox to complete
  467. *
  468. * If the XPU is responding with Ack's, the mailbox shouldn't be in
  469. * a busy state, since we serialize access to it on our end.
  470. *
  471. * If the wait for ack after sending a previous command was interrupted
  472. * by a signal, we may get here and find a busy mailbox. After waiting,
  473. * mark it "not busy" from our end, if the XPU hasn't ack'ed it still.
  474. */
  475. state = cx18_readl(cx, xpu_state);
  476. req = cx18_readl(cx, &mb->request);
  477. timeout = msecs_to_jiffies(10);
  478. ret = wait_event_timeout(*waitq,
  479. (ack = cx18_readl(cx, &mb->ack)) == req,
  480. timeout);
  481. if (req != ack) {
  482. /* waited long enough, make the mbox "not busy" from our end */
  483. cx18_writel(cx, req, &mb->ack);
  484. CX18_ERR("mbox was found stuck busy when setting up for %s; "
  485. "clearing busy and trying to proceed\n", info->name);
  486. } else if (ret != timeout)
  487. CX18_DEBUG_API("waited %u msecs for busy mbox to be acked\n",
  488. jiffies_to_msecs(timeout-ret));
  489. /* Build the outgoing mailbox */
  490. req = ((req & 0xfffffffe) == 0xfffffffe) ? 1 : req + 1;
  491. cx18_writel(cx, cmd, &mb->cmd);
  492. for (i = 0; i < args; i++)
  493. cx18_writel(cx, data[i], &mb->args[i]);
  494. cx18_writel(cx, 0, &mb->error);
  495. cx18_writel(cx, req, &mb->request);
  496. cx18_writel(cx, req - 1, &mb->ack); /* ensure ack & req are distinct */
  497. /*
  498. * Notify the XPU and wait for it to send an Ack back
  499. */
  500. timeout = msecs_to_jiffies((info->flags & API_FAST) ? 10 : 20);
  501. CX18_DEBUG_HI_IRQ("sending interrupt SW1: %x to send %s\n",
  502. irq, info->name);
  503. /* So we don't miss the wakeup, prepare to wait before notifying fw */
  504. prepare_to_wait(waitq, &w, TASK_UNINTERRUPTIBLE);
  505. cx18_write_reg_expect(cx, irq, SW1_INT_SET, irq, irq);
  506. t0 = jiffies;
  507. ack = cx18_readl(cx, &mb->ack);
  508. if (ack != req) {
  509. schedule_timeout(timeout);
  510. ret = jiffies - t0;
  511. ack = cx18_readl(cx, &mb->ack);
  512. } else {
  513. ret = jiffies - t0;
  514. }
  515. finish_wait(waitq, &w);
  516. if (req != ack) {
  517. mutex_unlock(mb_lock);
  518. if (ret >= timeout) {
  519. /* Timed out */
  520. CX18_DEBUG_WARN("sending %s timed out waiting %d msecs "
  521. "for RPU acknowledgement\n",
  522. info->name, jiffies_to_msecs(ret));
  523. } else {
  524. CX18_DEBUG_WARN("woken up before mailbox ack was ready "
  525. "after submitting %s to RPU. only "
  526. "waited %d msecs on req %u but awakened"
  527. " with unmatched ack %u\n",
  528. info->name,
  529. jiffies_to_msecs(ret),
  530. req, ack);
  531. }
  532. return -EINVAL;
  533. }
  534. if (ret >= timeout)
  535. CX18_DEBUG_WARN("failed to be awakened upon RPU acknowledgment "
  536. "sending %s; timed out waiting %d msecs\n",
  537. info->name, jiffies_to_msecs(ret));
  538. else
  539. CX18_DEBUG_HI_API("waited %u msecs for %s to be acked\n",
  540. jiffies_to_msecs(ret), info->name);
  541. /* Collect data returned by the XPU */
  542. for (i = 0; i < MAX_MB_ARGUMENTS; i++)
  543. data[i] = cx18_readl(cx, &mb->args[i]);
  544. err = cx18_readl(cx, &mb->error);
  545. mutex_unlock(mb_lock);
  546. /*
  547. * Wait for XPU to perform extra actions for the caller in some cases.
  548. * e.g. CX18_CPU_DE_RELEASE_MDL will cause the CPU to send all buffers
  549. * back in a burst shortly thereafter
  550. */
  551. if (info->flags & API_SLOW)
  552. cx18_msleep_timeout(300, 0);
  553. if (err)
  554. CX18_DEBUG_API("mailbox error %08x for command %s\n", err,
  555. info->name);
  556. return err ? -EIO : 0;
  557. }
  558. int cx18_api(struct cx18 *cx, u32 cmd, int args, u32 data[])
  559. {
  560. return cx18_api_call(cx, cmd, args, data);
  561. }
  562. static int cx18_set_filter_param(struct cx18_stream *s)
  563. {
  564. struct cx18 *cx = s->cx;
  565. u32 mode;
  566. int ret;
  567. mode = (cx->filter_mode & 1) ? 2 : (cx->spatial_strength ? 1 : 0);
  568. ret = cx18_vapi(cx, CX18_CPU_SET_FILTER_PARAM, 4,
  569. s->handle, 1, mode, cx->spatial_strength);
  570. mode = (cx->filter_mode & 2) ? 2 : (cx->temporal_strength ? 1 : 0);
  571. ret = ret ? ret : cx18_vapi(cx, CX18_CPU_SET_FILTER_PARAM, 4,
  572. s->handle, 0, mode, cx->temporal_strength);
  573. ret = ret ? ret : cx18_vapi(cx, CX18_CPU_SET_FILTER_PARAM, 4,
  574. s->handle, 2, cx->filter_mode >> 2, 0);
  575. return ret;
  576. }
  577. int cx18_api_func(void *priv, u32 cmd, int in, int out,
  578. u32 data[CX2341X_MBOX_MAX_DATA])
  579. {
  580. struct cx18_api_func_private *api_priv = priv;
  581. struct cx18 *cx = api_priv->cx;
  582. struct cx18_stream *s = api_priv->s;
  583. switch (cmd) {
  584. case CX2341X_ENC_SET_OUTPUT_PORT:
  585. return 0;
  586. case CX2341X_ENC_SET_FRAME_RATE:
  587. return cx18_vapi(cx, CX18_CPU_SET_VIDEO_IN, 6,
  588. s->handle, 0, 0, 0, 0, data[0]);
  589. case CX2341X_ENC_SET_FRAME_SIZE:
  590. return cx18_vapi(cx, CX18_CPU_SET_VIDEO_RESOLUTION, 3,
  591. s->handle, data[1], data[0]);
  592. case CX2341X_ENC_SET_STREAM_TYPE:
  593. return cx18_vapi(cx, CX18_CPU_SET_STREAM_OUTPUT_TYPE, 2,
  594. s->handle, data[0]);
  595. case CX2341X_ENC_SET_ASPECT_RATIO:
  596. return cx18_vapi(cx, CX18_CPU_SET_ASPECT_RATIO, 2,
  597. s->handle, data[0]);
  598. case CX2341X_ENC_SET_GOP_PROPERTIES:
  599. return cx18_vapi(cx, CX18_CPU_SET_GOP_STRUCTURE, 3,
  600. s->handle, data[0], data[1]);
  601. case CX2341X_ENC_SET_GOP_CLOSURE:
  602. return 0;
  603. case CX2341X_ENC_SET_AUDIO_PROPERTIES:
  604. return cx18_vapi(cx, CX18_CPU_SET_AUDIO_PARAMETERS, 2,
  605. s->handle, data[0]);
  606. case CX2341X_ENC_MUTE_AUDIO:
  607. return cx18_vapi(cx, CX18_CPU_SET_AUDIO_MUTE, 2,
  608. s->handle, data[0]);
  609. case CX2341X_ENC_SET_BIT_RATE:
  610. return cx18_vapi(cx, CX18_CPU_SET_VIDEO_RATE, 5,
  611. s->handle, data[0], data[1], data[2], data[3]);
  612. case CX2341X_ENC_MUTE_VIDEO:
  613. return cx18_vapi(cx, CX18_CPU_SET_VIDEO_MUTE, 2,
  614. s->handle, data[0]);
  615. case CX2341X_ENC_SET_FRAME_DROP_RATE:
  616. return cx18_vapi(cx, CX18_CPU_SET_SKIP_INPUT_FRAME, 2,
  617. s->handle, data[0]);
  618. case CX2341X_ENC_MISC:
  619. return cx18_vapi(cx, CX18_CPU_SET_MISC_PARAMETERS, 4,
  620. s->handle, data[0], data[1], data[2]);
  621. case CX2341X_ENC_SET_DNR_FILTER_MODE:
  622. cx->filter_mode = (data[0] & 3) | (data[1] << 2);
  623. return cx18_set_filter_param(s);
  624. case CX2341X_ENC_SET_DNR_FILTER_PROPS:
  625. cx->spatial_strength = data[0];
  626. cx->temporal_strength = data[1];
  627. return cx18_set_filter_param(s);
  628. case CX2341X_ENC_SET_SPATIAL_FILTER_TYPE:
  629. return cx18_vapi(cx, CX18_CPU_SET_SPATIAL_FILTER_TYPE, 3,
  630. s->handle, data[0], data[1]);
  631. case CX2341X_ENC_SET_CORING_LEVELS:
  632. return cx18_vapi(cx, CX18_CPU_SET_MEDIAN_CORING, 5,
  633. s->handle, data[0], data[1], data[2], data[3]);
  634. }
  635. CX18_WARN("Unknown cmd %x\n", cmd);
  636. return 0;
  637. }
  638. int cx18_vapi_result(struct cx18 *cx, u32 data[MAX_MB_ARGUMENTS],
  639. u32 cmd, int args, ...)
  640. {
  641. va_list ap;
  642. int i;
  643. va_start(ap, args);
  644. for (i = 0; i < args; i++)
  645. data[i] = va_arg(ap, u32);
  646. va_end(ap);
  647. return cx18_api(cx, cmd, args, data);
  648. }
  649. int cx18_vapi(struct cx18 *cx, u32 cmd, int args, ...)
  650. {
  651. u32 data[MAX_MB_ARGUMENTS];
  652. va_list ap;
  653. int i;
  654. if (cx == NULL) {
  655. CX18_ERR("cx == NULL (cmd=%x)\n", cmd);
  656. return 0;
  657. }
  658. if (args > MAX_MB_ARGUMENTS) {
  659. CX18_ERR("args too big (cmd=%x)\n", cmd);
  660. args = MAX_MB_ARGUMENTS;
  661. }
  662. va_start(ap, args);
  663. for (i = 0; i < args; i++)
  664. data[i] = va_arg(ap, u32);
  665. va_end(ap);
  666. return cx18_api(cx, cmd, args, data);
  667. }