Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 1 | /* |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 2 | * Copyright 2008-2011 Freescale Semiconductor, Inc. |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 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 | |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 33 | static ccsr_qman_t *qman = (void *)CONFIG_SYS_FSL_QMAN_ADDR; |
Haiying Wang | 2a0ffb8 | 2011-03-01 09:30:07 -0500 | [diff] [blame] | 34 | static ccsr_bman_t *bman = (void *)CONFIG_SYS_FSL_BMAN_ADDR; |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 35 | |
| 36 | void setup_portals(void) |
| 37 | { |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 38 | #ifdef CONFIG_FSL_CORENET |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 39 | int i; |
| 40 | |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 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 | } |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 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); |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 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 | { |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 124 | int childoff, dev_off, ret = 0; |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 125 | uint32_t dev_handle; |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 126 | #ifdef CONFIG_FSL_CORENET |
| 127 | int num; |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 128 | u32 liodns[2]; |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 129 | #endif |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 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); |
Kumar Gala | f117c0f | 2011-08-01 00:23:23 -0500 | [diff] [blame] | 154 | ret = fdt_set_phandle(blob, dev_off, |
Timur Tabi | e4e7e42 | 2011-05-10 15:28:14 -0500 | [diff] [blame] | 155 | dev_handle); |
| 156 | if (ret < 0) |
| 157 | return ret; |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 158 | } |
| 159 | |
| 160 | ret = fdt_setprop(blob, childoff, "dev-handle", |
| 161 | &dev_handle, sizeof(dev_handle)); |
| 162 | if (ret < 0) |
| 163 | return ret; |
| 164 | |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 165 | #ifdef CONFIG_FSL_CORENET |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 166 | num = get_dpaa_liodn(dev, &liodns[0], id); |
| 167 | ret = fdt_setprop(blob, childoff, "fsl,liodn", |
| 168 | &liodns[0], sizeof(u32) * num); |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 169 | #endif |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 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) { |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 197 | #ifdef CONFIG_FSL_CORENET |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 198 | u32 liodns[2]; |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 199 | #endif |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 200 | const int *ci = fdt_getprop(blob, off, "cell-index", NULL); |
Kumar Gala | e2d0f25 | 2011-07-31 12:55:39 -0500 | [diff] [blame] | 201 | int i = *ci; |
| 202 | #ifdef CONFIG_SYS_DPAA_FMAN |
| 203 | int j; |
| 204 | #endif |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 205 | |
| 206 | err = fdt_setprop(blob, off, "compatible", compat, compat_len); |
| 207 | if (err < 0) |
| 208 | goto err; |
| 209 | |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 210 | #ifdef CONFIG_FSL_CORENET |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 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; |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 218 | #endif |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 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 | |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 227 | #ifdef CONFIG_FSL_CORENET |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 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 |
Haiying Wang | 24995d8 | 2011-01-20 22:26:31 +0000 | [diff] [blame] | 235 | #endif |
| 236 | |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 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 |
Kumar Gala | 4d28db8 | 2011-10-14 13:28:52 -0500 | [diff] [blame] | 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 |
Kumar Gala | db977ab | 2009-09-10 03:02:13 -0500 | [diff] [blame] | 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 | } |
Haiying Wang | 2a0ffb8 | 2011-03-01 09:30:07 -0500 | [diff] [blame] | 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 | } |