drivers/gpu/ipu-v3/ipu-smfc.c

   1 /*
   2  * Copyright 2008-2010 Freescale Semiconductor, Inc. All Rights Reserved.
   3  *
   4  * The code contained herein is licensed under the GNU General Public
   5  * License. You may obtain a copy of the GNU General Public License
   6  * Version 2 or later at the following locations:
   7  *
   8  * http://www.opensource.org/licenses/gpl-license.html
   9  * http://www.gnu.org/copyleft/gpl.html
  10  */
  11 #define DEBUG
  12 #include <linux/export.h>
  13 #include <linux/types.h>
  14 #include <linux/init.h>
  15 #include <linux/io.h>
  16 #include <linux/errno.h>
  17 #include <linux/spinlock.h>
  18 #include <linux/delay.h>
  19 #include <linux/clk.h>
  20 #include <video/imx-ipu-v3.h>
  21
  22 #include "ipu-prv.h"
  23
  24 struct ipu_smfc_priv {
  25         void __iomem *base;
  26         spinlock_t lock;
  27 };
  28
  29 /*SMFC Registers */
  30 #define SMFC_MAP        0x0000
  31 #define SMFC_WMC        0x0004
  32 #define SMFC_BS         0x0008
  33
  34 int ipu_smfc_set_burstsize(struct ipu_soc *ipu, int channel, int burstsize)
  35 {
  36         struct ipu_smfc_priv *smfc = ipu->smfc_priv;
  37         unsigned long flags;
  38         u32 val, shift;
  39
  40         spin_lock_irqsave(&smfc->lock, flags);
  41
  42         shift = channel * 4;
  43         val = readl(smfc->base + SMFC_BS);
  44         val &= ~(0xf << shift);
  45         val |= burstsize << shift;
  46         writel(val, smfc->base + SMFC_BS);
  47
  48         spin_unlock_irqrestore(&smfc->lock, flags);
  49
  50         return 0;
  51 }
  52 EXPORT_SYMBOL_GPL(ipu_smfc_set_burstsize);
  53
  54 int ipu_smfc_map_channel(struct ipu_soc *ipu, int channel, int csi_id, int mipi_id)
  55 {
  56         struct ipu_smfc_priv *smfc = ipu->smfc_priv;
  57         unsigned long flags;
  58         u32 val, shift;
  59
  60         spin_lock_irqsave(&smfc->lock, flags);
  61
  62         shift = channel * 3;
  63         val = readl(smfc->base + SMFC_MAP);
  64         val &= ~(0x7 << shift);
  65         val |= ((csi_id << 2) | mipi_id) << shift;
  66         writel(val, smfc->base + SMFC_MAP);
  67
  68         spin_unlock_irqrestore(&smfc->lock, flags);
  69
  70         return 0;
  71 }
  72 EXPORT_SYMBOL_GPL(ipu_smfc_map_channel);
  73
  74 int ipu_smfc_init(struct ipu_soc *ipu, struct device *dev,
  75                   unsigned long base)
  76 {
  77         struct ipu_smfc_priv *smfc;
  78
  79         smfc = devm_kzalloc(dev, sizeof(*smfc), GFP_KERNEL);
  80         if (!smfc)
  81                 return -ENOMEM;
  82
  83         ipu->smfc_priv = smfc;
  84         spin_lock_init(&smfc->lock);
  85
  86         smfc->base = devm_ioremap(dev, base, PAGE_SIZE);
  87         if (!smfc->base)
  88                 return -ENOMEM;
  89
  90         pr_debug("%s: ioremap 0x%08lx -> %p\n", __func__, base, smfc->base);
  91
  92         return 0;
  93 }
  94
  95 void ipu_smfc_exit(struct ipu_soc *ipu)
  96 {
  97 }