arch/powerpc/cpu/mpc85xx/liodn.c

   1 /*
   2  * Copyright 2008-2011 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_srio_liodn(struct srio_liodn_id_table *tbl, int size)
  44 {
  45         int i;
  46
  47         for (i = 0; i < size; i++) {
  48                 unsigned long reg_off = tbl[i].reg_offset[0];
  49                 out_be32((u32 *)reg_off, tbl[i].id[0]);
  50
  51                 if (tbl[i].num_ids == 2) {
  52                         reg_off = tbl[i].reg_offset[1];
  53                         out_be32((u32 *)reg_off, tbl[i].id[1]);
  54                 }
  55         }
  56 }
  57
  58 static void set_liodn(struct liodn_id_table *tbl, int size)
  59 {
  60         int i;
  61
  62         for (i = 0; i < size; i++) {
  63                 u32 liodn;
  64                 if (tbl[i].num_ids == 2) {
  65                         liodn = (tbl[i].id[0] << 16) | tbl[i].id[1];
  66                 } else {
  67                         liodn = tbl[i].id[0];
  68                 }
  69
  70                 out_be32((volatile u32 *)(tbl[i].reg_offset), liodn);
  71         }
  72 }
  73
  74 static void setup_sec_liodn_base(void)
  75 {
  76         ccsr_sec_t *sec = (void *)CONFIG_SYS_FSL_SEC_ADDR;
  77         u32 base;
  78
  79         if (!IS_E_PROCESSOR(get_svr()))
  80                 return;
  81
  82         /* QILCR[QSLOM] */
  83         out_be32(&sec->qilcr_ms, 0x3ff<<16);
  84
  85         base = (liodn_bases[FSL_HW_PORTAL_SEC].id[0] << 16) |
  86                 liodn_bases[FSL_HW_PORTAL_SEC].id[1];
  87
  88         out_be32(&sec->qilcr_ls, base);
  89 }
  90
  91 #ifdef CONFIG_SYS_DPAA_FMAN
  92 static void setup_fman_liodn_base(enum fsl_dpaa_dev dev,
  93                                   struct liodn_id_table *tbl, int size)
  94 {
  95         int i;
  96         ccsr_fman_t *fm;
  97         u32 base;
  98
  99         switch(dev) {
 100         case FSL_HW_PORTAL_FMAN1:
 101                 fm = (void *)CONFIG_SYS_FSL_FM1_ADDR;
 102                 break;
 103
 104 #if (CONFIG_SYS_NUM_FMAN == 2)
 105         case FSL_HW_PORTAL_FMAN2:
 106                 fm = (void *)CONFIG_SYS_FSL_FM2_ADDR;
 107                 break;
 108 #endif
 109         default:
 110                 printf("Error: Invalid device type to %s\n", __FUNCTION__);
 111                 return ;
 112         }
 113
 114         base = (liodn_bases[dev].id[0] << 16) | liodn_bases[dev].id[0];
 115
 116         /* setup all bases the same */
 117         for (i = 0; i < 32; i++) {
 118                 out_be32(&fm->fm_dma.fmdmplr[i], base);
 119         }
 120
 121         /* update tbl to ... */
 122         for (i = 0; i < size; i++)
 123                 tbl[i].id[0] += liodn_bases[dev].id[0];
 124 }
 125 #endif
 126
 127 static void setup_pme_liodn_base(void)
 128 {
 129 #ifdef CONFIG_SYS_DPAA_PME
 130         ccsr_pme_t *pme = (void *)CONFIG_SYS_FSL_CORENET_PME_ADDR;
 131         u32 base = (liodn_bases[FSL_HW_PORTAL_PME].id[0] << 16) |
 132                         liodn_bases[FSL_HW_PORTAL_PME].id[1];
 133
 134         out_be32(&pme->liodnbr, base);
 135 #endif
 136 }
 137
 138 #ifdef CONFIG_SYS_FSL_RAID_ENGINE
 139 static void setup_raide_liodn_base(void)
 140 {
 141         struct ccsr_raide *raide = (void *)CONFIG_SYS_FSL_RAID_ENGINE_ADDR;
 142
 143         /* setup raid engine liodn base for data/desc ; both set to 47 */
 144         u32 base = (liodn_bases[FSL_HW_PORTAL_RAID_ENGINE].id[0] << 16) |
 145                         liodn_bases[FSL_HW_PORTAL_RAID_ENGINE].id[0];
 146
 147         out_be32(&raide->liodnbr, base);
 148 }
 149 #endif
 150
 151 #ifdef CONFIG_SYS_DPAA_RMAN
 152 static void set_rman_liodn(struct liodn_id_table *tbl, int size)
 153 {
 154         int i;
 155         struct ccsr_rman *rman = (void *)CONFIG_SYS_FSL_CORENET_RMAN_ADDR;
 156
 157         for (i = 0; i < size; i++) {
 158                 /* write the RMan block number */
 159                 out_be32(&rman->mmitar, i);
 160                 /* write the liodn offset corresponding to the block */
 161                 out_be32((u32 *)(tbl[i].reg_offset), tbl[i].id[0]);
 162         }
 163 }
 164
 165 static void setup_rman_liodn_base(struct liodn_id_table *tbl, int size)
 166 {
 167         int i;
 168         struct ccsr_rman *rman = (void *)CONFIG_SYS_FSL_CORENET_RMAN_ADDR;
 169         u32 base = liodn_bases[FSL_HW_PORTAL_RMAN].id[0];
 170
 171         out_be32(&rman->mmliodnbr, base);
 172
 173         /* update liodn offset */
 174         for (i = 0; i < size; i++)
 175                 tbl[i].id[0] += base;
 176 }
 177 #endif
 178
 179 void set_liodns(void)
 180 {
 181         /* setup general liodn offsets */
 182         set_liodn(liodn_tbl, liodn_tbl_sz);
 183
 184         /* setup SRIO port liodns */
 185         set_srio_liodn(srio_liodn_tbl, srio_liodn_tbl_sz);
 186
 187         /* setup SEC block liodn bases & offsets if we have one */
 188         if (IS_E_PROCESSOR(get_svr())) {
 189                 set_liodn(sec_liodn_tbl, sec_liodn_tbl_sz);
 190                 setup_sec_liodn_base();
 191         }
 192
 193         /* setup FMAN block(s) liodn bases & offsets if we have one */
 194 #ifdef CONFIG_SYS_DPAA_FMAN
 195         set_liodn(fman1_liodn_tbl, fman1_liodn_tbl_sz);
 196         setup_fman_liodn_base(FSL_HW_PORTAL_FMAN1, fman1_liodn_tbl,
 197                                 fman1_liodn_tbl_sz);
 198
 199 #if (CONFIG_SYS_NUM_FMAN == 2)
 200         set_liodn(fman2_liodn_tbl, fman2_liodn_tbl_sz);
 201         setup_fman_liodn_base(FSL_HW_PORTAL_FMAN2, fman2_liodn_tbl,
 202                                 fman2_liodn_tbl_sz);
 203 #endif
 204 #endif
 205         /* setup PME liodn base */
 206         setup_pme_liodn_base();
 207
 208 #ifdef CONFIG_SYS_FSL_RAID_ENGINE
 209         /* raid engine ccr addr code for liodn */
 210         set_liodn(raide_liodn_tbl, raide_liodn_tbl_sz);
 211         setup_raide_liodn_base();
 212 #endif
 213
 214 #ifdef CONFIG_SYS_DPAA_RMAN
 215         /* setup RMan liodn offsets */
 216         set_rman_liodn(rman_liodn_tbl, rman_liodn_tbl_sz);
 217         /* setup RMan liodn base */
 218         setup_rman_liodn_base(rman_liodn_tbl, rman_liodn_tbl_sz);
 219 #endif
 220 }
 221
 222 static void fdt_fixup_srio_liodn(void *blob, struct srio_liodn_id_table *tbl)
 223 {
 224         int i, srio_off;
 225
 226         /* search for srio node, if doesn't exist just return - nothing todo */
 227         srio_off = fdt_node_offset_by_compatible(blob, -1, "fsl,srio");
 228         if (srio_off < 0)
 229                 return ;
 230
 231         for (i = 0; i < srio_liodn_tbl_sz; i++) {
 232                 int off, portid = tbl[i].portid;
 233
 234                 off = fdt_node_offset_by_prop_value(blob, srio_off,
 235                          "cell-index", &portid, 4);
 236                 if (off >= 0) {
 237                         off = fdt_setprop(blob, off, "fsl,liodn",
 238                                 &tbl[i].id[0],
 239                                 sizeof(u32) * tbl[i].num_ids);
 240                         if (off > 0)
 241                                 printf("WARNING unable to set fsl,liodn for "
 242                                         "fsl,srio port %d: %s\n",
 243                                         portid, fdt_strerror(off));
 244                 } else {
 245                         debug("WARNING: couldn't set fsl,liodn for srio: %s.\n",
 246                                 fdt_strerror(off));
 247                 }
 248         }
 249 }
 250
 251 static void fdt_fixup_liodn_tbl(void *blob, struct liodn_id_table *tbl, int sz)
 252 {
 253         int i;
 254
 255         for (i = 0; i < sz; i++) {
 256                 int off;
 257
 258                 if (tbl[i].compat == NULL)
 259                         continue;
 260
 261                 off = fdt_node_offset_by_compat_reg(blob,
 262                                 tbl[i].compat, tbl[i].compat_offset);
 263                 if (off >= 0) {
 264                         off = fdt_setprop(blob, off, "fsl,liodn",
 265                                 &tbl[i].id[0],
 266                                 sizeof(u32) * tbl[i].num_ids);
 267                         if (off > 0)
 268                                 printf("WARNING unable to set fsl,liodn for "
 269                                         "%s: %s\n",
 270                                         tbl[i].compat, fdt_strerror(off));
 271                 } else {
 272                         debug("WARNING: could not set fsl,liodn for %s: %s.\n",
 273                                         tbl[i].compat, fdt_strerror(off));
 274                 }
 275         }
 276 }
 277
 278 void fdt_fixup_liodn(void *blob)
 279 {
 280         fdt_fixup_srio_liodn(blob, srio_liodn_tbl);
 281
 282         fdt_fixup_liodn_tbl(blob, liodn_tbl, liodn_tbl_sz);
 283 #ifdef CONFIG_SYS_DPAA_FMAN
 284         fdt_fixup_liodn_tbl(blob, fman1_liodn_tbl, fman1_liodn_tbl_sz);
 285 #if (CONFIG_SYS_NUM_FMAN == 2)
 286         fdt_fixup_liodn_tbl(blob, fman2_liodn_tbl, fman2_liodn_tbl_sz);
 287 #endif
 288 #endif
 289         fdt_fixup_liodn_tbl(blob, sec_liodn_tbl, sec_liodn_tbl_sz);
 290
 291 #ifdef CONFIG_SYS_FSL_RAID_ENGINE
 292         fdt_fixup_liodn_tbl(blob, raide_liodn_tbl, raide_liodn_tbl_sz);
 293 #endif
 294
 295 #ifdef CONFIG_SYS_DPAA_RMAN
 296         fdt_fixup_liodn_tbl(blob, rman_liodn_tbl, rman_liodn_tbl_sz);
 297 #endif
 298 }