arch/powerpc/cpu/mpc85xx/liodn.c

   1 /*
   2  * Copyright 2008-2010 Freescale Semiconductor, Inc.
   3  *
   4  * See file CREDITS for list of people who contributed to this
   5  * project.
   6  *
   7  * This program is free software; you can redistribute it and/or
   8  * modify it under the terms of the GNU General Public License as
   9  * published by the Free Software Foundation; either version 2 of
  10  * the License, or (at your option) any later version.
  11  *
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  20  * MA 02111-1307 USA
  21  */
  22
  23 #include <common.h>
  24 #include <libfdt.h>
  25 #include <fdt_support.h>
  26
  27 #include <asm/immap_85xx.h>
  28 #include <asm/io.h>
  29 #include <asm/processor.h>
  30 #include <asm/fsl_portals.h>
  31 #include <asm/fsl_liodn.h>
  32
  33 int get_dpaa_liodn(enum fsl_dpaa_dev dpaa_dev, u32 *liodns, int liodn_offset)
  34 {
  35         liodns[0] = liodn_bases[dpaa_dev].id[0] + liodn_offset;
  36
  37         if (liodn_bases[dpaa_dev].num_ids == 2)
  38                 liodns[1] = liodn_bases[dpaa_dev].id[1] + liodn_offset;
  39
  40         return liodn_bases[dpaa_dev].num_ids;
  41 }
  42
  43 static void set_liodn(struct liodn_id_table *tbl, int size)
  44 {
  45         int i;
  46
  47         for (i = 0; i < size; i++) {
  48                 u32 liodn;
  49                 if (tbl[i].num_ids == 2) {
  50                         liodn = (tbl[i].id[0] << 16) | tbl[i].id[1];
  51                 } else {
  52                         liodn = tbl[i].id[0];
  53                 }
  54
  55                 out_be32((volatile u32 *)(tbl[i].reg_offset), liodn);
  56         }
  57 }
  58
  59 static void setup_sec_liodn_base(void)
  60 {
  61         ccsr_sec_t *sec = (void *)CONFIG_SYS_FSL_SEC_ADDR;
  62         u32 base;
  63
  64         if (!IS_E_PROCESSOR(get_svr()))
  65                 return;
  66
  67         /* QILCR[QSLOM] */
  68         out_be32(&sec->qilcr_ms, 0x3ff<<16);
  69
  70         base = (liodn_bases[FSL_HW_PORTAL_SEC].id[0] << 16) |
  71                 liodn_bases[FSL_HW_PORTAL_SEC].id[1];
  72
  73         out_be32(&sec->qilcr_ls, base);
  74 }
  75
  76 #ifdef CONFIG_SYS_DPAA_FMAN
  77 static void setup_fman_liodn_base(enum fsl_dpaa_dev dev,
  78                                   struct liodn_id_table *tbl, int size)
  79 {
  80         int i;
  81         ccsr_fman_t *fm;
  82         u32 base;
  83
  84         switch(dev) {
  85         case FSL_HW_PORTAL_FMAN1:
  86                 fm = (void *)CONFIG_SYS_FSL_FM1_ADDR;
  87                 break;
  88
  89 #if (CONFIG_SYS_NUM_FMAN == 2)
  90         case FSL_HW_PORTAL_FMAN2:
  91                 fm = (void *)CONFIG_SYS_FSL_FM2_ADDR;
  92                 break;
  93 #endif
  94         default:
  95                 printf("Error: Invalid device type to %s\n", __FUNCTION__);
  96                 return ;
  97         }
  98
  99         base = (liodn_bases[dev].id[0] << 16) | liodn_bases[dev].id[0];
 100
 101         /* setup all bases the same */
 102         for (i = 0; i < 32; i++) {
 103                 out_be32(&fm->fm_dma.fmdmplr[i], base);
 104         }
 105
 106         /* update tbl to ... */
 107         for (i = 0; i < size; i++)
 108                 tbl[i].id[0] += liodn_bases[dev].id[0];
 109 }
 110 #endif
 111
 112 static void setup_pme_liodn_base(void)
 113 {
 114 #ifdef CONFIG_SYS_DPAA_PME
 115         ccsr_pme_t *pme = (void *)CONFIG_SYS_FSL_CORENET_PME_ADDR;
 116         u32 base = (liodn_bases[FSL_HW_PORTAL_PME].id[0] << 16) |
 117                         liodn_bases[FSL_HW_PORTAL_PME].id[1];
 118
 119         out_be32(&pme->liodnbr, base);
 120 #endif
 121 }
 122
 123 void set_liodns(void)
 124 {
 125         /* setup general liodn offsets */
 126         set_liodn(liodn_tbl, liodn_tbl_sz);
 127
 128         /* setup SEC block liodn bases & offsets if we have one */
 129         if (IS_E_PROCESSOR(get_svr())) {
 130                 set_liodn(sec_liodn_tbl, sec_liodn_tbl_sz);
 131                 setup_sec_liodn_base();
 132         }
 133
 134         /* setup FMAN block(s) liodn bases & offsets if we have one */
 135 #ifdef CONFIG_SYS_DPAA_FMAN
 136         set_liodn(fman1_liodn_tbl, fman1_liodn_tbl_sz);
 137         setup_fman_liodn_base(FSL_HW_PORTAL_FMAN1, fman1_liodn_tbl,
 138                                 fman1_liodn_tbl_sz);
 139
 140 #if (CONFIG_SYS_NUM_FMAN == 2)
 141         set_liodn(fman2_liodn_tbl, fman2_liodn_tbl_sz);
 142         setup_fman_liodn_base(FSL_HW_PORTAL_FMAN2, fman2_liodn_tbl,
 143                                 fman2_liodn_tbl_sz);
 144 #endif
 145 #endif
 146         /* setup PME liodn base */
 147         setup_pme_liodn_base();
 148 }
 149
 150 static void fdt_fixup_liodn_tbl(void *blob, struct liodn_id_table *tbl, int sz)
 151 {
 152         int i;
 153
 154         for (i = 0; i < sz; i++) {
 155                 int off;
 156
 157                 if (tbl[i].compat == NULL)
 158                         continue;
 159
 160                 off = fdt_node_offset_by_compat_reg(blob,
 161                                 tbl[i].compat, tbl[i].compat_offset);
 162                 if (off >= 0) {
 163                         off = fdt_setprop(blob, off, "fsl,liodn",
 164                                 &tbl[i].id[0],
 165                                 sizeof(u32) * tbl[i].num_ids);
 166                         if (off > 0)
 167                                 printf("WARNING unable to set fsl,liodn for "
 168                                         "%s: %s\n",
 169                                         tbl[i].compat, fdt_strerror(off));
 170                 } else {
 171                         debug("WARNING: could not set fsl,liodn for %s: %s.\n",
 172                                         tbl[i].compat, fdt_strerror(off));
 173                 }
 174         }
 175 }
 176
 177 void fdt_fixup_liodn(void *blob)
 178 {
 179         fdt_fixup_liodn_tbl(blob, liodn_tbl, liodn_tbl_sz);
 180 #ifdef CONFIG_SYS_DPAA_FMAN
 181         fdt_fixup_liodn_tbl(blob, fman1_liodn_tbl, fman1_liodn_tbl_sz);
 182 #if (CONFIG_SYS_NUM_FMAN == 2)
 183         fdt_fixup_liodn_tbl(blob, fman2_liodn_tbl, fman2_liodn_tbl_sz);
 184 #endif
 185 #endif
 186         fdt_fixup_liodn_tbl(blob, sec_liodn_tbl, sec_liodn_tbl_sz);
 187 }