sh_mobile_meram.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715
  1. /*
  2. * SuperH Mobile MERAM Driver for SuperH Mobile LCDC Driver
  3. *
  4. * Copyright (c) 2011 Damian Hobson-Garcia <dhobsong@igel.co.jp>
  5. * Takanari Hayama <taki@igel.co.jp>
  6. *
  7. * This file is subject to the terms and conditions of the GNU General Public
  8. * License. See the file "COPYING" in the main directory of this archive
  9. * for more details.
  10. */
  11. #include <linux/kernel.h>
  12. #include <linux/module.h>
  13. #include <linux/device.h>
  14. #include <linux/pm_runtime.h>
  15. #include <linux/io.h>
  16. #include <linux/slab.h>
  17. #include <linux/platform_device.h>
  18. #include <video/sh_mobile_meram.h>
  19. /* meram registers */
  20. #define MEVCR1 0x4
  21. #define MEVCR1_RST (1 << 31)
  22. #define MEVCR1_WD (1 << 30)
  23. #define MEVCR1_AMD1 (1 << 29)
  24. #define MEVCR1_AMD0 (1 << 28)
  25. #define MEQSEL1 0x40
  26. #define MEQSEL2 0x44
  27. #define MExxCTL 0x400
  28. #define MExxCTL_BV (1 << 31)
  29. #define MExxCTL_BSZ_SHIFT 28
  30. #define MExxCTL_MSAR_MASK (0x7ff << MExxCTL_MSAR_SHIFT)
  31. #define MExxCTL_MSAR_SHIFT 16
  32. #define MExxCTL_NXT_MASK (0x1f << MExxCTL_NXT_SHIFT)
  33. #define MExxCTL_NXT_SHIFT 11
  34. #define MExxCTL_WD1 (1 << 10)
  35. #define MExxCTL_WD0 (1 << 9)
  36. #define MExxCTL_WS (1 << 8)
  37. #define MExxCTL_CB (1 << 7)
  38. #define MExxCTL_WBF (1 << 6)
  39. #define MExxCTL_WF (1 << 5)
  40. #define MExxCTL_RF (1 << 4)
  41. #define MExxCTL_CM (1 << 3)
  42. #define MExxCTL_MD_READ (1 << 0)
  43. #define MExxCTL_MD_WRITE (2 << 0)
  44. #define MExxCTL_MD_ICB_WB (3 << 0)
  45. #define MExxCTL_MD_ICB (4 << 0)
  46. #define MExxCTL_MD_FB (7 << 0)
  47. #define MExxCTL_MD_MASK (7 << 0)
  48. #define MExxBSIZE 0x404
  49. #define MExxBSIZE_RCNT_SHIFT 28
  50. #define MExxBSIZE_YSZM1_SHIFT 16
  51. #define MExxBSIZE_XSZM1_SHIFT 0
  52. #define MExxMNCF 0x408
  53. #define MExxMNCF_KWBNM_SHIFT 28
  54. #define MExxMNCF_KRBNM_SHIFT 24
  55. #define MExxMNCF_BNM_SHIFT 16
  56. #define MExxMNCF_XBV (1 << 15)
  57. #define MExxMNCF_CPL_YCBCR444 (1 << 12)
  58. #define MExxMNCF_CPL_YCBCR420 (2 << 12)
  59. #define MExxMNCF_CPL_YCBCR422 (3 << 12)
  60. #define MExxMNCF_CPL_MSK (3 << 12)
  61. #define MExxMNCF_BL (1 << 2)
  62. #define MExxMNCF_LNM_SHIFT 0
  63. #define MExxSARA 0x410
  64. #define MExxSARB 0x414
  65. #define MExxSBSIZE 0x418
  66. #define MExxSBSIZE_HDV (1 << 31)
  67. #define MExxSBSIZE_HSZ16 (0 << 28)
  68. #define MExxSBSIZE_HSZ32 (1 << 28)
  69. #define MExxSBSIZE_HSZ64 (2 << 28)
  70. #define MExxSBSIZE_HSZ128 (3 << 28)
  71. #define MExxSBSIZE_SBSIZZ_SHIFT 0
  72. #define MERAM_MExxCTL_VAL(next, addr) \
  73. ((((next) << MExxCTL_NXT_SHIFT) & MExxCTL_NXT_MASK) | \
  74. (((addr) << MExxCTL_MSAR_SHIFT) & MExxCTL_MSAR_MASK))
  75. #define MERAM_MExxBSIZE_VAL(rcnt, yszm1, xszm1) \
  76. (((rcnt) << MExxBSIZE_RCNT_SHIFT) | \
  77. ((yszm1) << MExxBSIZE_YSZM1_SHIFT) | \
  78. ((xszm1) << MExxBSIZE_XSZM1_SHIFT))
  79. #define SH_MOBILE_MERAM_ICB_NUM 32
  80. static unsigned long common_regs[] = {
  81. MEVCR1,
  82. MEQSEL1,
  83. MEQSEL2,
  84. };
  85. #define CMN_REGS_SIZE ARRAY_SIZE(common_regs)
  86. static unsigned long icb_regs[] = {
  87. MExxCTL,
  88. MExxBSIZE,
  89. MExxMNCF,
  90. MExxSARA,
  91. MExxSARB,
  92. MExxSBSIZE,
  93. };
  94. #define ICB_REGS_SIZE ARRAY_SIZE(icb_regs)
  95. /*
  96. * sh_mobile_meram_icb - MERAM ICB information
  97. * @regs: Registers cache
  98. * @region: Start and end addresses of the MERAM region
  99. * @cache_unit: Bytes to cache per ICB
  100. * @pixelformat: Video pixel format of the data stored in the ICB
  101. * @current_reg: Which of Start Address Register A (0) or B (1) is in use
  102. */
  103. struct sh_mobile_meram_icb {
  104. unsigned long regs[ICB_REGS_SIZE];
  105. unsigned long region;
  106. unsigned int cache_unit;
  107. unsigned int pixelformat;
  108. unsigned int current_reg;
  109. };
  110. /*
  111. * sh_mobile_meram_priv - MERAM device
  112. * @base: Registers base address
  113. * @regs: Registers cache
  114. * @lock: Protects used_icb and icbs
  115. * @used_icb: Bitmask of used ICBs
  116. * @icbs: ICBs
  117. */
  118. struct sh_mobile_meram_priv {
  119. void __iomem *base;
  120. unsigned long regs[CMN_REGS_SIZE];
  121. struct mutex lock;
  122. unsigned long used_icb;
  123. struct sh_mobile_meram_icb icbs[SH_MOBILE_MERAM_ICB_NUM];
  124. };
  125. /* settings */
  126. #define MERAM_SEC_LINE 15
  127. #define MERAM_LINE_WIDTH 2048
  128. /*
  129. * MERAM/ICB access functions
  130. */
  131. #define MERAM_ICB_OFFSET(base, idx, off) ((base) + (off) + (idx) * 0x20)
  132. static inline void meram_write_icb(void __iomem *base, unsigned int idx,
  133. unsigned int off, unsigned long val)
  134. {
  135. iowrite32(val, MERAM_ICB_OFFSET(base, idx, off));
  136. }
  137. static inline unsigned long meram_read_icb(void __iomem *base, unsigned int idx,
  138. unsigned int off)
  139. {
  140. return ioread32(MERAM_ICB_OFFSET(base, idx, off));
  141. }
  142. static inline void meram_write_reg(void __iomem *base, unsigned int off,
  143. unsigned long val)
  144. {
  145. iowrite32(val, base + off);
  146. }
  147. static inline unsigned long meram_read_reg(void __iomem *base, unsigned int off)
  148. {
  149. return ioread32(base + off);
  150. }
  151. /*
  152. * register ICB
  153. */
  154. #define MERAM_CACHE_START(p) ((p) >> 16)
  155. #define MERAM_CACHE_END(p) ((p) & 0xffff)
  156. #define MERAM_CACHE_SET(o, s) ((((o) & 0xffff) << 16) | \
  157. (((o) + (s) - 1) & 0xffff))
  158. /*
  159. * check if there's no overlaps in MERAM allocation.
  160. */
  161. static inline int meram_check_overlap(struct sh_mobile_meram_priv *priv,
  162. const struct sh_mobile_meram_icb_cfg *new)
  163. {
  164. unsigned int used_start, used_end, meram_start, meram_end;
  165. unsigned int i;
  166. /* valid ICB? */
  167. if (new->marker_icb & ~0x1f || new->cache_icb & ~0x1f)
  168. return 1;
  169. if (test_bit(new->marker_icb, &priv->used_icb) ||
  170. test_bit(new->cache_icb, &priv->used_icb))
  171. return 1;
  172. for (i = 0; i < SH_MOBILE_MERAM_ICB_NUM; i++) {
  173. if (!test_bit(i, &priv->used_icb))
  174. continue;
  175. used_start = MERAM_CACHE_START(priv->icbs[i].region);
  176. used_end = MERAM_CACHE_END(priv->icbs[i].region);
  177. meram_start = new->meram_offset;
  178. meram_end = new->meram_offset + new->meram_size;
  179. if ((meram_start >= used_start && meram_start < used_end) ||
  180. (meram_end > used_start && meram_end < used_end))
  181. return 1;
  182. }
  183. return 0;
  184. }
  185. /*
  186. * mark the specified ICB as used
  187. */
  188. static inline void meram_mark(struct sh_mobile_meram_priv *priv,
  189. const struct sh_mobile_meram_icb_cfg *new,
  190. int pixelformat)
  191. {
  192. __set_bit(new->marker_icb, &priv->used_icb);
  193. __set_bit(new->cache_icb, &priv->used_icb);
  194. priv->icbs[new->marker_icb].region = MERAM_CACHE_SET(new->meram_offset,
  195. new->meram_size);
  196. priv->icbs[new->cache_icb].region = MERAM_CACHE_SET(new->meram_offset,
  197. new->meram_size);
  198. priv->icbs[new->marker_icb].current_reg = 1;
  199. priv->icbs[new->marker_icb].pixelformat = pixelformat;
  200. }
  201. /*
  202. * unmark the specified ICB as used
  203. */
  204. static inline void meram_unmark(struct sh_mobile_meram_priv *priv,
  205. const struct sh_mobile_meram_icb_cfg *icb)
  206. {
  207. __clear_bit(icb->marker_icb, &priv->used_icb);
  208. __clear_bit(icb->cache_icb, &priv->used_icb);
  209. }
  210. /*
  211. * is this a YCbCr(NV12, NV16 or NV24) colorspace
  212. */
  213. static inline int is_nvcolor(int cspace)
  214. {
  215. if (cspace == SH_MOBILE_MERAM_PF_NV ||
  216. cspace == SH_MOBILE_MERAM_PF_NV24)
  217. return 1;
  218. return 0;
  219. }
  220. /*
  221. * set the next address to fetch
  222. */
  223. static inline void meram_set_next_addr(struct sh_mobile_meram_priv *priv,
  224. const struct sh_mobile_meram_cfg *cfg,
  225. unsigned long base_addr_y,
  226. unsigned long base_addr_c)
  227. {
  228. struct sh_mobile_meram_icb *icb = &priv->icbs[cfg->icb[0].marker_icb];
  229. unsigned long target;
  230. icb->current_reg ^= 1;
  231. target = icb->current_reg ? MExxSARB : MExxSARA;
  232. /* set the next address to fetch */
  233. meram_write_icb(priv->base, cfg->icb[0].cache_icb, target,
  234. base_addr_y);
  235. meram_write_icb(priv->base, cfg->icb[0].marker_icb, target,
  236. base_addr_y +
  237. priv->icbs[cfg->icb[0].marker_icb].cache_unit);
  238. if (is_nvcolor(icb->pixelformat)) {
  239. meram_write_icb(priv->base, cfg->icb[1].cache_icb, target,
  240. base_addr_c);
  241. meram_write_icb(priv->base, cfg->icb[1].marker_icb, target,
  242. base_addr_c +
  243. priv->icbs[cfg->icb[1].marker_icb].cache_unit);
  244. }
  245. }
  246. /*
  247. * get the next ICB address
  248. */
  249. static inline void
  250. meram_get_next_icb_addr(struct sh_mobile_meram_info *pdata,
  251. const struct sh_mobile_meram_cfg *cfg,
  252. unsigned long *icb_addr_y, unsigned long *icb_addr_c)
  253. {
  254. struct sh_mobile_meram_priv *priv = pdata->priv;
  255. struct sh_mobile_meram_icb *icb = &priv->icbs[cfg->icb[0].marker_icb];
  256. unsigned long icb_offset;
  257. if (pdata->addr_mode == SH_MOBILE_MERAM_MODE0)
  258. icb_offset = 0x80000000 | (icb->current_reg << 29);
  259. else
  260. icb_offset = 0xc0000000 | (icb->current_reg << 23);
  261. *icb_addr_y = icb_offset | (cfg->icb[0].marker_icb << 24);
  262. if (is_nvcolor(icb->pixelformat))
  263. *icb_addr_c = icb_offset | (cfg->icb[1].marker_icb << 24);
  264. }
  265. #define MERAM_CALC_BYTECOUNT(x, y) \
  266. (((x) * (y) + (MERAM_LINE_WIDTH - 1)) & ~(MERAM_LINE_WIDTH - 1))
  267. /*
  268. * initialize MERAM
  269. */
  270. static int meram_init(struct sh_mobile_meram_priv *priv,
  271. const struct sh_mobile_meram_icb_cfg *icb,
  272. unsigned int xres, unsigned int yres,
  273. unsigned int *out_pitch)
  274. {
  275. unsigned long total_byte_count = MERAM_CALC_BYTECOUNT(xres, yres);
  276. unsigned long bnm;
  277. unsigned int lcdc_pitch;
  278. unsigned int xpitch;
  279. unsigned int line_cnt;
  280. unsigned int save_lines;
  281. /* adjust pitch to 1024, 2048, 4096 or 8192 */
  282. lcdc_pitch = (xres - 1) | 1023;
  283. lcdc_pitch = lcdc_pitch | (lcdc_pitch >> 1);
  284. lcdc_pitch = lcdc_pitch | (lcdc_pitch >> 2);
  285. lcdc_pitch += 1;
  286. /* derive settings */
  287. if (lcdc_pitch == 8192 && yres >= 1024) {
  288. lcdc_pitch = xpitch = MERAM_LINE_WIDTH;
  289. line_cnt = total_byte_count >> 11;
  290. *out_pitch = xres;
  291. save_lines = (icb->meram_size / 16 / MERAM_SEC_LINE);
  292. save_lines *= MERAM_SEC_LINE;
  293. } else {
  294. xpitch = xres;
  295. line_cnt = yres;
  296. *out_pitch = lcdc_pitch;
  297. save_lines = icb->meram_size / (lcdc_pitch >> 10) / 2;
  298. save_lines &= 0xff;
  299. }
  300. bnm = (save_lines - 1) << 16;
  301. /* TODO: we better to check if we have enough MERAM buffer size */
  302. /* set up ICB */
  303. meram_write_icb(priv->base, icb->cache_icb, MExxBSIZE,
  304. MERAM_MExxBSIZE_VAL(0x0, line_cnt - 1, xpitch - 1));
  305. meram_write_icb(priv->base, icb->marker_icb, MExxBSIZE,
  306. MERAM_MExxBSIZE_VAL(0xf, line_cnt - 1, xpitch - 1));
  307. meram_write_icb(priv->base, icb->cache_icb, MExxMNCF, bnm);
  308. meram_write_icb(priv->base, icb->marker_icb, MExxMNCF, bnm);
  309. meram_write_icb(priv->base, icb->cache_icb, MExxSBSIZE, xpitch);
  310. meram_write_icb(priv->base, icb->marker_icb, MExxSBSIZE, xpitch);
  311. /* save a cache unit size */
  312. priv->icbs[icb->cache_icb].cache_unit = xres * save_lines;
  313. priv->icbs[icb->marker_icb].cache_unit = xres * save_lines;
  314. /*
  315. * Set MERAM for framebuffer
  316. *
  317. * we also chain the cache_icb and the marker_icb.
  318. * we also split the allocated MERAM buffer between two ICBs.
  319. */
  320. meram_write_icb(priv->base, icb->cache_icb, MExxCTL,
  321. MERAM_MExxCTL_VAL(icb->marker_icb, icb->meram_offset) |
  322. MExxCTL_WD1 | MExxCTL_WD0 | MExxCTL_WS | MExxCTL_CM |
  323. MExxCTL_MD_FB);
  324. meram_write_icb(priv->base, icb->marker_icb, MExxCTL,
  325. MERAM_MExxCTL_VAL(icb->cache_icb, icb->meram_offset +
  326. icb->meram_size / 2) |
  327. MExxCTL_WD1 | MExxCTL_WD0 | MExxCTL_WS | MExxCTL_CM |
  328. MExxCTL_MD_FB);
  329. return 0;
  330. }
  331. static void meram_deinit(struct sh_mobile_meram_priv *priv,
  332. const struct sh_mobile_meram_icb_cfg *icb)
  333. {
  334. /* disable ICB */
  335. meram_write_icb(priv->base, icb->cache_icb, MExxCTL,
  336. MExxCTL_WBF | MExxCTL_WF | MExxCTL_RF);
  337. meram_write_icb(priv->base, icb->marker_icb, MExxCTL,
  338. MExxCTL_WBF | MExxCTL_WF | MExxCTL_RF);
  339. priv->icbs[icb->cache_icb].cache_unit = 0;
  340. priv->icbs[icb->marker_icb].cache_unit = 0;
  341. }
  342. /*
  343. * register the ICB
  344. */
  345. static int sh_mobile_meram_register(struct sh_mobile_meram_info *pdata,
  346. const struct sh_mobile_meram_cfg *cfg,
  347. unsigned int xres, unsigned int yres,
  348. unsigned int pixelformat,
  349. unsigned long base_addr_y,
  350. unsigned long base_addr_c,
  351. unsigned long *icb_addr_y,
  352. unsigned long *icb_addr_c,
  353. unsigned int *pitch)
  354. {
  355. struct platform_device *pdev;
  356. struct sh_mobile_meram_priv *priv;
  357. unsigned int out_pitch;
  358. unsigned int n;
  359. int error = 0;
  360. if (!pdata || !pdata->priv || !pdata->pdev || !cfg)
  361. return -EINVAL;
  362. if (pixelformat != SH_MOBILE_MERAM_PF_NV &&
  363. pixelformat != SH_MOBILE_MERAM_PF_NV24 &&
  364. pixelformat != SH_MOBILE_MERAM_PF_RGB)
  365. return -EINVAL;
  366. priv = pdata->priv;
  367. pdev = pdata->pdev;
  368. dev_dbg(&pdev->dev, "registering %dx%d (%s) (y=%08lx, c=%08lx)",
  369. xres, yres, (!pixelformat) ? "yuv" : "rgb",
  370. base_addr_y, base_addr_c);
  371. /* we can't handle wider than 8192px */
  372. if (xres > 8192) {
  373. dev_err(&pdev->dev, "width exceeding the limit (> 8192).");
  374. return -EINVAL;
  375. }
  376. /* do we have at least one ICB config? */
  377. if (cfg->icb[0].marker_icb < 0 || cfg->icb[0].cache_icb < 0) {
  378. dev_err(&pdev->dev, "at least one ICB is required.");
  379. return -EINVAL;
  380. }
  381. mutex_lock(&priv->lock);
  382. /* make sure that there's no overlaps */
  383. if (meram_check_overlap(priv, &cfg->icb[0])) {
  384. dev_err(&pdev->dev, "conflicting config detected.");
  385. error = -EINVAL;
  386. goto err;
  387. }
  388. n = 1;
  389. /* do the same if we have the second ICB set */
  390. if (cfg->icb[1].marker_icb >= 0 && cfg->icb[1].cache_icb >= 0) {
  391. if (meram_check_overlap(priv, &cfg->icb[1])) {
  392. dev_err(&pdev->dev, "conflicting config detected.");
  393. error = -EINVAL;
  394. goto err;
  395. }
  396. n = 2;
  397. }
  398. if (is_nvcolor(pixelformat) && n != 2) {
  399. dev_err(&pdev->dev, "requires two ICB sets for planar Y/C.");
  400. error = -EINVAL;
  401. goto err;
  402. }
  403. /* we now register the ICB */
  404. meram_mark(priv, &cfg->icb[0], pixelformat);
  405. if (is_nvcolor(pixelformat))
  406. meram_mark(priv, &cfg->icb[1], pixelformat);
  407. /* initialize MERAM */
  408. meram_init(priv, &cfg->icb[0], xres, yres, &out_pitch);
  409. *pitch = out_pitch;
  410. if (pixelformat == SH_MOBILE_MERAM_PF_NV)
  411. meram_init(priv, &cfg->icb[1], xres, (yres + 1) / 2,
  412. &out_pitch);
  413. else if (pixelformat == SH_MOBILE_MERAM_PF_NV24)
  414. meram_init(priv, &cfg->icb[1], 2 * xres, (yres + 1) / 2,
  415. &out_pitch);
  416. meram_set_next_addr(priv, cfg, base_addr_y, base_addr_c);
  417. meram_get_next_icb_addr(pdata, cfg, icb_addr_y, icb_addr_c);
  418. dev_dbg(&pdev->dev, "registered - can access via y=%08lx, c=%08lx",
  419. *icb_addr_y, *icb_addr_c);
  420. err:
  421. mutex_unlock(&priv->lock);
  422. return error;
  423. }
  424. static int sh_mobile_meram_unregister(struct sh_mobile_meram_info *pdata,
  425. const struct sh_mobile_meram_cfg *cfg)
  426. {
  427. struct sh_mobile_meram_priv *priv;
  428. struct sh_mobile_meram_icb *icb;
  429. if (!pdata || !pdata->priv || !cfg)
  430. return -EINVAL;
  431. priv = pdata->priv;
  432. icb = &priv->icbs[cfg->icb[0].marker_icb];
  433. mutex_lock(&priv->lock);
  434. /* deinit & unmark */
  435. if (is_nvcolor(icb->pixelformat)) {
  436. meram_deinit(priv, &cfg->icb[1]);
  437. meram_unmark(priv, &cfg->icb[1]);
  438. }
  439. meram_deinit(priv, &cfg->icb[0]);
  440. meram_unmark(priv, &cfg->icb[0]);
  441. mutex_unlock(&priv->lock);
  442. return 0;
  443. }
  444. static int sh_mobile_meram_update(struct sh_mobile_meram_info *pdata,
  445. const struct sh_mobile_meram_cfg *cfg,
  446. unsigned long base_addr_y,
  447. unsigned long base_addr_c,
  448. unsigned long *icb_addr_y,
  449. unsigned long *icb_addr_c)
  450. {
  451. struct sh_mobile_meram_priv *priv;
  452. if (!pdata || !pdata->priv || !cfg)
  453. return -EINVAL;
  454. priv = pdata->priv;
  455. mutex_lock(&priv->lock);
  456. meram_set_next_addr(priv, cfg, base_addr_y, base_addr_c);
  457. meram_get_next_icb_addr(pdata, cfg, icb_addr_y, icb_addr_c);
  458. mutex_unlock(&priv->lock);
  459. return 0;
  460. }
  461. static int sh_mobile_meram_runtime_suspend(struct device *dev)
  462. {
  463. struct platform_device *pdev = to_platform_device(dev);
  464. struct sh_mobile_meram_priv *priv = platform_get_drvdata(pdev);
  465. unsigned int i, j;
  466. for (i = 0; i < CMN_REGS_SIZE; i++)
  467. priv->regs[i] = meram_read_reg(priv->base, common_regs[i]);
  468. for (i = 0; i < 32; i++) {
  469. if (!test_bit(i, &priv->used_icb))
  470. continue;
  471. for (j = 0; j < ICB_REGS_SIZE; j++) {
  472. priv->icbs[i].regs[j] =
  473. meram_read_icb(priv->base, i, icb_regs[j]);
  474. /* Reset ICB on resume */
  475. if (icb_regs[j] == MExxCTL)
  476. priv->icbs[i].regs[j] |=
  477. MExxCTL_WBF | MExxCTL_WF | MExxCTL_RF;
  478. }
  479. }
  480. return 0;
  481. }
  482. static int sh_mobile_meram_runtime_resume(struct device *dev)
  483. {
  484. struct platform_device *pdev = to_platform_device(dev);
  485. struct sh_mobile_meram_priv *priv = platform_get_drvdata(pdev);
  486. unsigned int i, j;
  487. for (i = 0; i < 32; i++) {
  488. if (!test_bit(i, &priv->used_icb))
  489. continue;
  490. for (j = 0; j < ICB_REGS_SIZE; j++)
  491. meram_write_icb(priv->base, i, icb_regs[j],
  492. priv->icbs[i].regs[j]);
  493. }
  494. for (i = 0; i < CMN_REGS_SIZE; i++)
  495. meram_write_reg(priv->base, common_regs[i], priv->regs[i]);
  496. return 0;
  497. }
  498. static const struct dev_pm_ops sh_mobile_meram_dev_pm_ops = {
  499. .runtime_suspend = sh_mobile_meram_runtime_suspend,
  500. .runtime_resume = sh_mobile_meram_runtime_resume,
  501. };
  502. static struct sh_mobile_meram_ops sh_mobile_meram_ops = {
  503. .module = THIS_MODULE,
  504. .meram_register = sh_mobile_meram_register,
  505. .meram_unregister = sh_mobile_meram_unregister,
  506. .meram_update = sh_mobile_meram_update,
  507. };
  508. /*
  509. * initialize MERAM
  510. */
  511. static int __devinit sh_mobile_meram_probe(struct platform_device *pdev)
  512. {
  513. struct sh_mobile_meram_priv *priv;
  514. struct sh_mobile_meram_info *pdata = pdev->dev.platform_data;
  515. struct resource *regs;
  516. struct resource *meram;
  517. int error;
  518. if (!pdata) {
  519. dev_err(&pdev->dev, "no platform data defined\n");
  520. return -EINVAL;
  521. }
  522. regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  523. meram = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  524. if (regs == NULL || meram == NULL) {
  525. dev_err(&pdev->dev, "cannot get platform resources\n");
  526. return -ENOENT;
  527. }
  528. priv = kzalloc(sizeof(*priv), GFP_KERNEL);
  529. if (!priv) {
  530. dev_err(&pdev->dev, "cannot allocate device data\n");
  531. return -ENOMEM;
  532. }
  533. /* initialize private data */
  534. mutex_init(&priv->lock);
  535. pdata->ops = &sh_mobile_meram_ops;
  536. pdata->priv = priv;
  537. pdata->pdev = pdev;
  538. if (!request_mem_region(regs->start, resource_size(regs), pdev->name)) {
  539. dev_err(&pdev->dev, "MERAM registers region already claimed\n");
  540. error = -EBUSY;
  541. goto err_req_regs;
  542. }
  543. if (!request_mem_region(meram->start, resource_size(meram),
  544. pdev->name)) {
  545. dev_err(&pdev->dev, "MERAM memory region already claimed\n");
  546. error = -EBUSY;
  547. goto err_req_meram;
  548. }
  549. priv->base = ioremap_nocache(regs->start, resource_size(regs));
  550. if (!priv->base) {
  551. dev_err(&pdev->dev, "ioremap failed\n");
  552. error = -EFAULT;
  553. goto err_ioremap;
  554. }
  555. /* initialize ICB addressing mode */
  556. if (pdata->addr_mode == SH_MOBILE_MERAM_MODE1)
  557. meram_write_reg(priv->base, MEVCR1, MEVCR1_AMD1);
  558. platform_set_drvdata(pdev, priv);
  559. pm_runtime_enable(&pdev->dev);
  560. dev_info(&pdev->dev, "sh_mobile_meram initialized.");
  561. return 0;
  562. err_ioremap:
  563. release_mem_region(meram->start, resource_size(meram));
  564. err_req_meram:
  565. release_mem_region(regs->start, resource_size(regs));
  566. err_req_regs:
  567. mutex_destroy(&priv->lock);
  568. kfree(priv);
  569. return error;
  570. }
  571. static int sh_mobile_meram_remove(struct platform_device *pdev)
  572. {
  573. struct sh_mobile_meram_priv *priv = platform_get_drvdata(pdev);
  574. struct resource *regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  575. struct resource *meram = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  576. pm_runtime_disable(&pdev->dev);
  577. iounmap(priv->base);
  578. release_mem_region(meram->start, resource_size(meram));
  579. release_mem_region(regs->start, resource_size(regs));
  580. mutex_destroy(&priv->lock);
  581. kfree(priv);
  582. return 0;
  583. }
  584. static struct platform_driver sh_mobile_meram_driver = {
  585. .driver = {
  586. .name = "sh_mobile_meram",
  587. .owner = THIS_MODULE,
  588. .pm = &sh_mobile_meram_dev_pm_ops,
  589. },
  590. .probe = sh_mobile_meram_probe,
  591. .remove = sh_mobile_meram_remove,
  592. };
  593. module_platform_driver(sh_mobile_meram_driver);
  594. MODULE_DESCRIPTION("SuperH Mobile MERAM driver");
  595. MODULE_AUTHOR("Damian Hobson-Garcia / Takanari Hayama");
  596. MODULE_LICENSE("GPL v2");