ipu-ic.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Copyright (C) 2012-2014 Mentor Graphics Inc.
  4. * Copyright 2005-2012 Freescale Semiconductor, Inc. All Rights Reserved.
  5. */
  6. #include <linux/types.h>
  7. #include <linux/init.h>
  8. #include <linux/errno.h>
  9. #include <linux/spinlock.h>
  10. #include <linux/bitrev.h>
  11. #include <linux/io.h>
  12. #include <linux/err.h>
  13. #include <linux/sizes.h>
  14. #include "ipu-prv.h"
  15. /* IC Register Offsets */
  16. #define IC_CONF 0x0000
  17. #define IC_PRP_ENC_RSC 0x0004
  18. #define IC_PRP_VF_RSC 0x0008
  19. #define IC_PP_RSC 0x000C
  20. #define IC_CMBP_1 0x0010
  21. #define IC_CMBP_2 0x0014
  22. #define IC_IDMAC_1 0x0018
  23. #define IC_IDMAC_2 0x001C
  24. #define IC_IDMAC_3 0x0020
  25. #define IC_IDMAC_4 0x0024
  26. /* IC Register Fields */
  27. #define IC_CONF_PRPENC_EN (1 << 0)
  28. #define IC_CONF_PRPENC_CSC1 (1 << 1)
  29. #define IC_CONF_PRPENC_ROT_EN (1 << 2)
  30. #define IC_CONF_PRPVF_EN (1 << 8)
  31. #define IC_CONF_PRPVF_CSC1 (1 << 9)
  32. #define IC_CONF_PRPVF_CSC2 (1 << 10)
  33. #define IC_CONF_PRPVF_CMB (1 << 11)
  34. #define IC_CONF_PRPVF_ROT_EN (1 << 12)
  35. #define IC_CONF_PP_EN (1 << 16)
  36. #define IC_CONF_PP_CSC1 (1 << 17)
  37. #define IC_CONF_PP_CSC2 (1 << 18)
  38. #define IC_CONF_PP_CMB (1 << 19)
  39. #define IC_CONF_PP_ROT_EN (1 << 20)
  40. #define IC_CONF_IC_GLB_LOC_A (1 << 28)
  41. #define IC_CONF_KEY_COLOR_EN (1 << 29)
  42. #define IC_CONF_RWS_EN (1 << 30)
  43. #define IC_CONF_CSI_MEM_WR_EN (1 << 31)
  44. #define IC_IDMAC_1_CB0_BURST_16 (1 << 0)
  45. #define IC_IDMAC_1_CB1_BURST_16 (1 << 1)
  46. #define IC_IDMAC_1_CB2_BURST_16 (1 << 2)
  47. #define IC_IDMAC_1_CB3_BURST_16 (1 << 3)
  48. #define IC_IDMAC_1_CB4_BURST_16 (1 << 4)
  49. #define IC_IDMAC_1_CB5_BURST_16 (1 << 5)
  50. #define IC_IDMAC_1_CB6_BURST_16 (1 << 6)
  51. #define IC_IDMAC_1_CB7_BURST_16 (1 << 7)
  52. #define IC_IDMAC_1_PRPENC_ROT_MASK (0x7 << 11)
  53. #define IC_IDMAC_1_PRPENC_ROT_OFFSET 11
  54. #define IC_IDMAC_1_PRPVF_ROT_MASK (0x7 << 14)
  55. #define IC_IDMAC_1_PRPVF_ROT_OFFSET 14
  56. #define IC_IDMAC_1_PP_ROT_MASK (0x7 << 17)
  57. #define IC_IDMAC_1_PP_ROT_OFFSET 17
  58. #define IC_IDMAC_1_PP_FLIP_RS (1 << 22)
  59. #define IC_IDMAC_1_PRPVF_FLIP_RS (1 << 21)
  60. #define IC_IDMAC_1_PRPENC_FLIP_RS (1 << 20)
  61. #define IC_IDMAC_2_PRPENC_HEIGHT_MASK (0x3ff << 0)
  62. #define IC_IDMAC_2_PRPENC_HEIGHT_OFFSET 0
  63. #define IC_IDMAC_2_PRPVF_HEIGHT_MASK (0x3ff << 10)
  64. #define IC_IDMAC_2_PRPVF_HEIGHT_OFFSET 10
  65. #define IC_IDMAC_2_PP_HEIGHT_MASK (0x3ff << 20)
  66. #define IC_IDMAC_2_PP_HEIGHT_OFFSET 20
  67. #define IC_IDMAC_3_PRPENC_WIDTH_MASK (0x3ff << 0)
  68. #define IC_IDMAC_3_PRPENC_WIDTH_OFFSET 0
  69. #define IC_IDMAC_3_PRPVF_WIDTH_MASK (0x3ff << 10)
  70. #define IC_IDMAC_3_PRPVF_WIDTH_OFFSET 10
  71. #define IC_IDMAC_3_PP_WIDTH_MASK (0x3ff << 20)
  72. #define IC_IDMAC_3_PP_WIDTH_OFFSET 20
  73. struct ic_task_regoffs {
  74. u32 rsc;
  75. u32 tpmem_csc[2];
  76. };
  77. struct ic_task_bitfields {
  78. u32 ic_conf_en;
  79. u32 ic_conf_rot_en;
  80. u32 ic_conf_cmb_en;
  81. u32 ic_conf_csc1_en;
  82. u32 ic_conf_csc2_en;
  83. u32 ic_cmb_galpha_bit;
  84. };
  85. static const struct ic_task_regoffs ic_task_reg[IC_NUM_TASKS] = {
  86. [IC_TASK_ENCODER] = {
  87. .rsc = IC_PRP_ENC_RSC,
  88. .tpmem_csc = {0x2008, 0},
  89. },
  90. [IC_TASK_VIEWFINDER] = {
  91. .rsc = IC_PRP_VF_RSC,
  92. .tpmem_csc = {0x4028, 0x4040},
  93. },
  94. [IC_TASK_POST_PROCESSOR] = {
  95. .rsc = IC_PP_RSC,
  96. .tpmem_csc = {0x6060, 0x6078},
  97. },
  98. };
  99. static const struct ic_task_bitfields ic_task_bit[IC_NUM_TASKS] = {
  100. [IC_TASK_ENCODER] = {
  101. .ic_conf_en = IC_CONF_PRPENC_EN,
  102. .ic_conf_rot_en = IC_CONF_PRPENC_ROT_EN,
  103. .ic_conf_cmb_en = 0, /* NA */
  104. .ic_conf_csc1_en = IC_CONF_PRPENC_CSC1,
  105. .ic_conf_csc2_en = 0, /* NA */
  106. .ic_cmb_galpha_bit = 0, /* NA */
  107. },
  108. [IC_TASK_VIEWFINDER] = {
  109. .ic_conf_en = IC_CONF_PRPVF_EN,
  110. .ic_conf_rot_en = IC_CONF_PRPVF_ROT_EN,
  111. .ic_conf_cmb_en = IC_CONF_PRPVF_CMB,
  112. .ic_conf_csc1_en = IC_CONF_PRPVF_CSC1,
  113. .ic_conf_csc2_en = IC_CONF_PRPVF_CSC2,
  114. .ic_cmb_galpha_bit = 0,
  115. },
  116. [IC_TASK_POST_PROCESSOR] = {
  117. .ic_conf_en = IC_CONF_PP_EN,
  118. .ic_conf_rot_en = IC_CONF_PP_ROT_EN,
  119. .ic_conf_cmb_en = IC_CONF_PP_CMB,
  120. .ic_conf_csc1_en = IC_CONF_PP_CSC1,
  121. .ic_conf_csc2_en = IC_CONF_PP_CSC2,
  122. .ic_cmb_galpha_bit = 8,
  123. },
  124. };
  125. struct ipu_ic_priv;
  126. struct ipu_ic {
  127. enum ipu_ic_task task;
  128. const struct ic_task_regoffs *reg;
  129. const struct ic_task_bitfields *bit;
  130. struct ipu_ic_colorspace in_cs;
  131. struct ipu_ic_colorspace g_in_cs;
  132. struct ipu_ic_colorspace out_cs;
  133. bool graphics;
  134. bool rotation;
  135. bool in_use;
  136. struct ipu_ic_priv *priv;
  137. };
  138. struct ipu_ic_priv {
  139. void __iomem *base;
  140. void __iomem *tpmem_base;
  141. spinlock_t lock;
  142. struct ipu_soc *ipu;
  143. int use_count;
  144. int irt_use_count;
  145. struct ipu_ic task[IC_NUM_TASKS];
  146. };
  147. static inline u32 ipu_ic_read(struct ipu_ic *ic, unsigned offset)
  148. {
  149. return readl(ic->priv->base + offset);
  150. }
  151. static inline void ipu_ic_write(struct ipu_ic *ic, u32 value, unsigned offset)
  152. {
  153. writel(value, ic->priv->base + offset);
  154. }
  155. static int init_csc(struct ipu_ic *ic,
  156. const struct ipu_ic_csc *csc,
  157. int csc_index)
  158. {
  159. struct ipu_ic_priv *priv = ic->priv;
  160. u32 __iomem *base;
  161. const u16 (*c)[3];
  162. const u16 *a;
  163. u32 param;
  164. base = (u32 __iomem *)
  165. (priv->tpmem_base + ic->reg->tpmem_csc[csc_index]);
  166. /* Cast to unsigned */
  167. c = (const u16 (*)[3])csc->params.coeff;
  168. a = (const u16 *)csc->params.offset;
  169. param = ((a[0] & 0x1f) << 27) | ((c[0][0] & 0x1ff) << 18) |
  170. ((c[1][1] & 0x1ff) << 9) | (c[2][2] & 0x1ff);
  171. writel(param, base++);
  172. param = ((a[0] & 0x1fe0) >> 5) | (csc->params.scale << 8) |
  173. (csc->params.sat << 10);
  174. writel(param, base++);
  175. param = ((a[1] & 0x1f) << 27) | ((c[0][1] & 0x1ff) << 18) |
  176. ((c[1][0] & 0x1ff) << 9) | (c[2][0] & 0x1ff);
  177. writel(param, base++);
  178. param = ((a[1] & 0x1fe0) >> 5);
  179. writel(param, base++);
  180. param = ((a[2] & 0x1f) << 27) | ((c[0][2] & 0x1ff) << 18) |
  181. ((c[1][2] & 0x1ff) << 9) | (c[2][1] & 0x1ff);
  182. writel(param, base++);
  183. param = ((a[2] & 0x1fe0) >> 5);
  184. writel(param, base++);
  185. return 0;
  186. }
  187. static int calc_resize_coeffs(struct ipu_ic *ic,
  188. u32 in_size, u32 out_size,
  189. u32 *resize_coeff,
  190. u32 *downsize_coeff)
  191. {
  192. struct ipu_ic_priv *priv = ic->priv;
  193. struct ipu_soc *ipu = priv->ipu;
  194. u32 temp_size, temp_downsize;
  195. /*
  196. * Input size cannot be more than 4096, and output size cannot
  197. * be more than 1024
  198. */
  199. if (in_size > 4096) {
  200. dev_err(ipu->dev, "Unsupported resize (in_size > 4096)\n");
  201. return -EINVAL;
  202. }
  203. if (out_size > 1024) {
  204. dev_err(ipu->dev, "Unsupported resize (out_size > 1024)\n");
  205. return -EINVAL;
  206. }
  207. /* Cannot downsize more than 4:1 */
  208. if ((out_size << 2) < in_size) {
  209. dev_err(ipu->dev, "Unsupported downsize\n");
  210. return -EINVAL;
  211. }
  212. /* Compute downsizing coefficient */
  213. temp_downsize = 0;
  214. temp_size = in_size;
  215. while (((temp_size > 1024) || (temp_size >= out_size * 2)) &&
  216. (temp_downsize < 2)) {
  217. temp_size >>= 1;
  218. temp_downsize++;
  219. }
  220. *downsize_coeff = temp_downsize;
  221. /*
  222. * compute resizing coefficient using the following equation:
  223. * resize_coeff = M * (SI - 1) / (SO - 1)
  224. * where M = 2^13, SI = input size, SO = output size
  225. */
  226. *resize_coeff = (8192L * (temp_size - 1)) / (out_size - 1);
  227. if (*resize_coeff >= 16384L) {
  228. dev_err(ipu->dev, "Warning! Overflow on resize coeff.\n");
  229. *resize_coeff = 0x3FFF;
  230. }
  231. return 0;
  232. }
  233. void ipu_ic_task_enable(struct ipu_ic *ic)
  234. {
  235. struct ipu_ic_priv *priv = ic->priv;
  236. unsigned long flags;
  237. u32 ic_conf;
  238. spin_lock_irqsave(&priv->lock, flags);
  239. ic_conf = ipu_ic_read(ic, IC_CONF);
  240. ic_conf |= ic->bit->ic_conf_en;
  241. if (ic->rotation)
  242. ic_conf |= ic->bit->ic_conf_rot_en;
  243. if (ic->in_cs.cs != ic->out_cs.cs)
  244. ic_conf |= ic->bit->ic_conf_csc1_en;
  245. if (ic->graphics) {
  246. ic_conf |= ic->bit->ic_conf_cmb_en;
  247. ic_conf |= ic->bit->ic_conf_csc1_en;
  248. if (ic->g_in_cs.cs != ic->out_cs.cs)
  249. ic_conf |= ic->bit->ic_conf_csc2_en;
  250. }
  251. ipu_ic_write(ic, ic_conf, IC_CONF);
  252. spin_unlock_irqrestore(&priv->lock, flags);
  253. }
  254. EXPORT_SYMBOL_GPL(ipu_ic_task_enable);
  255. void ipu_ic_task_disable(struct ipu_ic *ic)
  256. {
  257. struct ipu_ic_priv *priv = ic->priv;
  258. unsigned long flags;
  259. u32 ic_conf;
  260. spin_lock_irqsave(&priv->lock, flags);
  261. ic_conf = ipu_ic_read(ic, IC_CONF);
  262. ic_conf &= ~(ic->bit->ic_conf_en |
  263. ic->bit->ic_conf_csc1_en |
  264. ic->bit->ic_conf_rot_en);
  265. if (ic->bit->ic_conf_csc2_en)
  266. ic_conf &= ~ic->bit->ic_conf_csc2_en;
  267. if (ic->bit->ic_conf_cmb_en)
  268. ic_conf &= ~ic->bit->ic_conf_cmb_en;
  269. ipu_ic_write(ic, ic_conf, IC_CONF);
  270. spin_unlock_irqrestore(&priv->lock, flags);
  271. }
  272. EXPORT_SYMBOL_GPL(ipu_ic_task_disable);
  273. int ipu_ic_task_init_rsc(struct ipu_ic *ic,
  274. const struct ipu_ic_csc *csc,
  275. int in_width, int in_height,
  276. int out_width, int out_height,
  277. u32 rsc)
  278. {
  279. struct ipu_ic_priv *priv = ic->priv;
  280. u32 downsize_coeff, resize_coeff;
  281. unsigned long flags;
  282. int ret = 0;
  283. if (!rsc) {
  284. /* Setup vertical resizing */
  285. ret = calc_resize_coeffs(ic, in_height, out_height,
  286. &resize_coeff, &downsize_coeff);
  287. if (ret)
  288. return ret;
  289. rsc = (downsize_coeff << 30) | (resize_coeff << 16);
  290. /* Setup horizontal resizing */
  291. ret = calc_resize_coeffs(ic, in_width, out_width,
  292. &resize_coeff, &downsize_coeff);
  293. if (ret)
  294. return ret;
  295. rsc |= (downsize_coeff << 14) | resize_coeff;
  296. }
  297. spin_lock_irqsave(&priv->lock, flags);
  298. ipu_ic_write(ic, rsc, ic->reg->rsc);
  299. /* Setup color space conversion */
  300. ic->in_cs = csc->in_cs;
  301. ic->out_cs = csc->out_cs;
  302. ret = init_csc(ic, csc, 0);
  303. spin_unlock_irqrestore(&priv->lock, flags);
  304. return ret;
  305. }
  306. int ipu_ic_task_init(struct ipu_ic *ic,
  307. const struct ipu_ic_csc *csc,
  308. int in_width, int in_height,
  309. int out_width, int out_height)
  310. {
  311. return ipu_ic_task_init_rsc(ic, csc,
  312. in_width, in_height,
  313. out_width, out_height, 0);
  314. }
  315. EXPORT_SYMBOL_GPL(ipu_ic_task_init);
  316. int ipu_ic_task_idma_init(struct ipu_ic *ic, struct ipuv3_channel *channel,
  317. u32 width, u32 height, int burst_size,
  318. enum ipu_rotate_mode rot)
  319. {
  320. struct ipu_ic_priv *priv = ic->priv;
  321. struct ipu_soc *ipu = priv->ipu;
  322. u32 ic_idmac_1, ic_idmac_2, ic_idmac_3;
  323. u32 temp_rot = bitrev8(rot) >> 5;
  324. bool need_hor_flip = false;
  325. unsigned long flags;
  326. int ret = 0;
  327. if ((burst_size != 8) && (burst_size != 16)) {
  328. dev_err(ipu->dev, "Illegal burst length for IC\n");
  329. return -EINVAL;
  330. }
  331. width--;
  332. height--;
  333. if (temp_rot & 0x2) /* Need horizontal flip */
  334. need_hor_flip = true;
  335. spin_lock_irqsave(&priv->lock, flags);
  336. ic_idmac_1 = ipu_ic_read(ic, IC_IDMAC_1);
  337. ic_idmac_2 = ipu_ic_read(ic, IC_IDMAC_2);
  338. ic_idmac_3 = ipu_ic_read(ic, IC_IDMAC_3);
  339. switch (channel->num) {
  340. case IPUV3_CHANNEL_IC_PP_MEM:
  341. if (burst_size == 16)
  342. ic_idmac_1 |= IC_IDMAC_1_CB2_BURST_16;
  343. else
  344. ic_idmac_1 &= ~IC_IDMAC_1_CB2_BURST_16;
  345. if (need_hor_flip)
  346. ic_idmac_1 |= IC_IDMAC_1_PP_FLIP_RS;
  347. else
  348. ic_idmac_1 &= ~IC_IDMAC_1_PP_FLIP_RS;
  349. ic_idmac_2 &= ~IC_IDMAC_2_PP_HEIGHT_MASK;
  350. ic_idmac_2 |= height << IC_IDMAC_2_PP_HEIGHT_OFFSET;
  351. ic_idmac_3 &= ~IC_IDMAC_3_PP_WIDTH_MASK;
  352. ic_idmac_3 |= width << IC_IDMAC_3_PP_WIDTH_OFFSET;
  353. break;
  354. case IPUV3_CHANNEL_MEM_IC_PP:
  355. if (burst_size == 16)
  356. ic_idmac_1 |= IC_IDMAC_1_CB5_BURST_16;
  357. else
  358. ic_idmac_1 &= ~IC_IDMAC_1_CB5_BURST_16;
  359. break;
  360. case IPUV3_CHANNEL_MEM_ROT_PP:
  361. ic_idmac_1 &= ~IC_IDMAC_1_PP_ROT_MASK;
  362. ic_idmac_1 |= temp_rot << IC_IDMAC_1_PP_ROT_OFFSET;
  363. break;
  364. case IPUV3_CHANNEL_MEM_IC_PRP_VF:
  365. if (burst_size == 16)
  366. ic_idmac_1 |= IC_IDMAC_1_CB6_BURST_16;
  367. else
  368. ic_idmac_1 &= ~IC_IDMAC_1_CB6_BURST_16;
  369. break;
  370. case IPUV3_CHANNEL_IC_PRP_ENC_MEM:
  371. if (burst_size == 16)
  372. ic_idmac_1 |= IC_IDMAC_1_CB0_BURST_16;
  373. else
  374. ic_idmac_1 &= ~IC_IDMAC_1_CB0_BURST_16;
  375. if (need_hor_flip)
  376. ic_idmac_1 |= IC_IDMAC_1_PRPENC_FLIP_RS;
  377. else
  378. ic_idmac_1 &= ~IC_IDMAC_1_PRPENC_FLIP_RS;
  379. ic_idmac_2 &= ~IC_IDMAC_2_PRPENC_HEIGHT_MASK;
  380. ic_idmac_2 |= height << IC_IDMAC_2_PRPENC_HEIGHT_OFFSET;
  381. ic_idmac_3 &= ~IC_IDMAC_3_PRPENC_WIDTH_MASK;
  382. ic_idmac_3 |= width << IC_IDMAC_3_PRPENC_WIDTH_OFFSET;
  383. break;
  384. case IPUV3_CHANNEL_MEM_ROT_ENC:
  385. ic_idmac_1 &= ~IC_IDMAC_1_PRPENC_ROT_MASK;
  386. ic_idmac_1 |= temp_rot << IC_IDMAC_1_PRPENC_ROT_OFFSET;
  387. break;
  388. case IPUV3_CHANNEL_IC_PRP_VF_MEM:
  389. if (burst_size == 16)
  390. ic_idmac_1 |= IC_IDMAC_1_CB1_BURST_16;
  391. else
  392. ic_idmac_1 &= ~IC_IDMAC_1_CB1_BURST_16;
  393. if (need_hor_flip)
  394. ic_idmac_1 |= IC_IDMAC_1_PRPVF_FLIP_RS;
  395. else
  396. ic_idmac_1 &= ~IC_IDMAC_1_PRPVF_FLIP_RS;
  397. ic_idmac_2 &= ~IC_IDMAC_2_PRPVF_HEIGHT_MASK;
  398. ic_idmac_2 |= height << IC_IDMAC_2_PRPVF_HEIGHT_OFFSET;
  399. ic_idmac_3 &= ~IC_IDMAC_3_PRPVF_WIDTH_MASK;
  400. ic_idmac_3 |= width << IC_IDMAC_3_PRPVF_WIDTH_OFFSET;
  401. break;
  402. case IPUV3_CHANNEL_MEM_ROT_VF:
  403. ic_idmac_1 &= ~IC_IDMAC_1_PRPVF_ROT_MASK;
  404. ic_idmac_1 |= temp_rot << IC_IDMAC_1_PRPVF_ROT_OFFSET;
  405. break;
  406. case IPUV3_CHANNEL_G_MEM_IC_PRP_VF:
  407. if (burst_size == 16)
  408. ic_idmac_1 |= IC_IDMAC_1_CB3_BURST_16;
  409. else
  410. ic_idmac_1 &= ~IC_IDMAC_1_CB3_BURST_16;
  411. break;
  412. case IPUV3_CHANNEL_G_MEM_IC_PP:
  413. if (burst_size == 16)
  414. ic_idmac_1 |= IC_IDMAC_1_CB4_BURST_16;
  415. else
  416. ic_idmac_1 &= ~IC_IDMAC_1_CB4_BURST_16;
  417. break;
  418. case IPUV3_CHANNEL_VDI_MEM_IC_VF:
  419. if (burst_size == 16)
  420. ic_idmac_1 |= IC_IDMAC_1_CB7_BURST_16;
  421. else
  422. ic_idmac_1 &= ~IC_IDMAC_1_CB7_BURST_16;
  423. break;
  424. default:
  425. goto unlock;
  426. }
  427. ipu_ic_write(ic, ic_idmac_1, IC_IDMAC_1);
  428. ipu_ic_write(ic, ic_idmac_2, IC_IDMAC_2);
  429. ipu_ic_write(ic, ic_idmac_3, IC_IDMAC_3);
  430. if (ipu_rot_mode_is_irt(rot))
  431. ic->rotation = true;
  432. unlock:
  433. spin_unlock_irqrestore(&priv->lock, flags);
  434. return ret;
  435. }
  436. EXPORT_SYMBOL_GPL(ipu_ic_task_idma_init);
  437. static void ipu_irt_enable(struct ipu_ic *ic)
  438. {
  439. struct ipu_ic_priv *priv = ic->priv;
  440. if (!priv->irt_use_count)
  441. ipu_module_enable(priv->ipu, IPU_CONF_ROT_EN);
  442. priv->irt_use_count++;
  443. }
  444. static void ipu_irt_disable(struct ipu_ic *ic)
  445. {
  446. struct ipu_ic_priv *priv = ic->priv;
  447. if (priv->irt_use_count) {
  448. if (!--priv->irt_use_count)
  449. ipu_module_disable(priv->ipu, IPU_CONF_ROT_EN);
  450. }
  451. }
  452. int ipu_ic_enable(struct ipu_ic *ic)
  453. {
  454. struct ipu_ic_priv *priv = ic->priv;
  455. unsigned long flags;
  456. spin_lock_irqsave(&priv->lock, flags);
  457. if (!priv->use_count)
  458. ipu_module_enable(priv->ipu, IPU_CONF_IC_EN);
  459. priv->use_count++;
  460. if (ic->rotation)
  461. ipu_irt_enable(ic);
  462. spin_unlock_irqrestore(&priv->lock, flags);
  463. return 0;
  464. }
  465. EXPORT_SYMBOL_GPL(ipu_ic_enable);
  466. int ipu_ic_disable(struct ipu_ic *ic)
  467. {
  468. struct ipu_ic_priv *priv = ic->priv;
  469. unsigned long flags;
  470. spin_lock_irqsave(&priv->lock, flags);
  471. priv->use_count--;
  472. if (!priv->use_count)
  473. ipu_module_disable(priv->ipu, IPU_CONF_IC_EN);
  474. if (priv->use_count < 0)
  475. priv->use_count = 0;
  476. if (ic->rotation)
  477. ipu_irt_disable(ic);
  478. ic->rotation = ic->graphics = false;
  479. spin_unlock_irqrestore(&priv->lock, flags);
  480. return 0;
  481. }
  482. EXPORT_SYMBOL_GPL(ipu_ic_disable);
  483. struct ipu_ic *ipu_ic_get(struct ipu_soc *ipu, enum ipu_ic_task task)
  484. {
  485. struct ipu_ic_priv *priv = ipu->ic_priv;
  486. unsigned long flags;
  487. struct ipu_ic *ic, *ret;
  488. if (task >= IC_NUM_TASKS)
  489. return ERR_PTR(-EINVAL);
  490. ic = &priv->task[task];
  491. spin_lock_irqsave(&priv->lock, flags);
  492. if (ic->in_use) {
  493. ret = ERR_PTR(-EBUSY);
  494. goto unlock;
  495. }
  496. ic->in_use = true;
  497. ret = ic;
  498. unlock:
  499. spin_unlock_irqrestore(&priv->lock, flags);
  500. return ret;
  501. }
  502. EXPORT_SYMBOL_GPL(ipu_ic_get);
  503. void ipu_ic_put(struct ipu_ic *ic)
  504. {
  505. struct ipu_ic_priv *priv = ic->priv;
  506. unsigned long flags;
  507. spin_lock_irqsave(&priv->lock, flags);
  508. ic->in_use = false;
  509. spin_unlock_irqrestore(&priv->lock, flags);
  510. }
  511. EXPORT_SYMBOL_GPL(ipu_ic_put);
  512. int ipu_ic_init(struct ipu_soc *ipu, struct device *dev,
  513. unsigned long base, unsigned long tpmem_base)
  514. {
  515. struct ipu_ic_priv *priv;
  516. int i;
  517. priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
  518. if (!priv)
  519. return -ENOMEM;
  520. ipu->ic_priv = priv;
  521. spin_lock_init(&priv->lock);
  522. priv->base = devm_ioremap(dev, base, PAGE_SIZE);
  523. if (!priv->base)
  524. return -ENOMEM;
  525. priv->tpmem_base = devm_ioremap(dev, tpmem_base, SZ_64K);
  526. if (!priv->tpmem_base)
  527. return -ENOMEM;
  528. dev_dbg(dev, "IC base: 0x%08lx remapped to %p\n", base, priv->base);
  529. priv->ipu = ipu;
  530. for (i = 0; i < IC_NUM_TASKS; i++) {
  531. priv->task[i].task = i;
  532. priv->task[i].priv = priv;
  533. priv->task[i].reg = &ic_task_reg[i];
  534. priv->task[i].bit = &ic_task_bit[i];
  535. }
  536. return 0;
  537. }
  538. void ipu_ic_exit(struct ipu_soc *ipu)
  539. {
  540. }
  541. void ipu_ic_dump(struct ipu_ic *ic)
  542. {
  543. struct ipu_ic_priv *priv = ic->priv;
  544. struct ipu_soc *ipu = priv->ipu;
  545. dev_dbg(ipu->dev, "IC_CONF = \t0x%08X\n",
  546. ipu_ic_read(ic, IC_CONF));
  547. dev_dbg(ipu->dev, "IC_PRP_ENC_RSC = \t0x%08X\n",
  548. ipu_ic_read(ic, IC_PRP_ENC_RSC));
  549. dev_dbg(ipu->dev, "IC_PRP_VF_RSC = \t0x%08X\n",
  550. ipu_ic_read(ic, IC_PRP_VF_RSC));
  551. dev_dbg(ipu->dev, "IC_PP_RSC = \t0x%08X\n",
  552. ipu_ic_read(ic, IC_PP_RSC));
  553. dev_dbg(ipu->dev, "IC_CMBP_1 = \t0x%08X\n",
  554. ipu_ic_read(ic, IC_CMBP_1));
  555. dev_dbg(ipu->dev, "IC_CMBP_2 = \t0x%08X\n",
  556. ipu_ic_read(ic, IC_CMBP_2));
  557. dev_dbg(ipu->dev, "IC_IDMAC_1 = \t0x%08X\n",
  558. ipu_ic_read(ic, IC_IDMAC_1));
  559. dev_dbg(ipu->dev, "IC_IDMAC_2 = \t0x%08X\n",
  560. ipu_ic_read(ic, IC_IDMAC_2));
  561. dev_dbg(ipu->dev, "IC_IDMAC_3 = \t0x%08X\n",
  562. ipu_ic_read(ic, IC_IDMAC_3));
  563. dev_dbg(ipu->dev, "IC_IDMAC_4 = \t0x%08X\n",
  564. ipu_ic_read(ic, IC_IDMAC_4));
  565. }
  566. EXPORT_SYMBOL_GPL(ipu_ic_dump);