ipu-common.c 34 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362
  1. /*
  2. * Copyright (c) 2010 Sascha Hauer <s.hauer@pengutronix.de>
  3. * Copyright (C) 2005-2009 Freescale Semiconductor, Inc.
  4. *
  5. * This program is free software; you can redistribute it and/or modify it
  6. * under the terms of the GNU General Public License as published by the
  7. * Free Software Foundation; either version 2 of the License, or (at your
  8. * option) any later version.
  9. *
  10. * This program is distributed in the hope that it will be useful, but
  11. * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
  12. * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
  13. * for more details.
  14. */
  15. #include <linux/module.h>
  16. #include <linux/export.h>
  17. #include <linux/types.h>
  18. #include <linux/reset.h>
  19. #include <linux/platform_device.h>
  20. #include <linux/err.h>
  21. #include <linux/spinlock.h>
  22. #include <linux/delay.h>
  23. #include <linux/interrupt.h>
  24. #include <linux/io.h>
  25. #include <linux/clk.h>
  26. #include <linux/list.h>
  27. #include <linux/irq.h>
  28. #include <linux/irqchip/chained_irq.h>
  29. #include <linux/irqdomain.h>
  30. #include <linux/of_device.h>
  31. #include <drm/drm_fourcc.h>
  32. #include <video/imx-ipu-v3.h>
  33. #include "ipu-prv.h"
  34. static inline u32 ipu_cm_read(struct ipu_soc *ipu, unsigned offset)
  35. {
  36. return readl(ipu->cm_reg + offset);
  37. }
  38. static inline void ipu_cm_write(struct ipu_soc *ipu, u32 value, unsigned offset)
  39. {
  40. writel(value, ipu->cm_reg + offset);
  41. }
  42. static inline u32 ipu_idmac_read(struct ipu_soc *ipu, unsigned offset)
  43. {
  44. return readl(ipu->idmac_reg + offset);
  45. }
  46. static inline void ipu_idmac_write(struct ipu_soc *ipu, u32 value,
  47. unsigned offset)
  48. {
  49. writel(value, ipu->idmac_reg + offset);
  50. }
  51. void ipu_srm_dp_sync_update(struct ipu_soc *ipu)
  52. {
  53. u32 val;
  54. val = ipu_cm_read(ipu, IPU_SRM_PRI2);
  55. val |= 0x8;
  56. ipu_cm_write(ipu, val, IPU_SRM_PRI2);
  57. }
  58. EXPORT_SYMBOL_GPL(ipu_srm_dp_sync_update);
  59. struct ipu_ch_param __iomem *ipu_get_cpmem(struct ipuv3_channel *channel)
  60. {
  61. struct ipu_soc *ipu = channel->ipu;
  62. return ipu->cpmem_base + channel->num;
  63. }
  64. EXPORT_SYMBOL_GPL(ipu_get_cpmem);
  65. void ipu_cpmem_set_high_priority(struct ipuv3_channel *channel)
  66. {
  67. struct ipu_soc *ipu = channel->ipu;
  68. struct ipu_ch_param __iomem *p = ipu_get_cpmem(channel);
  69. u32 val;
  70. if (ipu->ipu_type == IPUV3EX)
  71. ipu_ch_param_write_field(p, IPU_FIELD_ID, 1);
  72. val = ipu_idmac_read(ipu, IDMAC_CHA_PRI(channel->num));
  73. val |= 1 << (channel->num % 32);
  74. ipu_idmac_write(ipu, val, IDMAC_CHA_PRI(channel->num));
  75. };
  76. EXPORT_SYMBOL_GPL(ipu_cpmem_set_high_priority);
  77. void ipu_ch_param_write_field(struct ipu_ch_param __iomem *base, u32 wbs, u32 v)
  78. {
  79. u32 bit = (wbs >> 8) % 160;
  80. u32 size = wbs & 0xff;
  81. u32 word = (wbs >> 8) / 160;
  82. u32 i = bit / 32;
  83. u32 ofs = bit % 32;
  84. u32 mask = (1 << size) - 1;
  85. u32 val;
  86. pr_debug("%s %d %d %d\n", __func__, word, bit , size);
  87. val = readl(&base->word[word].data[i]);
  88. val &= ~(mask << ofs);
  89. val |= v << ofs;
  90. writel(val, &base->word[word].data[i]);
  91. if ((bit + size - 1) / 32 > i) {
  92. val = readl(&base->word[word].data[i + 1]);
  93. val &= ~(mask >> (ofs ? (32 - ofs) : 0));
  94. val |= v >> (ofs ? (32 - ofs) : 0);
  95. writel(val, &base->word[word].data[i + 1]);
  96. }
  97. }
  98. EXPORT_SYMBOL_GPL(ipu_ch_param_write_field);
  99. u32 ipu_ch_param_read_field(struct ipu_ch_param __iomem *base, u32 wbs)
  100. {
  101. u32 bit = (wbs >> 8) % 160;
  102. u32 size = wbs & 0xff;
  103. u32 word = (wbs >> 8) / 160;
  104. u32 i = bit / 32;
  105. u32 ofs = bit % 32;
  106. u32 mask = (1 << size) - 1;
  107. u32 val = 0;
  108. pr_debug("%s %d %d %d\n", __func__, word, bit , size);
  109. val = (readl(&base->word[word].data[i]) >> ofs) & mask;
  110. if ((bit + size - 1) / 32 > i) {
  111. u32 tmp;
  112. tmp = readl(&base->word[word].data[i + 1]);
  113. tmp &= mask >> (ofs ? (32 - ofs) : 0);
  114. val |= tmp << (ofs ? (32 - ofs) : 0);
  115. }
  116. return val;
  117. }
  118. EXPORT_SYMBOL_GPL(ipu_ch_param_read_field);
  119. int ipu_cpmem_set_format_rgb(struct ipu_ch_param __iomem *p,
  120. const struct ipu_rgb *rgb)
  121. {
  122. int bpp = 0, npb = 0, ro, go, bo, to;
  123. ro = rgb->bits_per_pixel - rgb->red.length - rgb->red.offset;
  124. go = rgb->bits_per_pixel - rgb->green.length - rgb->green.offset;
  125. bo = rgb->bits_per_pixel - rgb->blue.length - rgb->blue.offset;
  126. to = rgb->bits_per_pixel - rgb->transp.length - rgb->transp.offset;
  127. ipu_ch_param_write_field(p, IPU_FIELD_WID0, rgb->red.length - 1);
  128. ipu_ch_param_write_field(p, IPU_FIELD_OFS0, ro);
  129. ipu_ch_param_write_field(p, IPU_FIELD_WID1, rgb->green.length - 1);
  130. ipu_ch_param_write_field(p, IPU_FIELD_OFS1, go);
  131. ipu_ch_param_write_field(p, IPU_FIELD_WID2, rgb->blue.length - 1);
  132. ipu_ch_param_write_field(p, IPU_FIELD_OFS2, bo);
  133. if (rgb->transp.length) {
  134. ipu_ch_param_write_field(p, IPU_FIELD_WID3,
  135. rgb->transp.length - 1);
  136. ipu_ch_param_write_field(p, IPU_FIELD_OFS3, to);
  137. } else {
  138. ipu_ch_param_write_field(p, IPU_FIELD_WID3, 7);
  139. ipu_ch_param_write_field(p, IPU_FIELD_OFS3,
  140. rgb->bits_per_pixel);
  141. }
  142. switch (rgb->bits_per_pixel) {
  143. case 32:
  144. bpp = 0;
  145. npb = 15;
  146. break;
  147. case 24:
  148. bpp = 1;
  149. npb = 19;
  150. break;
  151. case 16:
  152. bpp = 3;
  153. npb = 31;
  154. break;
  155. case 8:
  156. bpp = 5;
  157. npb = 63;
  158. break;
  159. default:
  160. return -EINVAL;
  161. }
  162. ipu_ch_param_write_field(p, IPU_FIELD_BPP, bpp);
  163. ipu_ch_param_write_field(p, IPU_FIELD_NPB, npb);
  164. ipu_ch_param_write_field(p, IPU_FIELD_PFS, 7); /* rgb mode */
  165. return 0;
  166. }
  167. EXPORT_SYMBOL_GPL(ipu_cpmem_set_format_rgb);
  168. int ipu_cpmem_set_format_passthrough(struct ipu_ch_param __iomem *p,
  169. int width)
  170. {
  171. int bpp = 0, npb = 0;
  172. switch (width) {
  173. case 32:
  174. bpp = 0;
  175. npb = 15;
  176. break;
  177. case 24:
  178. bpp = 1;
  179. npb = 19;
  180. break;
  181. case 16:
  182. bpp = 3;
  183. npb = 31;
  184. break;
  185. case 8:
  186. bpp = 5;
  187. npb = 63;
  188. break;
  189. default:
  190. return -EINVAL;
  191. }
  192. ipu_ch_param_write_field(p, IPU_FIELD_BPP, bpp);
  193. ipu_ch_param_write_field(p, IPU_FIELD_NPB, npb);
  194. ipu_ch_param_write_field(p, IPU_FIELD_PFS, 6); /* raw mode */
  195. return 0;
  196. }
  197. EXPORT_SYMBOL_GPL(ipu_cpmem_set_format_passthrough);
  198. void ipu_cpmem_set_yuv_interleaved(struct ipu_ch_param __iomem *p,
  199. u32 pixel_format)
  200. {
  201. switch (pixel_format) {
  202. case V4L2_PIX_FMT_UYVY:
  203. ipu_ch_param_write_field(p, IPU_FIELD_BPP, 3); /* bits/pixel */
  204. ipu_ch_param_write_field(p, IPU_FIELD_PFS, 0xA); /* pix format */
  205. ipu_ch_param_write_field(p, IPU_FIELD_NPB, 31); /* burst size */
  206. break;
  207. case V4L2_PIX_FMT_YUYV:
  208. ipu_ch_param_write_field(p, IPU_FIELD_BPP, 3); /* bits/pixel */
  209. ipu_ch_param_write_field(p, IPU_FIELD_PFS, 0x8); /* pix format */
  210. ipu_ch_param_write_field(p, IPU_FIELD_NPB, 31); /* burst size */
  211. break;
  212. }
  213. }
  214. EXPORT_SYMBOL_GPL(ipu_cpmem_set_yuv_interleaved);
  215. void ipu_cpmem_set_yuv_planar_full(struct ipu_ch_param __iomem *p,
  216. u32 pixel_format, int stride, int u_offset, int v_offset)
  217. {
  218. switch (pixel_format) {
  219. case V4L2_PIX_FMT_YUV420:
  220. ipu_ch_param_write_field(p, IPU_FIELD_SLUV, (stride / 2) - 1);
  221. ipu_ch_param_write_field(p, IPU_FIELD_UBO, u_offset / 8);
  222. ipu_ch_param_write_field(p, IPU_FIELD_VBO, v_offset / 8);
  223. break;
  224. case V4L2_PIX_FMT_YVU420:
  225. ipu_ch_param_write_field(p, IPU_FIELD_SLUV, (stride / 2) - 1);
  226. ipu_ch_param_write_field(p, IPU_FIELD_UBO, v_offset / 8);
  227. ipu_ch_param_write_field(p, IPU_FIELD_VBO, u_offset / 8);
  228. break;
  229. }
  230. }
  231. EXPORT_SYMBOL_GPL(ipu_cpmem_set_yuv_planar_full);
  232. void ipu_cpmem_set_yuv_planar(struct ipu_ch_param __iomem *p, u32 pixel_format,
  233. int stride, int height)
  234. {
  235. int u_offset, v_offset;
  236. int uv_stride = 0;
  237. switch (pixel_format) {
  238. case V4L2_PIX_FMT_YUV420:
  239. case V4L2_PIX_FMT_YVU420:
  240. uv_stride = stride / 2;
  241. u_offset = stride * height;
  242. v_offset = u_offset + (uv_stride * height / 2);
  243. ipu_cpmem_set_yuv_planar_full(p, pixel_format, stride,
  244. u_offset, v_offset);
  245. break;
  246. }
  247. }
  248. EXPORT_SYMBOL_GPL(ipu_cpmem_set_yuv_planar);
  249. static const struct ipu_rgb def_rgb_32 = {
  250. .red = { .offset = 16, .length = 8, },
  251. .green = { .offset = 8, .length = 8, },
  252. .blue = { .offset = 0, .length = 8, },
  253. .transp = { .offset = 24, .length = 8, },
  254. .bits_per_pixel = 32,
  255. };
  256. static const struct ipu_rgb def_bgr_32 = {
  257. .red = { .offset = 0, .length = 8, },
  258. .green = { .offset = 8, .length = 8, },
  259. .blue = { .offset = 16, .length = 8, },
  260. .transp = { .offset = 24, .length = 8, },
  261. .bits_per_pixel = 32,
  262. };
  263. static const struct ipu_rgb def_rgb_24 = {
  264. .red = { .offset = 16, .length = 8, },
  265. .green = { .offset = 8, .length = 8, },
  266. .blue = { .offset = 0, .length = 8, },
  267. .transp = { .offset = 0, .length = 0, },
  268. .bits_per_pixel = 24,
  269. };
  270. static const struct ipu_rgb def_bgr_24 = {
  271. .red = { .offset = 0, .length = 8, },
  272. .green = { .offset = 8, .length = 8, },
  273. .blue = { .offset = 16, .length = 8, },
  274. .transp = { .offset = 0, .length = 0, },
  275. .bits_per_pixel = 24,
  276. };
  277. static const struct ipu_rgb def_rgb_16 = {
  278. .red = { .offset = 11, .length = 5, },
  279. .green = { .offset = 5, .length = 6, },
  280. .blue = { .offset = 0, .length = 5, },
  281. .transp = { .offset = 0, .length = 0, },
  282. .bits_per_pixel = 16,
  283. };
  284. static const struct ipu_rgb def_bgr_16 = {
  285. .red = { .offset = 0, .length = 5, },
  286. .green = { .offset = 5, .length = 6, },
  287. .blue = { .offset = 11, .length = 5, },
  288. .transp = { .offset = 0, .length = 0, },
  289. .bits_per_pixel = 16,
  290. };
  291. #define Y_OFFSET(pix, x, y) ((x) + pix->width * (y))
  292. #define U_OFFSET(pix, x, y) ((pix->width * pix->height) + \
  293. (pix->width * (y) / 4) + (x) / 2)
  294. #define V_OFFSET(pix, x, y) ((pix->width * pix->height) + \
  295. (pix->width * pix->height / 4) + \
  296. (pix->width * (y) / 4) + (x) / 2)
  297. int ipu_cpmem_set_fmt(struct ipu_ch_param __iomem *cpmem, u32 drm_fourcc)
  298. {
  299. switch (drm_fourcc) {
  300. case DRM_FORMAT_YUV420:
  301. case DRM_FORMAT_YVU420:
  302. /* pix format */
  303. ipu_ch_param_write_field(cpmem, IPU_FIELD_PFS, 2);
  304. /* burst size */
  305. ipu_ch_param_write_field(cpmem, IPU_FIELD_NPB, 63);
  306. break;
  307. case DRM_FORMAT_UYVY:
  308. /* bits/pixel */
  309. ipu_ch_param_write_field(cpmem, IPU_FIELD_BPP, 3);
  310. /* pix format */
  311. ipu_ch_param_write_field(cpmem, IPU_FIELD_PFS, 0xA);
  312. /* burst size */
  313. ipu_ch_param_write_field(cpmem, IPU_FIELD_NPB, 31);
  314. break;
  315. case DRM_FORMAT_YUYV:
  316. /* bits/pixel */
  317. ipu_ch_param_write_field(cpmem, IPU_FIELD_BPP, 3);
  318. /* pix format */
  319. ipu_ch_param_write_field(cpmem, IPU_FIELD_PFS, 0x8);
  320. /* burst size */
  321. ipu_ch_param_write_field(cpmem, IPU_FIELD_NPB, 31);
  322. break;
  323. case DRM_FORMAT_ABGR8888:
  324. case DRM_FORMAT_XBGR8888:
  325. ipu_cpmem_set_format_rgb(cpmem, &def_bgr_32);
  326. break;
  327. case DRM_FORMAT_ARGB8888:
  328. case DRM_FORMAT_XRGB8888:
  329. ipu_cpmem_set_format_rgb(cpmem, &def_rgb_32);
  330. break;
  331. case DRM_FORMAT_BGR888:
  332. ipu_cpmem_set_format_rgb(cpmem, &def_bgr_24);
  333. break;
  334. case DRM_FORMAT_RGB888:
  335. ipu_cpmem_set_format_rgb(cpmem, &def_rgb_24);
  336. break;
  337. case DRM_FORMAT_RGB565:
  338. ipu_cpmem_set_format_rgb(cpmem, &def_rgb_16);
  339. break;
  340. case DRM_FORMAT_BGR565:
  341. ipu_cpmem_set_format_rgb(cpmem, &def_bgr_16);
  342. break;
  343. default:
  344. return -EINVAL;
  345. }
  346. return 0;
  347. }
  348. EXPORT_SYMBOL_GPL(ipu_cpmem_set_fmt);
  349. /*
  350. * The V4L2 spec defines packed RGB formats in memory byte order, which from
  351. * point of view of the IPU corresponds to little-endian words with the first
  352. * component in the least significant bits.
  353. * The DRM pixel formats and IPU internal representation are ordered the other
  354. * way around, with the first named component ordered at the most significant
  355. * bits. Further, V4L2 formats are not well defined:
  356. * http://linuxtv.org/downloads/v4l-dvb-apis/packed-rgb.html
  357. * We choose the interpretation which matches GStreamer behavior.
  358. */
  359. static int v4l2_pix_fmt_to_drm_fourcc(u32 pixelformat)
  360. {
  361. switch (pixelformat) {
  362. case V4L2_PIX_FMT_RGB565:
  363. /*
  364. * Here we choose the 'corrected' interpretation of RGBP, a
  365. * little-endian 16-bit word with the red component at the most
  366. * significant bits:
  367. * g[2:0]b[4:0] r[4:0]g[5:3] <=> [16:0] R:G:B
  368. */
  369. return DRM_FORMAT_RGB565;
  370. case V4L2_PIX_FMT_BGR24:
  371. /* B G R <=> [24:0] R:G:B */
  372. return DRM_FORMAT_RGB888;
  373. case V4L2_PIX_FMT_RGB24:
  374. /* R G B <=> [24:0] B:G:R */
  375. return DRM_FORMAT_BGR888;
  376. case V4L2_PIX_FMT_BGR32:
  377. /* B G R A <=> [32:0] A:B:G:R */
  378. return DRM_FORMAT_XRGB8888;
  379. case V4L2_PIX_FMT_RGB32:
  380. /* R G B A <=> [32:0] A:B:G:R */
  381. return DRM_FORMAT_XBGR8888;
  382. case V4L2_PIX_FMT_UYVY:
  383. return DRM_FORMAT_UYVY;
  384. case V4L2_PIX_FMT_YUYV:
  385. return DRM_FORMAT_YUYV;
  386. case V4L2_PIX_FMT_YUV420:
  387. return DRM_FORMAT_YUV420;
  388. case V4L2_PIX_FMT_YVU420:
  389. return DRM_FORMAT_YVU420;
  390. }
  391. return -EINVAL;
  392. }
  393. enum ipu_color_space ipu_drm_fourcc_to_colorspace(u32 drm_fourcc)
  394. {
  395. switch (drm_fourcc) {
  396. case DRM_FORMAT_RGB565:
  397. case DRM_FORMAT_BGR565:
  398. case DRM_FORMAT_RGB888:
  399. case DRM_FORMAT_BGR888:
  400. case DRM_FORMAT_XRGB8888:
  401. case DRM_FORMAT_XBGR8888:
  402. case DRM_FORMAT_RGBX8888:
  403. case DRM_FORMAT_BGRX8888:
  404. case DRM_FORMAT_ARGB8888:
  405. case DRM_FORMAT_ABGR8888:
  406. case DRM_FORMAT_RGBA8888:
  407. case DRM_FORMAT_BGRA8888:
  408. return IPUV3_COLORSPACE_RGB;
  409. case DRM_FORMAT_YUYV:
  410. case DRM_FORMAT_UYVY:
  411. case DRM_FORMAT_YUV420:
  412. case DRM_FORMAT_YVU420:
  413. return IPUV3_COLORSPACE_YUV;
  414. default:
  415. return IPUV3_COLORSPACE_UNKNOWN;
  416. }
  417. }
  418. EXPORT_SYMBOL_GPL(ipu_drm_fourcc_to_colorspace);
  419. int ipu_cpmem_set_image(struct ipu_ch_param __iomem *cpmem,
  420. struct ipu_image *image)
  421. {
  422. struct v4l2_pix_format *pix = &image->pix;
  423. int y_offset, u_offset, v_offset;
  424. pr_debug("%s: resolution: %dx%d stride: %d\n",
  425. __func__, pix->width, pix->height,
  426. pix->bytesperline);
  427. ipu_cpmem_set_resolution(cpmem, image->rect.width,
  428. image->rect.height);
  429. ipu_cpmem_set_stride(cpmem, pix->bytesperline);
  430. ipu_cpmem_set_fmt(cpmem, v4l2_pix_fmt_to_drm_fourcc(pix->pixelformat));
  431. switch (pix->pixelformat) {
  432. case V4L2_PIX_FMT_YUV420:
  433. case V4L2_PIX_FMT_YVU420:
  434. y_offset = Y_OFFSET(pix, image->rect.left, image->rect.top);
  435. u_offset = U_OFFSET(pix, image->rect.left,
  436. image->rect.top) - y_offset;
  437. v_offset = V_OFFSET(pix, image->rect.left,
  438. image->rect.top) - y_offset;
  439. ipu_cpmem_set_yuv_planar_full(cpmem, pix->pixelformat,
  440. pix->bytesperline, u_offset, v_offset);
  441. ipu_cpmem_set_buffer(cpmem, 0, image->phys + y_offset);
  442. break;
  443. case V4L2_PIX_FMT_UYVY:
  444. case V4L2_PIX_FMT_YUYV:
  445. ipu_cpmem_set_buffer(cpmem, 0, image->phys +
  446. image->rect.left * 2 +
  447. image->rect.top * image->pix.bytesperline);
  448. break;
  449. case V4L2_PIX_FMT_RGB32:
  450. case V4L2_PIX_FMT_BGR32:
  451. ipu_cpmem_set_buffer(cpmem, 0, image->phys +
  452. image->rect.left * 4 +
  453. image->rect.top * image->pix.bytesperline);
  454. break;
  455. case V4L2_PIX_FMT_RGB565:
  456. ipu_cpmem_set_buffer(cpmem, 0, image->phys +
  457. image->rect.left * 2 +
  458. image->rect.top * image->pix.bytesperline);
  459. break;
  460. case V4L2_PIX_FMT_RGB24:
  461. case V4L2_PIX_FMT_BGR24:
  462. ipu_cpmem_set_buffer(cpmem, 0, image->phys +
  463. image->rect.left * 3 +
  464. image->rect.top * image->pix.bytesperline);
  465. break;
  466. default:
  467. return -EINVAL;
  468. }
  469. return 0;
  470. }
  471. EXPORT_SYMBOL_GPL(ipu_cpmem_set_image);
  472. enum ipu_color_space ipu_pixelformat_to_colorspace(u32 pixelformat)
  473. {
  474. switch (pixelformat) {
  475. case V4L2_PIX_FMT_YUV420:
  476. case V4L2_PIX_FMT_YVU420:
  477. case V4L2_PIX_FMT_UYVY:
  478. case V4L2_PIX_FMT_YUYV:
  479. return IPUV3_COLORSPACE_YUV;
  480. case V4L2_PIX_FMT_RGB32:
  481. case V4L2_PIX_FMT_BGR32:
  482. case V4L2_PIX_FMT_RGB24:
  483. case V4L2_PIX_FMT_BGR24:
  484. case V4L2_PIX_FMT_RGB565:
  485. return IPUV3_COLORSPACE_RGB;
  486. default:
  487. return IPUV3_COLORSPACE_UNKNOWN;
  488. }
  489. }
  490. EXPORT_SYMBOL_GPL(ipu_pixelformat_to_colorspace);
  491. struct ipuv3_channel *ipu_idmac_get(struct ipu_soc *ipu, unsigned num)
  492. {
  493. struct ipuv3_channel *channel;
  494. dev_dbg(ipu->dev, "%s %d\n", __func__, num);
  495. if (num > 63)
  496. return ERR_PTR(-ENODEV);
  497. mutex_lock(&ipu->channel_lock);
  498. channel = &ipu->channel[num];
  499. if (channel->busy) {
  500. channel = ERR_PTR(-EBUSY);
  501. goto out;
  502. }
  503. channel->busy = true;
  504. channel->num = num;
  505. out:
  506. mutex_unlock(&ipu->channel_lock);
  507. return channel;
  508. }
  509. EXPORT_SYMBOL_GPL(ipu_idmac_get);
  510. void ipu_idmac_put(struct ipuv3_channel *channel)
  511. {
  512. struct ipu_soc *ipu = channel->ipu;
  513. dev_dbg(ipu->dev, "%s %d\n", __func__, channel->num);
  514. mutex_lock(&ipu->channel_lock);
  515. channel->busy = false;
  516. mutex_unlock(&ipu->channel_lock);
  517. }
  518. EXPORT_SYMBOL_GPL(ipu_idmac_put);
  519. #define idma_mask(ch) (1 << (ch & 0x1f))
  520. void ipu_idmac_set_double_buffer(struct ipuv3_channel *channel,
  521. bool doublebuffer)
  522. {
  523. struct ipu_soc *ipu = channel->ipu;
  524. unsigned long flags;
  525. u32 reg;
  526. spin_lock_irqsave(&ipu->lock, flags);
  527. reg = ipu_cm_read(ipu, IPU_CHA_DB_MODE_SEL(channel->num));
  528. if (doublebuffer)
  529. reg |= idma_mask(channel->num);
  530. else
  531. reg &= ~idma_mask(channel->num);
  532. ipu_cm_write(ipu, reg, IPU_CHA_DB_MODE_SEL(channel->num));
  533. spin_unlock_irqrestore(&ipu->lock, flags);
  534. }
  535. EXPORT_SYMBOL_GPL(ipu_idmac_set_double_buffer);
  536. int ipu_module_enable(struct ipu_soc *ipu, u32 mask)
  537. {
  538. unsigned long lock_flags;
  539. u32 val;
  540. spin_lock_irqsave(&ipu->lock, lock_flags);
  541. val = ipu_cm_read(ipu, IPU_DISP_GEN);
  542. if (mask & IPU_CONF_DI0_EN)
  543. val |= IPU_DI0_COUNTER_RELEASE;
  544. if (mask & IPU_CONF_DI1_EN)
  545. val |= IPU_DI1_COUNTER_RELEASE;
  546. ipu_cm_write(ipu, val, IPU_DISP_GEN);
  547. val = ipu_cm_read(ipu, IPU_CONF);
  548. val |= mask;
  549. ipu_cm_write(ipu, val, IPU_CONF);
  550. spin_unlock_irqrestore(&ipu->lock, lock_flags);
  551. return 0;
  552. }
  553. EXPORT_SYMBOL_GPL(ipu_module_enable);
  554. int ipu_module_disable(struct ipu_soc *ipu, u32 mask)
  555. {
  556. unsigned long lock_flags;
  557. u32 val;
  558. spin_lock_irqsave(&ipu->lock, lock_flags);
  559. val = ipu_cm_read(ipu, IPU_CONF);
  560. val &= ~mask;
  561. ipu_cm_write(ipu, val, IPU_CONF);
  562. val = ipu_cm_read(ipu, IPU_DISP_GEN);
  563. if (mask & IPU_CONF_DI0_EN)
  564. val &= ~IPU_DI0_COUNTER_RELEASE;
  565. if (mask & IPU_CONF_DI1_EN)
  566. val &= ~IPU_DI1_COUNTER_RELEASE;
  567. ipu_cm_write(ipu, val, IPU_DISP_GEN);
  568. spin_unlock_irqrestore(&ipu->lock, lock_flags);
  569. return 0;
  570. }
  571. EXPORT_SYMBOL_GPL(ipu_module_disable);
  572. int ipu_csi_enable(struct ipu_soc *ipu, int csi)
  573. {
  574. return ipu_module_enable(ipu, csi ? IPU_CONF_CSI1_EN : IPU_CONF_CSI0_EN);
  575. }
  576. EXPORT_SYMBOL_GPL(ipu_csi_enable);
  577. int ipu_csi_disable(struct ipu_soc *ipu, int csi)
  578. {
  579. return ipu_module_disable(ipu, csi ? IPU_CONF_CSI1_EN : IPU_CONF_CSI0_EN);
  580. }
  581. EXPORT_SYMBOL_GPL(ipu_csi_disable);
  582. int ipu_smfc_enable(struct ipu_soc *ipu)
  583. {
  584. return ipu_module_enable(ipu, IPU_CONF_SMFC_EN);
  585. }
  586. EXPORT_SYMBOL_GPL(ipu_smfc_enable);
  587. int ipu_smfc_disable(struct ipu_soc *ipu)
  588. {
  589. return ipu_module_disable(ipu, IPU_CONF_SMFC_EN);
  590. }
  591. EXPORT_SYMBOL_GPL(ipu_smfc_disable);
  592. int ipu_idmac_get_current_buffer(struct ipuv3_channel *channel)
  593. {
  594. struct ipu_soc *ipu = channel->ipu;
  595. unsigned int chno = channel->num;
  596. return (ipu_cm_read(ipu, IPU_CHA_CUR_BUF(chno)) & idma_mask(chno)) ? 1 : 0;
  597. }
  598. EXPORT_SYMBOL_GPL(ipu_idmac_get_current_buffer);
  599. void ipu_idmac_select_buffer(struct ipuv3_channel *channel, u32 buf_num)
  600. {
  601. struct ipu_soc *ipu = channel->ipu;
  602. unsigned int chno = channel->num;
  603. unsigned long flags;
  604. spin_lock_irqsave(&ipu->lock, flags);
  605. /* Mark buffer as ready. */
  606. if (buf_num == 0)
  607. ipu_cm_write(ipu, idma_mask(chno), IPU_CHA_BUF0_RDY(chno));
  608. else
  609. ipu_cm_write(ipu, idma_mask(chno), IPU_CHA_BUF1_RDY(chno));
  610. spin_unlock_irqrestore(&ipu->lock, flags);
  611. }
  612. EXPORT_SYMBOL_GPL(ipu_idmac_select_buffer);
  613. int ipu_idmac_enable_channel(struct ipuv3_channel *channel)
  614. {
  615. struct ipu_soc *ipu = channel->ipu;
  616. u32 val;
  617. unsigned long flags;
  618. spin_lock_irqsave(&ipu->lock, flags);
  619. val = ipu_idmac_read(ipu, IDMAC_CHA_EN(channel->num));
  620. val |= idma_mask(channel->num);
  621. ipu_idmac_write(ipu, val, IDMAC_CHA_EN(channel->num));
  622. spin_unlock_irqrestore(&ipu->lock, flags);
  623. return 0;
  624. }
  625. EXPORT_SYMBOL_GPL(ipu_idmac_enable_channel);
  626. bool ipu_idmac_channel_busy(struct ipu_soc *ipu, unsigned int chno)
  627. {
  628. return (ipu_idmac_read(ipu, IDMAC_CHA_BUSY(chno)) & idma_mask(chno));
  629. }
  630. EXPORT_SYMBOL_GPL(ipu_idmac_channel_busy);
  631. int ipu_idmac_wait_busy(struct ipuv3_channel *channel, int ms)
  632. {
  633. struct ipu_soc *ipu = channel->ipu;
  634. unsigned long timeout;
  635. timeout = jiffies + msecs_to_jiffies(ms);
  636. while (ipu_idmac_read(ipu, IDMAC_CHA_BUSY(channel->num)) &
  637. idma_mask(channel->num)) {
  638. if (time_after(jiffies, timeout))
  639. return -ETIMEDOUT;
  640. cpu_relax();
  641. }
  642. return 0;
  643. }
  644. EXPORT_SYMBOL_GPL(ipu_idmac_wait_busy);
  645. int ipu_wait_interrupt(struct ipu_soc *ipu, int irq, int ms)
  646. {
  647. unsigned long timeout;
  648. timeout = jiffies + msecs_to_jiffies(ms);
  649. ipu_cm_write(ipu, BIT(irq % 32), IPU_INT_STAT(irq / 32));
  650. while (!(ipu_cm_read(ipu, IPU_INT_STAT(irq / 32) & BIT(irq % 32)))) {
  651. if (time_after(jiffies, timeout))
  652. return -ETIMEDOUT;
  653. cpu_relax();
  654. }
  655. return 0;
  656. }
  657. EXPORT_SYMBOL_GPL(ipu_wait_interrupt);
  658. int ipu_idmac_disable_channel(struct ipuv3_channel *channel)
  659. {
  660. struct ipu_soc *ipu = channel->ipu;
  661. u32 val;
  662. unsigned long flags;
  663. spin_lock_irqsave(&ipu->lock, flags);
  664. /* Disable DMA channel(s) */
  665. val = ipu_idmac_read(ipu, IDMAC_CHA_EN(channel->num));
  666. val &= ~idma_mask(channel->num);
  667. ipu_idmac_write(ipu, val, IDMAC_CHA_EN(channel->num));
  668. /* Set channel buffers NOT to be ready */
  669. ipu_cm_write(ipu, 0xf0000000, IPU_GPR); /* write one to clear */
  670. if (ipu_cm_read(ipu, IPU_CHA_BUF0_RDY(channel->num)) &
  671. idma_mask(channel->num)) {
  672. ipu_cm_write(ipu, idma_mask(channel->num),
  673. IPU_CHA_BUF0_RDY(channel->num));
  674. }
  675. if (ipu_cm_read(ipu, IPU_CHA_BUF1_RDY(channel->num)) &
  676. idma_mask(channel->num)) {
  677. ipu_cm_write(ipu, idma_mask(channel->num),
  678. IPU_CHA_BUF1_RDY(channel->num));
  679. }
  680. ipu_cm_write(ipu, 0x0, IPU_GPR); /* write one to set */
  681. /* Reset the double buffer */
  682. val = ipu_cm_read(ipu, IPU_CHA_DB_MODE_SEL(channel->num));
  683. val &= ~idma_mask(channel->num);
  684. ipu_cm_write(ipu, val, IPU_CHA_DB_MODE_SEL(channel->num));
  685. spin_unlock_irqrestore(&ipu->lock, flags);
  686. return 0;
  687. }
  688. EXPORT_SYMBOL_GPL(ipu_idmac_disable_channel);
  689. static int ipu_memory_reset(struct ipu_soc *ipu)
  690. {
  691. unsigned long timeout;
  692. ipu_cm_write(ipu, 0x807FFFFF, IPU_MEM_RST);
  693. timeout = jiffies + msecs_to_jiffies(1000);
  694. while (ipu_cm_read(ipu, IPU_MEM_RST) & 0x80000000) {
  695. if (time_after(jiffies, timeout))
  696. return -ETIME;
  697. cpu_relax();
  698. }
  699. return 0;
  700. }
  701. struct ipu_devtype {
  702. const char *name;
  703. unsigned long cm_ofs;
  704. unsigned long cpmem_ofs;
  705. unsigned long srm_ofs;
  706. unsigned long tpm_ofs;
  707. unsigned long disp0_ofs;
  708. unsigned long disp1_ofs;
  709. unsigned long dc_tmpl_ofs;
  710. unsigned long vdi_ofs;
  711. enum ipuv3_type type;
  712. };
  713. static struct ipu_devtype ipu_type_imx51 = {
  714. .name = "IPUv3EX",
  715. .cm_ofs = 0x1e000000,
  716. .cpmem_ofs = 0x1f000000,
  717. .srm_ofs = 0x1f040000,
  718. .tpm_ofs = 0x1f060000,
  719. .disp0_ofs = 0x1e040000,
  720. .disp1_ofs = 0x1e048000,
  721. .dc_tmpl_ofs = 0x1f080000,
  722. .vdi_ofs = 0x1e068000,
  723. .type = IPUV3EX,
  724. };
  725. static struct ipu_devtype ipu_type_imx53 = {
  726. .name = "IPUv3M",
  727. .cm_ofs = 0x06000000,
  728. .cpmem_ofs = 0x07000000,
  729. .srm_ofs = 0x07040000,
  730. .tpm_ofs = 0x07060000,
  731. .disp0_ofs = 0x06040000,
  732. .disp1_ofs = 0x06048000,
  733. .dc_tmpl_ofs = 0x07080000,
  734. .vdi_ofs = 0x06068000,
  735. .type = IPUV3M,
  736. };
  737. static struct ipu_devtype ipu_type_imx6q = {
  738. .name = "IPUv3H",
  739. .cm_ofs = 0x00200000,
  740. .cpmem_ofs = 0x00300000,
  741. .srm_ofs = 0x00340000,
  742. .tpm_ofs = 0x00360000,
  743. .disp0_ofs = 0x00240000,
  744. .disp1_ofs = 0x00248000,
  745. .dc_tmpl_ofs = 0x00380000,
  746. .vdi_ofs = 0x00268000,
  747. .type = IPUV3H,
  748. };
  749. static const struct of_device_id imx_ipu_dt_ids[] = {
  750. { .compatible = "fsl,imx51-ipu", .data = &ipu_type_imx51, },
  751. { .compatible = "fsl,imx53-ipu", .data = &ipu_type_imx53, },
  752. { .compatible = "fsl,imx6q-ipu", .data = &ipu_type_imx6q, },
  753. { /* sentinel */ }
  754. };
  755. MODULE_DEVICE_TABLE(of, imx_ipu_dt_ids);
  756. static int ipu_submodules_init(struct ipu_soc *ipu,
  757. struct platform_device *pdev, unsigned long ipu_base,
  758. struct clk *ipu_clk)
  759. {
  760. char *unit;
  761. int ret;
  762. struct device *dev = &pdev->dev;
  763. const struct ipu_devtype *devtype = ipu->devtype;
  764. ret = ipu_di_init(ipu, dev, 0, ipu_base + devtype->disp0_ofs,
  765. IPU_CONF_DI0_EN, ipu_clk);
  766. if (ret) {
  767. unit = "di0";
  768. goto err_di_0;
  769. }
  770. ret = ipu_di_init(ipu, dev, 1, ipu_base + devtype->disp1_ofs,
  771. IPU_CONF_DI1_EN, ipu_clk);
  772. if (ret) {
  773. unit = "di1";
  774. goto err_di_1;
  775. }
  776. ret = ipu_dc_init(ipu, dev, ipu_base + devtype->cm_ofs +
  777. IPU_CM_DC_REG_OFS, ipu_base + devtype->dc_tmpl_ofs);
  778. if (ret) {
  779. unit = "dc_template";
  780. goto err_dc;
  781. }
  782. ret = ipu_dmfc_init(ipu, dev, ipu_base +
  783. devtype->cm_ofs + IPU_CM_DMFC_REG_OFS, ipu_clk);
  784. if (ret) {
  785. unit = "dmfc";
  786. goto err_dmfc;
  787. }
  788. ret = ipu_dp_init(ipu, dev, ipu_base + devtype->srm_ofs);
  789. if (ret) {
  790. unit = "dp";
  791. goto err_dp;
  792. }
  793. ret = ipu_smfc_init(ipu, dev, ipu_base +
  794. devtype->cm_ofs + IPU_CM_SMFC_REG_OFS);
  795. if (ret) {
  796. unit = "smfc";
  797. goto err_smfc;
  798. }
  799. return 0;
  800. err_smfc:
  801. ipu_dp_exit(ipu);
  802. err_dp:
  803. ipu_dmfc_exit(ipu);
  804. err_dmfc:
  805. ipu_dc_exit(ipu);
  806. err_dc:
  807. ipu_di_exit(ipu, 1);
  808. err_di_1:
  809. ipu_di_exit(ipu, 0);
  810. err_di_0:
  811. dev_err(&pdev->dev, "init %s failed with %d\n", unit, ret);
  812. return ret;
  813. }
  814. static void ipu_irq_handle(struct ipu_soc *ipu, const int *regs, int num_regs)
  815. {
  816. unsigned long status;
  817. int i, bit, irq;
  818. for (i = 0; i < num_regs; i++) {
  819. status = ipu_cm_read(ipu, IPU_INT_STAT(regs[i]));
  820. status &= ipu_cm_read(ipu, IPU_INT_CTRL(regs[i]));
  821. for_each_set_bit(bit, &status, 32) {
  822. irq = irq_linear_revmap(ipu->domain,
  823. regs[i] * 32 + bit);
  824. if (irq)
  825. generic_handle_irq(irq);
  826. }
  827. }
  828. }
  829. static void ipu_irq_handler(unsigned int irq, struct irq_desc *desc)
  830. {
  831. struct ipu_soc *ipu = irq_desc_get_handler_data(desc);
  832. const int int_reg[] = { 0, 1, 2, 3, 10, 11, 12, 13, 14};
  833. struct irq_chip *chip = irq_get_chip(irq);
  834. chained_irq_enter(chip, desc);
  835. ipu_irq_handle(ipu, int_reg, ARRAY_SIZE(int_reg));
  836. chained_irq_exit(chip, desc);
  837. }
  838. static void ipu_err_irq_handler(unsigned int irq, struct irq_desc *desc)
  839. {
  840. struct ipu_soc *ipu = irq_desc_get_handler_data(desc);
  841. const int int_reg[] = { 4, 5, 8, 9};
  842. struct irq_chip *chip = irq_get_chip(irq);
  843. chained_irq_enter(chip, desc);
  844. ipu_irq_handle(ipu, int_reg, ARRAY_SIZE(int_reg));
  845. chained_irq_exit(chip, desc);
  846. }
  847. int ipu_map_irq(struct ipu_soc *ipu, int irq)
  848. {
  849. int virq;
  850. virq = irq_linear_revmap(ipu->domain, irq);
  851. if (!virq)
  852. virq = irq_create_mapping(ipu->domain, irq);
  853. return virq;
  854. }
  855. EXPORT_SYMBOL_GPL(ipu_map_irq);
  856. int ipu_idmac_channel_irq(struct ipu_soc *ipu, struct ipuv3_channel *channel,
  857. enum ipu_channel_irq irq_type)
  858. {
  859. return ipu_map_irq(ipu, irq_type + channel->num);
  860. }
  861. EXPORT_SYMBOL_GPL(ipu_idmac_channel_irq);
  862. static void ipu_submodules_exit(struct ipu_soc *ipu)
  863. {
  864. ipu_smfc_exit(ipu);
  865. ipu_dp_exit(ipu);
  866. ipu_dmfc_exit(ipu);
  867. ipu_dc_exit(ipu);
  868. ipu_di_exit(ipu, 1);
  869. ipu_di_exit(ipu, 0);
  870. }
  871. static int platform_remove_devices_fn(struct device *dev, void *unused)
  872. {
  873. struct platform_device *pdev = to_platform_device(dev);
  874. platform_device_unregister(pdev);
  875. return 0;
  876. }
  877. static void platform_device_unregister_children(struct platform_device *pdev)
  878. {
  879. device_for_each_child(&pdev->dev, NULL, platform_remove_devices_fn);
  880. }
  881. struct ipu_platform_reg {
  882. struct ipu_client_platformdata pdata;
  883. const char *name;
  884. int reg_offset;
  885. };
  886. static const struct ipu_platform_reg client_reg[] = {
  887. {
  888. .pdata = {
  889. .di = 0,
  890. .dc = 5,
  891. .dp = IPU_DP_FLOW_SYNC_BG,
  892. .dma[0] = IPUV3_CHANNEL_MEM_BG_SYNC,
  893. .dma[1] = IPUV3_CHANNEL_MEM_FG_SYNC,
  894. },
  895. .name = "imx-ipuv3-crtc",
  896. }, {
  897. .pdata = {
  898. .di = 1,
  899. .dc = 1,
  900. .dp = -EINVAL,
  901. .dma[0] = IPUV3_CHANNEL_MEM_DC_SYNC,
  902. .dma[1] = -EINVAL,
  903. },
  904. .name = "imx-ipuv3-crtc",
  905. }, {
  906. .pdata = {
  907. .csi = 0,
  908. .dma[0] = IPUV3_CHANNEL_CSI0,
  909. .dma[1] = -EINVAL,
  910. },
  911. .reg_offset = IPU_CM_CSI0_REG_OFS,
  912. .name = "imx-ipuv3-camera",
  913. }, {
  914. .pdata = {
  915. .csi = 1,
  916. .dma[0] = IPUV3_CHANNEL_CSI1,
  917. .dma[1] = -EINVAL,
  918. },
  919. .reg_offset = IPU_CM_CSI1_REG_OFS,
  920. .name = "imx-ipuv3-camera",
  921. },
  922. };
  923. static DEFINE_MUTEX(ipu_client_id_mutex);
  924. static int ipu_client_id;
  925. static int ipu_add_client_devices(struct ipu_soc *ipu, unsigned long ipu_base)
  926. {
  927. struct device *dev = ipu->dev;
  928. unsigned i;
  929. int id, ret;
  930. mutex_lock(&ipu_client_id_mutex);
  931. id = ipu_client_id;
  932. ipu_client_id += ARRAY_SIZE(client_reg);
  933. mutex_unlock(&ipu_client_id_mutex);
  934. for (i = 0; i < ARRAY_SIZE(client_reg); i++) {
  935. const struct ipu_platform_reg *reg = &client_reg[i];
  936. struct platform_device *pdev;
  937. struct resource res;
  938. if (reg->reg_offset) {
  939. memset(&res, 0, sizeof(res));
  940. res.flags = IORESOURCE_MEM;
  941. res.start = ipu_base + ipu->devtype->cm_ofs + reg->reg_offset;
  942. res.end = res.start + PAGE_SIZE - 1;
  943. pdev = platform_device_register_resndata(dev, reg->name,
  944. id++, &res, 1, &reg->pdata, sizeof(reg->pdata));
  945. } else {
  946. pdev = platform_device_register_data(dev, reg->name,
  947. id++, &reg->pdata, sizeof(reg->pdata));
  948. }
  949. if (IS_ERR(pdev))
  950. goto err_register;
  951. }
  952. return 0;
  953. err_register:
  954. platform_device_unregister_children(to_platform_device(dev));
  955. return ret;
  956. }
  957. static int ipu_irq_init(struct ipu_soc *ipu)
  958. {
  959. struct irq_chip_generic *gc;
  960. struct irq_chip_type *ct;
  961. unsigned long unused[IPU_NUM_IRQS / 32] = {
  962. 0x400100d0, 0xffe000fd,
  963. 0x400100d0, 0xffe000fd,
  964. 0x400100d0, 0xffe000fd,
  965. 0x4077ffff, 0xffe7e1fd,
  966. 0x23fffffe, 0x8880fff0,
  967. 0xf98fe7d0, 0xfff81fff,
  968. 0x400100d0, 0xffe000fd,
  969. 0x00000000,
  970. };
  971. int ret, i;
  972. ipu->domain = irq_domain_add_linear(ipu->dev->of_node, IPU_NUM_IRQS,
  973. &irq_generic_chip_ops, ipu);
  974. if (!ipu->domain) {
  975. dev_err(ipu->dev, "failed to add irq domain\n");
  976. return -ENODEV;
  977. }
  978. ret = irq_alloc_domain_generic_chips(ipu->domain, 32, 1, "IPU",
  979. handle_level_irq, 0,
  980. IRQF_VALID, 0);
  981. if (ret < 0) {
  982. dev_err(ipu->dev, "failed to alloc generic irq chips\n");
  983. irq_domain_remove(ipu->domain);
  984. return ret;
  985. }
  986. for (i = 0; i < IPU_NUM_IRQS; i += 32) {
  987. gc = irq_get_domain_generic_chip(ipu->domain, i);
  988. gc->reg_base = ipu->cm_reg;
  989. gc->unused = unused[i / 32];
  990. ct = gc->chip_types;
  991. ct->chip.irq_ack = irq_gc_ack_set_bit;
  992. ct->chip.irq_mask = irq_gc_mask_clr_bit;
  993. ct->chip.irq_unmask = irq_gc_mask_set_bit;
  994. ct->regs.ack = IPU_INT_STAT(i / 32);
  995. ct->regs.mask = IPU_INT_CTRL(i / 32);
  996. }
  997. irq_set_chained_handler(ipu->irq_sync, ipu_irq_handler);
  998. irq_set_handler_data(ipu->irq_sync, ipu);
  999. irq_set_chained_handler(ipu->irq_err, ipu_err_irq_handler);
  1000. irq_set_handler_data(ipu->irq_err, ipu);
  1001. return 0;
  1002. }
  1003. static void ipu_irq_exit(struct ipu_soc *ipu)
  1004. {
  1005. int i, irq;
  1006. irq_set_chained_handler(ipu->irq_err, NULL);
  1007. irq_set_handler_data(ipu->irq_err, NULL);
  1008. irq_set_chained_handler(ipu->irq_sync, NULL);
  1009. irq_set_handler_data(ipu->irq_sync, NULL);
  1010. /* TODO: remove irq_domain_generic_chips */
  1011. for (i = 0; i < IPU_NUM_IRQS; i++) {
  1012. irq = irq_linear_revmap(ipu->domain, i);
  1013. if (irq)
  1014. irq_dispose_mapping(irq);
  1015. }
  1016. irq_domain_remove(ipu->domain);
  1017. }
  1018. static int ipu_probe(struct platform_device *pdev)
  1019. {
  1020. const struct of_device_id *of_id =
  1021. of_match_device(imx_ipu_dt_ids, &pdev->dev);
  1022. struct ipu_soc *ipu;
  1023. struct resource *res;
  1024. unsigned long ipu_base;
  1025. int i, ret, irq_sync, irq_err;
  1026. const struct ipu_devtype *devtype;
  1027. devtype = of_id->data;
  1028. irq_sync = platform_get_irq(pdev, 0);
  1029. irq_err = platform_get_irq(pdev, 1);
  1030. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1031. dev_dbg(&pdev->dev, "irq_sync: %d irq_err: %d\n",
  1032. irq_sync, irq_err);
  1033. if (!res || irq_sync < 0 || irq_err < 0)
  1034. return -ENODEV;
  1035. ipu_base = res->start;
  1036. ipu = devm_kzalloc(&pdev->dev, sizeof(*ipu), GFP_KERNEL);
  1037. if (!ipu)
  1038. return -ENODEV;
  1039. for (i = 0; i < 64; i++)
  1040. ipu->channel[i].ipu = ipu;
  1041. ipu->devtype = devtype;
  1042. ipu->ipu_type = devtype->type;
  1043. spin_lock_init(&ipu->lock);
  1044. mutex_init(&ipu->channel_lock);
  1045. dev_dbg(&pdev->dev, "cm_reg: 0x%08lx\n",
  1046. ipu_base + devtype->cm_ofs);
  1047. dev_dbg(&pdev->dev, "idmac: 0x%08lx\n",
  1048. ipu_base + devtype->cm_ofs + IPU_CM_IDMAC_REG_OFS);
  1049. dev_dbg(&pdev->dev, "cpmem: 0x%08lx\n",
  1050. ipu_base + devtype->cpmem_ofs);
  1051. dev_dbg(&pdev->dev, "disp0: 0x%08lx\n",
  1052. ipu_base + devtype->disp0_ofs);
  1053. dev_dbg(&pdev->dev, "disp1: 0x%08lx\n",
  1054. ipu_base + devtype->disp1_ofs);
  1055. dev_dbg(&pdev->dev, "srm: 0x%08lx\n",
  1056. ipu_base + devtype->srm_ofs);
  1057. dev_dbg(&pdev->dev, "tpm: 0x%08lx\n",
  1058. ipu_base + devtype->tpm_ofs);
  1059. dev_dbg(&pdev->dev, "dc: 0x%08lx\n",
  1060. ipu_base + devtype->cm_ofs + IPU_CM_DC_REG_OFS);
  1061. dev_dbg(&pdev->dev, "ic: 0x%08lx\n",
  1062. ipu_base + devtype->cm_ofs + IPU_CM_IC_REG_OFS);
  1063. dev_dbg(&pdev->dev, "dmfc: 0x%08lx\n",
  1064. ipu_base + devtype->cm_ofs + IPU_CM_DMFC_REG_OFS);
  1065. dev_dbg(&pdev->dev, "vdi: 0x%08lx\n",
  1066. ipu_base + devtype->vdi_ofs);
  1067. ipu->cm_reg = devm_ioremap(&pdev->dev,
  1068. ipu_base + devtype->cm_ofs, PAGE_SIZE);
  1069. ipu->idmac_reg = devm_ioremap(&pdev->dev,
  1070. ipu_base + devtype->cm_ofs + IPU_CM_IDMAC_REG_OFS,
  1071. PAGE_SIZE);
  1072. ipu->cpmem_base = devm_ioremap(&pdev->dev,
  1073. ipu_base + devtype->cpmem_ofs, PAGE_SIZE);
  1074. if (!ipu->cm_reg || !ipu->idmac_reg || !ipu->cpmem_base)
  1075. return -ENOMEM;
  1076. ipu->clk = devm_clk_get(&pdev->dev, "bus");
  1077. if (IS_ERR(ipu->clk)) {
  1078. ret = PTR_ERR(ipu->clk);
  1079. dev_err(&pdev->dev, "clk_get failed with %d", ret);
  1080. return ret;
  1081. }
  1082. platform_set_drvdata(pdev, ipu);
  1083. ret = clk_prepare_enable(ipu->clk);
  1084. if (ret) {
  1085. dev_err(&pdev->dev, "clk_prepare_enable failed: %d\n", ret);
  1086. return ret;
  1087. }
  1088. ipu->dev = &pdev->dev;
  1089. ipu->irq_sync = irq_sync;
  1090. ipu->irq_err = irq_err;
  1091. ret = ipu_irq_init(ipu);
  1092. if (ret)
  1093. goto out_failed_irq;
  1094. ret = device_reset(&pdev->dev);
  1095. if (ret) {
  1096. dev_err(&pdev->dev, "failed to reset: %d\n", ret);
  1097. goto out_failed_reset;
  1098. }
  1099. ret = ipu_memory_reset(ipu);
  1100. if (ret)
  1101. goto out_failed_reset;
  1102. /* Set MCU_T to divide MCU access window into 2 */
  1103. ipu_cm_write(ipu, 0x00400000L | (IPU_MCU_T_DEFAULT << 18),
  1104. IPU_DISP_GEN);
  1105. ret = ipu_submodules_init(ipu, pdev, ipu_base, ipu->clk);
  1106. if (ret)
  1107. goto failed_submodules_init;
  1108. ret = ipu_add_client_devices(ipu, ipu_base);
  1109. if (ret) {
  1110. dev_err(&pdev->dev, "adding client devices failed with %d\n",
  1111. ret);
  1112. goto failed_add_clients;
  1113. }
  1114. dev_info(&pdev->dev, "%s probed\n", devtype->name);
  1115. return 0;
  1116. failed_add_clients:
  1117. ipu_submodules_exit(ipu);
  1118. failed_submodules_init:
  1119. out_failed_reset:
  1120. ipu_irq_exit(ipu);
  1121. out_failed_irq:
  1122. clk_disable_unprepare(ipu->clk);
  1123. return ret;
  1124. }
  1125. static int ipu_remove(struct platform_device *pdev)
  1126. {
  1127. struct ipu_soc *ipu = platform_get_drvdata(pdev);
  1128. platform_device_unregister_children(pdev);
  1129. ipu_submodules_exit(ipu);
  1130. ipu_irq_exit(ipu);
  1131. clk_disable_unprepare(ipu->clk);
  1132. return 0;
  1133. }
  1134. static struct platform_driver imx_ipu_driver = {
  1135. .driver = {
  1136. .name = "imx-ipuv3",
  1137. .of_match_table = imx_ipu_dt_ids,
  1138. },
  1139. .probe = ipu_probe,
  1140. .remove = ipu_remove,
  1141. };
  1142. module_platform_driver(imx_ipu_driver);
  1143. MODULE_ALIAS("platform:imx-ipuv3");
  1144. MODULE_DESCRIPTION("i.MX IPU v3 driver");
  1145. MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de>");
  1146. MODULE_LICENSE("GPL");