2 * Copyright 2008-2011 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_srio_liodn(struct srio_liodn_id_table
*tbl
, int size
)
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]);
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]);
58 static void set_liodn(struct liodn_id_table
*tbl
, int size
)
62 for (i
= 0; i
< size
; i
++) {
64 if (tbl
[i
].num_ids
== 2) {
65 liodn
= (tbl
[i
].id
[0] << 16) | tbl
[i
].id
[1];
70 out_be32((volatile u32
*)(tbl
[i
].reg_offset
), liodn
);
74 static void setup_sec_liodn_base(void)
76 ccsr_sec_t
*sec
= (void *)CONFIG_SYS_FSL_SEC_ADDR
;
79 if (!IS_E_PROCESSOR(get_svr()))
83 out_be32(&sec
->qilcr_ms
, 0x3ff<<16);
85 base
= (liodn_bases
[FSL_HW_PORTAL_SEC
].id
[0] << 16) |
86 liodn_bases
[FSL_HW_PORTAL_SEC
].id
[1];
88 out_be32(&sec
->qilcr_ls
, base
);
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
)
100 case FSL_HW_PORTAL_FMAN1
:
101 fm
= (void *)CONFIG_SYS_FSL_FM1_ADDR
;
104 #if (CONFIG_SYS_NUM_FMAN == 2)
105 case FSL_HW_PORTAL_FMAN2
:
106 fm
= (void *)CONFIG_SYS_FSL_FM2_ADDR
;
110 printf("Error: Invalid device type to %s\n", __FUNCTION__
);
114 base
= (liodn_bases
[dev
].id
[0] << 16) | liodn_bases
[dev
].id
[0];
116 /* setup all bases the same */
117 for (i
= 0; i
< 32; i
++) {
118 out_be32(&fm
->fm_dma
.fmdmplr
[i
], base
);
121 /* update tbl to ... */
122 for (i
= 0; i
< size
; i
++)
123 tbl
[i
].id
[0] += liodn_bases
[dev
].id
[0];
127 static void setup_pme_liodn_base(void)
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];
134 out_be32(&pme
->liodnbr
, base
);
138 #ifdef CONFIG_SYS_FSL_RAID_ENGINE
139 static void setup_raide_liodn_base(void)
141 struct ccsr_raide
*raide
= (void *)CONFIG_SYS_FSL_RAID_ENGINE_ADDR
;
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];
147 out_be32(&raide
->liodnbr
, base
);
151 #ifdef CONFIG_SYS_DPAA_RMAN
152 static void set_rman_liodn(struct liodn_id_table
*tbl
, int size
)
155 struct ccsr_rman
*rman
= (void *)CONFIG_SYS_FSL_CORENET_RMAN_ADDR
;
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]);
165 static void setup_rman_liodn_base(struct liodn_id_table
*tbl
, int size
)
168 struct ccsr_rman
*rman
= (void *)CONFIG_SYS_FSL_CORENET_RMAN_ADDR
;
169 u32 base
= liodn_bases
[FSL_HW_PORTAL_RMAN
].id
[0];
171 out_be32(&rman
->mmliodnbr
, base
);
173 /* update liodn offset */
174 for (i
= 0; i
< size
; i
++)
175 tbl
[i
].id
[0] += base
;
179 void set_liodns(void)
181 /* setup general liodn offsets */
182 set_liodn(liodn_tbl
, liodn_tbl_sz
);
184 /* setup SRIO port liodns */
185 set_srio_liodn(srio_liodn_tbl
, srio_liodn_tbl_sz
);
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();
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
,
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
,
205 /* setup PME liodn base */
206 setup_pme_liodn_base();
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();
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
);
222 static void fdt_fixup_srio_liodn(void *blob
, struct srio_liodn_id_table
*tbl
)
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");
231 for (i
= 0; i
< srio_liodn_tbl_sz
; i
++) {
232 int off
, portid
= tbl
[i
].portid
;
234 off
= fdt_node_offset_by_prop_value(blob
, srio_off
,
235 "cell-index", &portid
, 4);
237 off
= fdt_setprop(blob
, off
, "fsl,liodn",
239 sizeof(u32
) * tbl
[i
].num_ids
);
241 printf("WARNING unable to set fsl,liodn for "
242 "fsl,srio port %d: %s\n",
243 portid
, fdt_strerror(off
));
245 debug("WARNING: couldn't set fsl,liodn for srio: %s.\n",
251 static void fdt_fixup_liodn_tbl(void *blob
, struct liodn_id_table
*tbl
, int sz
)
255 for (i
= 0; i
< sz
; i
++) {
258 if (tbl
[i
].compat
== NULL
)
261 off
= fdt_node_offset_by_compat_reg(blob
,
262 tbl
[i
].compat
, tbl
[i
].compat_offset
);
264 off
= fdt_setprop(blob
, off
, "fsl,liodn",
266 sizeof(u32
) * tbl
[i
].num_ids
);
268 printf("WARNING unable to set fsl,liodn for "
270 tbl
[i
].compat
, fdt_strerror(off
));
272 debug("WARNING: could not set fsl,liodn for %s: %s.\n",
273 tbl
[i
].compat
, fdt_strerror(off
));
278 void fdt_fixup_liodn(void *blob
)
280 fdt_fixup_srio_liodn(blob
, srio_liodn_tbl
);
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
);
289 fdt_fixup_liodn_tbl(blob
, sec_liodn_tbl
, sec_liodn_tbl_sz
);
291 #ifdef CONFIG_SYS_FSL_RAID_ENGINE
292 fdt_fixup_liodn_tbl(blob
, raide_liodn_tbl
, raide_liodn_tbl_sz
);
295 #ifdef CONFIG_SYS_DPAA_RMAN
296 fdt_fixup_liodn_tbl(blob
, rman_liodn_tbl
, rman_liodn_tbl_sz
);