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/processor.h> 28 #include <asm/io.h> 29 30 #include <asm/fsl_portals.h> 31 #include <asm/fsl_liodn.h> 32 33 static ccsr_qman_t *qman = (void *)CONFIG_SYS_FSL_QMAN_ADDR; 34 static ccsr_bman_t *bman = (void *)CONFIG_SYS_FSL_BMAN_ADDR; 35 36 void setup_portals(void) 37 { 38 #ifdef CONFIG_FSL_CORENET 39 int i; 40 41 for (i = 0; i < CONFIG_SYS_QMAN_NUM_PORTALS; i++) { 42 u8 sdest = qp_info[i].sdest; 43 u16 fliodn = qp_info[i].fliodn; 44 u16 dliodn = qp_info[i].dliodn; 45 u16 liodn_off = qp_info[i].liodn_offset; 46 47 out_be32(&qman->qcsp[i].qcsp_lio_cfg, (liodn_off << 16) | 48 dliodn); 49 /* set frame liodn */ 50 out_be32(&qman->qcsp[i].qcsp_io_cfg, (sdest << 16) | fliodn); 51 } 52 #endif 53 54 /* Set the Qman initiator BAR to match the LAW (for DQRR stashing) */ 55 #ifdef CONFIG_PHYS_64BIT 56 out_be32(&qman->qcsp_bare, (u32)(CONFIG_SYS_QMAN_MEM_PHYS >> 32)); 57 #endif 58 out_be32(&qman->qcsp_bar, (u32)CONFIG_SYS_QMAN_MEM_PHYS); 59 } 60 61 /* Update portal containter to match LAW setup of portal in phy map */ 62 void fdt_portal(void *blob, const char *compat, const char *container, 63 u64 addr, u32 size) 64 { 65 int off; 66 67 off = fdt_node_offset_by_compatible(blob, -1, compat); 68 if (off < 0) 69 return ; 70 71 off = fdt_parent_offset(blob, off); 72 /* if non-zero assume we have a container */ 73 if (off > 0) { 74 char buf[60]; 75 const char *p, *name; 76 u32 *range; 77 int len; 78 79 /* fixup ranges */ 80 range = fdt_getprop_w(blob, off, "ranges", &len); 81 if (range == NULL) { 82 printf("ERROR: container for %s has no ranges", compat); 83 return ; 84 } 85 86 range[0] = 0; 87 if (len == 16) { 88 range[1] = addr >> 32; 89 range[2] = addr & 0xffffffff; 90 range[3] = size; 91 } else { 92 range[1] = addr & 0xffffffff; 93 range[2] = size; 94 } 95 fdt_setprop_inplace(blob, off, "ranges", range, len); 96 97 /* fixup the name */ 98 name = fdt_get_name(blob, off, &len); 99 p = memchr(name, '@', len); 100 101 if (p) 102 len = p - name; 103 104 /* if we are given a container name check it 105 * against what we found, if it doesnt match exit out */ 106 if (container && (memcmp(container, name, len))) { 107 printf("WARNING: container names didn't match %s %s\n", 108 container, name); 109 return ; 110 } 111 112 memcpy(&buf, name, len); 113 len += sprintf(&buf[len], "@%llx", addr); 114 fdt_set_name(blob, off, buf); 115 return ; 116 } 117 118 printf("ERROR: %s isn't in a container. Not supported\n", compat); 119 } 120 121 static int fdt_qportal(void *blob, int off, int id, char *name, 122 enum fsl_dpaa_dev dev, int create) 123 { 124 int childoff, dev_off, ret = 0; 125 uint32_t dev_handle; 126 #ifdef CONFIG_FSL_CORENET 127 int num; 128 u32 liodns[2]; 129 #endif 130 131 childoff = fdt_subnode_offset(blob, off, name); 132 if (create) { 133 if (childoff <= 0) 134 childoff = fdt_add_subnode(blob, off, name); 135 136 if (childoff > 0) { 137 char handle[64], *p; 138 139 strncpy(handle, name, sizeof(handle)); 140 p = strchr(handle, '@'); 141 if (!strncmp(name, "fman", 4)) { 142 *p = *(p + 1); 143 p++; 144 } 145 *p = '\0'; 146 147 dev_off = fdt_path_offset(blob, handle); 148 if (dev_off < 0) 149 return dev_off; 150 151 dev_handle = fdt_get_phandle(blob, dev_off); 152 if (dev_handle <= 0) { 153 dev_handle = fdt_alloc_phandle(blob); 154 ret = fdt_set_phandle(blob, dev_off, 155 dev_handle); 156 if (ret < 0) 157 return ret; 158 } 159 160 ret = fdt_setprop(blob, childoff, "dev-handle", 161 &dev_handle, sizeof(dev_handle)); 162 if (ret < 0) 163 return ret; 164 165 #ifdef CONFIG_FSL_CORENET 166 num = get_dpaa_liodn(dev, &liodns[0], id); 167 ret = fdt_setprop(blob, childoff, "fsl,liodn", 168 &liodns[0], sizeof(u32) * num); 169 #endif 170 } else { 171 return childoff; 172 } 173 } else { 174 if (childoff > 0) 175 ret = fdt_del_node(blob, childoff); 176 } 177 178 return ret; 179 } 180 181 void fdt_fixup_qportals(void *blob) 182 { 183 int off, err; 184 unsigned int maj, min; 185 u32 rev_1 = in_be32(&qman->ip_rev_1); 186 char compat[64]; 187 int compat_len; 188 189 maj = (rev_1 >> 8) & 0xff; 190 min = rev_1 & 0xff; 191 192 compat_len = sprintf(compat, "fsl,qman-portal-%u.%u", maj, min) + 1; 193 compat_len += sprintf(compat + compat_len, "fsl,qman-portal") + 1; 194 195 off = fdt_node_offset_by_compatible(blob, -1, "fsl,qman-portal"); 196 while (off != -FDT_ERR_NOTFOUND) { 197 #ifdef CONFIG_FSL_CORENET 198 u32 liodns[2]; 199 #endif 200 const int *ci = fdt_getprop(blob, off, "cell-index", NULL); 201 int i = *ci; 202 #ifdef CONFIG_SYS_DPAA_FMAN 203 int j; 204 #endif 205 206 err = fdt_setprop(blob, off, "compatible", compat, compat_len); 207 if (err < 0) 208 goto err; 209 210 #ifdef CONFIG_FSL_CORENET 211 liodns[0] = qp_info[i].dliodn; 212 liodns[1] = qp_info[i].fliodn; 213 214 err = fdt_setprop(blob, off, "fsl,liodn", 215 &liodns, sizeof(u32) * 2); 216 if (err < 0) 217 goto err; 218 #endif 219 220 i++; 221 222 err = fdt_qportal(blob, off, i, "crypto@0", FSL_HW_PORTAL_SEC, 223 IS_E_PROCESSOR(get_svr())); 224 if (err < 0) 225 goto err; 226 227 #ifdef CONFIG_FSL_CORENET 228 #ifdef CONFIG_SYS_DPAA_PME 229 err = fdt_qportal(blob, off, i, "pme@0", FSL_HW_PORTAL_PME, 1); 230 if (err < 0) 231 goto err; 232 #else 233 fdt_qportal(blob, off, i, "pme@0", FSL_HW_PORTAL_PME, 0); 234 #endif 235 #endif 236 237 #ifdef CONFIG_SYS_DPAA_FMAN 238 for (j = 0; j < CONFIG_SYS_NUM_FMAN; j++) { 239 char name[] = "fman@0"; 240 241 name[sizeof(name) - 2] = '0' + j; 242 err = fdt_qportal(blob, off, i, name, 243 FSL_HW_PORTAL_FMAN1 + j, 1); 244 if (err < 0) 245 goto err; 246 } 247 #endif 248 #ifdef CONFIG_SYS_DPAA_RMAN 249 err = fdt_qportal(blob, off, i, "rman@0", 250 FSL_HW_PORTAL_RMAN, 1); 251 if (err < 0) 252 goto err; 253 #endif 254 255 err: 256 if (err < 0) { 257 printf("ERROR: unable to create props for %s: %s\n", 258 fdt_get_name(blob, off, NULL), fdt_strerror(err)); 259 return; 260 } 261 262 off = fdt_node_offset_by_compatible(blob, off, "fsl,qman-portal"); 263 } 264 } 265 266 void fdt_fixup_bportals(void *blob) 267 { 268 int off, err; 269 unsigned int maj, min; 270 u32 rev_1 = in_be32(&bman->ip_rev_1); 271 char compat[64]; 272 int compat_len; 273 274 maj = (rev_1 >> 8) & 0xff; 275 min = rev_1 & 0xff; 276 277 compat_len = sprintf(compat, "fsl,bman-portal-%u.%u", maj, min) + 1; 278 compat_len += sprintf(compat + compat_len, "fsl,bman-portal") + 1; 279 280 off = fdt_node_offset_by_compatible(blob, -1, "fsl,bman-portal"); 281 while (off != -FDT_ERR_NOTFOUND) { 282 err = fdt_setprop(blob, off, "compatible", compat, compat_len); 283 if (err < 0) { 284 printf("ERROR: unable to create props for %s: %s\n", 285 fdt_get_name(blob, off, NULL), 286 fdt_strerror(err)); 287 return; 288 } 289 290 off = fdt_node_offset_by_compatible(blob, off, "fsl,bman-portal"); 291 } 292 293 } 294