1
2
3
4
5
6
7
8
9
10
11
12
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
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
|
#ifndef __CB_BDK_THREAD_H__
#define __CB_BDK_THREAD_H__
/***********************license start***********************************
* Copyright (c) 2003-2017 Cavium Inc. (support@cavium.com). All rights
* reserved.
*
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions are
* met:
*
* * Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
*
* * Redistributions in binary form must reproduce the above
* copyright notice, this list of conditions and the following
* disclaimer in the documentation and/or other materials provided
* with the distribution.
*
* * Neither the name of Cavium Inc. nor the names of
* its contributors may be used to endorse or promote products
* derived from this software without specific prior written
* permission.
*
* This Software, including technical data, may be subject to U.S. export
* control laws, including the U.S. Export Administration Act and its
* associated regulations, and may be subject to export or import
* regulations in other countries.
*
* TO THE MAXIMUM EXTENT PERMITTED BY LAW, THE SOFTWARE IS PROVIDED "AS IS"
* AND WITH ALL FAULTS AND CAVIUM INC. MAKES NO PROMISES, REPRESENTATIONS OR
* WARRANTIES, EITHER EXPRESS, IMPLIED, STATUTORY, OR OTHERWISE, WITH RESPECT
* TO THE SOFTWARE, INCLUDING ITS CONDITION, ITS CONFORMITY TO ANY
* REPRESENTATION OR DESCRIPTION, OR THE EXISTENCE OF ANY LATENT OR PATENT
* DEFECTS, AND CAVIUM SPECIFICALLY DISCLAIMS ALL IMPLIED (IF ANY) WARRANTIES
* OF TITLE, MERCHANTABILITY, NONINFRINGEMENT, FITNESS FOR A PARTICULAR
* PURPOSE, LACK OF VIRUSES, ACCURACY OR COMPLETENESS, QUIET ENJOYMENT,
* QUIET POSSESSION OR CORRESPONDENCE TO DESCRIPTION. THE ENTIRE RISK
* ARISING OUT OF USE OR PERFORMANCE OF THE SOFTWARE LIES WITH YOU.
***********************license end**************************************/
/**
* @file
*
* Functions for controlling threads.
*
* <hr>$Revision: 49448 $<hr>
*
* @defgroup thread Threading library
* @{
*/
/* Use a larger stack size for main() as it tends to do lots of
extra stuff. For example, DDR init requires a bigger stack */
#define BDK_THREAD_MAIN_STACK_SIZE 16384
#define BDK_THREAD_DEFAULT_STACK_SIZE 8192
typedef void (*bdk_thread_func_t)(int arg, void *arg1);
extern int bdk_thread_initialize(void);
extern void bdk_thread_yield(void);
extern int bdk_thread_create(bdk_node_t node, uint64_t coremask, bdk_thread_func_t func, int arg0, void *arg1, int stack_size);
extern void bdk_thread_destroy(void) __attribute__ ((noreturn));
extern void bdk_thread_first(bdk_thread_func_t func, int arg0, void *arg1, int stack_size) __attribute__ ((noreturn));
/**
* Number of the Core on which the program is currently running.
*
* @return Number of cores
*/
static inline int bdk_get_core_num(void) __attribute__ ((always_inline));
static inline int bdk_get_core_num(void)
{
if (CAVIUM_IS_MODEL(CAVIUM_CN8XXX))
{
int mpidr_el1;
BDK_MRS(MPIDR_EL1, mpidr_el1);
/* Core is 4 bits from AFF0 and rest from AFF1 */
int core_num;
core_num = mpidr_el1 & 0xf;
core_num |= (mpidr_el1 & 0xff00) >> 4;
return core_num;
}
else
{
uint64_t cvm_pn_el1;
BDK_MRS(s3_0_c11_c4_2, cvm_pn_el1);
return cvm_pn_el1 & 0xffff;
}
}
/**
* Return a mask representing this core in a 64bit bitmask
*
* @return
*/
static inline uint64_t bdk_core_to_mask(void) __attribute__ ((always_inline));
static inline uint64_t bdk_core_to_mask(void)
{
return 1ull << bdk_get_core_num();
}
static inline int bdk_is_boot_core(void)
{
const int master = 0x80000000 | (bdk_numa_master() << 16);
int mpidr_el1;
BDK_MRS_NV(MPIDR_EL1, mpidr_el1);
return mpidr_el1 == master;
}
static inline void *bdk_thread_get_id(void) __attribute__ ((always_inline));
static inline void *bdk_thread_get_id(void)
{
uint64_t current;
BDK_MRS_NV(TPIDR_EL3, current);
/* If we haven't started threading yet use the core number. Add one
so the thread id is never zero */
if (!current)
current = bdk_get_core_num() + 1;
return (void*)current;
}
/** @} */
#endif /* !__CB_BDK_THREAD_H__ */
|
