sh_mobile_meram.c 19 KB

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