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 } 188