| 1 |
/* |
| 2 |
* Copyright (c) 2021, Arm Limited. All rights reserved. |
| 3 |
* |
| 4 |
* SPDX-License-Identifier: BSD-3-Clause |
| 5 |
*/ |
| 6 |
|
| 7 |
#include <stddef.h> |
| 8 |
#include <stdint.h> |
| 9 |
|
| 10 |
#include <common/debug.h> |
| 11 |
#include <common/fdt_wrappers.h> |
| 12 |
#include <lib/fconf/fconf.h> |
| 13 |
#include <lib/fconf/fconf_mpmm_getter.h> |
| 14 |
#include <libfdt.h> |
| 15 |
|
| 16 |
#include <plat/common/platform.h> |
| 17 |
|
| 18 |
struct fconf_mpmm_config fconf_mpmm_config; |
| 19 |
static struct mpmm_topology fconf_mpmm_topology; |
| 20 |
|
| 21 |
/* |
| 22 |
* Within a `cpu` node, determine support for MPMM via the `supports-mpmm` |
| 23 |
* property. |
| 24 |
* |
| 25 |
* Returns `0` on success, or a negative integer representing an error code. |
| 26 |
*/ |
| 27 |
static int fconf_populate_mpmm_cpu(const void *fdt, int off, uintptr_t mpidr) |
| 28 |
{ |
| 29 |
int ret, len; |
| 30 |
|
| 31 |
int core_pos; |
| 32 |
struct mpmm_core *core; |
| 33 |
|
| 34 |
core_pos = plat_core_pos_by_mpidr(mpidr); |
| 35 |
if (core_pos < 0) { |
| 36 |
return -FDT_ERR_BADVALUE; |
| 37 |
} |
| 38 |
|
| 39 |
core = &fconf_mpmm_topology.cores[core_pos]; |
| 40 |
|
| 41 |
fdt_getprop(fdt, off, "supports-mpmm", &len); |
| 42 |
if (len >= 0) { |
| 43 |
core->supported = true; |
| 44 |
ret = 0; |
| 45 |
} else { |
| 46 |
core->supported = false; |
| 47 |
ret = len; |
| 48 |
} |
| 49 |
|
| 50 |
return ret; |
| 51 |
} |
| 52 |
|
| 53 |
/* |
| 54 |
* Populates the global `fconf_mpmm_config` structure based on what's described |
| 55 |
* by the hardware configuration device tree blob. |
| 56 |
* |
| 57 |
* The device tree is expected to provide a `supports-mpmm` property for each |
| 58 |
* `cpu` node, like so: |
| 59 |
* |
| 60 |
* cpu@0 { |
| 61 |
* supports-mpmm; |
| 62 |
* }; |
| 63 |
* |
| 64 |
* This property indicates whether the core implements MPMM, as we cannot detect |
| 65 |
* support for it dynamically. |
| 66 |
*/ |
| 67 |
static int fconf_populate_mpmm(uintptr_t config) |
| 68 |
{ |
| 69 |
int ret = fdtw_for_each_cpu( |
| 70 |
(const void *)config, fconf_populate_mpmm_cpu); |
| 71 |
if (ret == 0) { |
| 72 |
fconf_mpmm_config.topology = &fconf_mpmm_topology; |
| 73 |
} else { |
| 74 |
ERROR("FCONF: failed to configure MPMM: %d\n", ret); |
| 75 |
} |
| 76 |
|
| 77 |
return ret; |
| 78 |
} |
| 79 |
|
| 80 |
FCONF_REGISTER_POPULATOR(HW_CONFIG, mpmm, fconf_populate_mpmm); |