2 * Copyright 2008-2010 Freescale Semiconductor, Inc.
4 * See file CREDITS for list of people who contributed to this
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.
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.
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,
25 #include <fdt_support.h>
27 #include <asm/immap_85xx.h>
29 #include <asm/processor.h>
30 #include <asm/fsl_portals.h>
31 #include <asm/fsl_liodn.h>
33 int get_dpaa_liodn(enum fsl_dpaa_dev dpaa_dev, u32 *liodns, int liodn_offset)
35 liodns[0] = liodn_bases[dpaa_dev].id[0] + liodn_offset;
37 if (liodn_bases[dpaa_dev].num_ids == 2)
38 liodns[1] = liodn_bases[dpaa_dev].id[1] + liodn_offset;
40 return liodn_bases[dpaa_dev].num_ids;
43 static void set_liodn(struct liodn_id_table *tbl, int size)
47 for (i = 0; i < size; i++) {
49 if (tbl[i].num_ids == 2) {
50 liodn = (tbl[i].id[0] << 16) | tbl[i].id[1];
55 out_be32((volatile u32 *)(tbl[i].reg_offset), liodn);
59 static void setup_sec_liodn_base(void)
61 ccsr_sec_t *sec = (void *)CONFIG_SYS_FSL_SEC_ADDR;
64 if (!IS_E_PROCESSOR(get_svr()))
68 out_be32(&sec->qilcr_ms, 0x3ff<<16);
70 base = (liodn_bases[FSL_HW_PORTAL_SEC].id[0] << 16) |
71 liodn_bases[FSL_HW_PORTAL_SEC].id[1];
73 out_be32(&sec->qilcr_ls, base);
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)
85 case FSL_HW_PORTAL_FMAN1:
86 fm = (void *)CONFIG_SYS_FSL_FM1_ADDR;
89 #if (CONFIG_SYS_NUM_FMAN == 2)
90 case FSL_HW_PORTAL_FMAN2:
91 fm = (void *)CONFIG_SYS_FSL_FM2_ADDR;
95 printf("Error: Invalid device type to %s\n", __FUNCTION__);
99 base = (liodn_bases[dev].id[0] << 16) | liodn_bases[dev].id[0];
101 /* setup all bases the same */
102 for (i = 0; i < 32; i++) {
103 out_be32(&fm->fm_dma.fmdmplr[i], base);
106 /* update tbl to ... */
107 for (i = 0; i < size; i++)
108 tbl[i].id[0] += liodn_bases[dev].id[0];
112 static void setup_pme_liodn_base(void)
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];
119 out_be32(&pme->liodnbr, base);
123 void set_liodns(void)
125 /* setup general liodn offsets */
126 set_liodn(liodn_tbl, liodn_tbl_sz);
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();
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,
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,
146 /* setup PME liodn base */
147 setup_pme_liodn_base();
150 static void fdt_fixup_liodn_tbl(void *blob, struct liodn_id_table *tbl, int sz)
154 for (i = 0; i < sz; i++) {
157 if (tbl[i].compat == NULL)
160 off = fdt_node_offset_by_compat_reg(blob,
161 tbl[i].compat, tbl[i].compat_offset);
163 off = fdt_setprop(blob, off, "fsl,liodn",
165 sizeof(u32) * tbl[i].num_ids);
167 printf("WARNING unable to set fsl,liodn for "
169 tbl[i].compat, fdt_strerror(off));
171 debug("WARNING: could not set fsl,liodn for %s: %s.\n",
172 tbl[i].compat, fdt_strerror(off));
177 void fdt_fixup_liodn(void *blob)
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);
186 fdt_fixup_liodn_tbl(blob, sec_liodn_tbl, sec_liodn_tbl_sz);