arch/arm/plat-samsung/s5p-dev-mfc.c

   1 /*
   2  * Copyright (C) 2010-2011 Samsung Electronics Co.Ltd
   3  *
   4  * Base S5P MFC resource and device definitions
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  */
  10
  11 #include <linux/kernel.h>
  12 #include <linux/interrupt.h>
  13 #include <linux/platform_device.h>
  14 #include <linux/dma-mapping.h>
  15 #include <linux/memblock.h>
  16 #include <linux/ioport.h>
  17 #include <linux/of_fdt.h>
  18 #include <linux/of.h>
  19
  20 static struct platform_device s5p_device_mfc_l;
  21 static struct platform_device s5p_device_mfc_r;
  22
  23 struct s5p_mfc_dt_meminfo {
  24         unsigned long   loff;
  25         unsigned long   lsize;
  26         unsigned long   roff;
  27         unsigned long   rsize;
  28         char            *compatible;
  29 };
  30
  31 struct s5p_mfc_reserved_mem {
  32         phys_addr_t     base;
  33         unsigned long   size;
  34         struct device   *dev;
  35 };
  36
  37 static struct s5p_mfc_reserved_mem s5p_mfc_mem[2] __initdata;
  38
  39
  40 static void __init s5p_mfc_reserve_mem(phys_addr_t rbase, unsigned int rsize,
  41                                 phys_addr_t lbase, unsigned int lsize)
  42 {
  43         int i;
  44
  45         s5p_mfc_mem[0].dev = &s5p_device_mfc_r.dev;
  46         s5p_mfc_mem[0].base = rbase;
  47         s5p_mfc_mem[0].size = rsize;
  48
  49         s5p_mfc_mem[1].dev = &s5p_device_mfc_l.dev;
  50         s5p_mfc_mem[1].base = lbase;
  51         s5p_mfc_mem[1].size = lsize;
  52
  53         for (i = 0; i < ARRAY_SIZE(s5p_mfc_mem); i++) {
  54                 struct s5p_mfc_reserved_mem *area = &s5p_mfc_mem[i];
  55                 if (memblock_remove(area->base, area->size)) {
  56                         printk(KERN_ERR "Failed to reserve memory for MFC device (%ld bytes at 0x%08lx)\n",
  57                                area->size, (unsigned long) area->base);
  58                         area->base = 0;
  59                 }
  60         }
  61 }
  62
  63 int __init s5p_fdt_alloc_mfc_mem(unsigned long node, const char *uname,
  64                                 int depth, void *data)
  65 {
  66         const __be32 *prop;
  67         int len;
  68         struct s5p_mfc_dt_meminfo mfc_mem;
  69
  70         if (!data)
  71                 return 0;
  72
  73         if (!of_flat_dt_is_compatible(node, data))
  74                 return 0;
  75
  76         prop = of_get_flat_dt_prop(node, "samsung,mfc-l", &len);
  77         if (!prop || (len != 2 * sizeof(unsigned long)))
  78                 return 0;
  79
  80         mfc_mem.loff = be32_to_cpu(prop[0]);
  81         mfc_mem.lsize = be32_to_cpu(prop[1]);
  82
  83         prop = of_get_flat_dt_prop(node, "samsung,mfc-r", &len);
  84         if (!prop || (len != 2 * sizeof(unsigned long)))
  85                 return 0;
  86
  87         mfc_mem.roff = be32_to_cpu(prop[0]);
  88         mfc_mem.rsize = be32_to_cpu(prop[1]);
  89
  90         s5p_mfc_reserve_mem(mfc_mem.roff, mfc_mem.rsize,
  91                         mfc_mem.loff, mfc_mem.lsize);
  92
  93         return 1;
  94 }