Skip to content

GitLab

Switch branch/tag
Find file Normal viewHistoryPermalink
k3_topology.c 1.81 KB
Newer Older
Benjamin Fair's avatar
ti: k3: common: Implement topology functions    
Benjamin Fair committed
1
2
3
4
5
6
7
8
9
10
11 
/*
 * Copyright (c) 2017-2018, ARM Limited and Contributors. All rights reserved.
 *
 * SPDX-License-Identifier: BSD-3-Clause
 */

#include <platform_def.h>
#include <psci.h>

/* The power domain tree descriptor */
static unsigned char power_domain_tree_desc[] = {
Andrew F. Davis's avatar
ti: k3: common: Add root domain node to platform topology    
Andrew F. Davis committed
12 
	PLATFORM_SYSTEM_COUNT,
Benjamin Fair's avatar
ti: k3: common: Implement topology functions    
Benjamin Fair committed
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71 
	PLATFORM_CLUSTER_COUNT,
	K3_CLUSTER0_CORE_COUNT,
#if K3_CLUSTER1_MSMC_PORT != UNUSED
	K3_CLUSTER1_CORE_COUNT,
#endif /* K3_CLUSTER1_MSMC_PORT != UNUSED */
#if K3_CLUSTER2_MSMC_PORT != UNUSED
	K3_CLUSTER2_CORE_COUNT,
#endif /* K3_CLUSTER2_MSMC_PORT != UNUSED */
#if K3_CLUSTER3_MSMC_PORT != UNUSED
	K3_CLUSTER3_CORE_COUNT,
#endif /* K3_CLUSTER3_MSMC_PORT != UNUSED */
};

const unsigned char *plat_get_power_domain_tree_desc(void)
{
	return power_domain_tree_desc;
}

int plat_core_pos_by_mpidr(u_register_t mpidr)
{
	unsigned int cpu_id;

	mpidr &= MPIDR_AFFINITY_MASK;

	if (mpidr & ~(MPIDR_CLUSTER_MASK | MPIDR_CPU_MASK))
		return -1;

	cpu_id = MPIDR_AFFLVL0_VAL(mpidr);

	switch (MPIDR_AFFLVL1_VAL(mpidr)) {
	case K3_CLUSTER0_MSMC_PORT:
		if (cpu_id < K3_CLUSTER0_CORE_COUNT)
			return cpu_id;
		return -1;
#if K3_CLUSTER1_MSMC_PORT != UNUSED
	case K3_CLUSTER1_MSMC_PORT:
		if (cpu_id < K3_CLUSTER1_CORE_COUNT)
			return K3_CLUSTER0_CORE_COUNT + cpu_id;
		return -1;
#endif /* K3_CLUSTER1_MSMC_PORT != UNUSED */
#if K3_CLUSTER2_MSMC_PORT != UNUSED
	case K3_CLUSTER2_MSMC_PORT:
		if (cpu_id < K3_CLUSTER2_CORE_COUNT)
			return K3_CLUSTER0_CORE_COUNT +
			       K3_CLUSTER1_CORE_COUNT + cpu_id;
		return -1;
#endif /* K3_CLUSTER2_MSMC_PORT != UNUSED */
#if K3_CLUSTER3_MSMC_PORT != UNUSED
	case K3_CLUSTER3_MSMC_PORT:
		if (cpu_id < K3_CLUSTER3_CORE_COUNT)
			return K3_CLUSTER0_CORE_COUNT +
			       K3_CLUSTER1_CORE_COUNT +
			       K3_CLUSTER2_CORE_COUNT + cpu_id;
		return -1;
#endif /* K3_CLUSTER3_MSMC_PORT != UNUSED */
	default:
		return -1;
	}
}