Provide helper APIs to set and get cpu affinity in ODP threads, and set cpu affinity to the 1st available control cpu for all odp test/validation programs in odp_cunit_common library.
Signed-off-by: Yi He <yi...@linaro.org> --- helper/include/odp/helper/linux.h | 23 ++++++++- helper/linux.c | 54 +++++++++++++++++++++ helper/test/odpthreads.c | 81 +++++++++++++++++++++++++++---- test/validation/common/odp_cunit_common.c | 21 ++++++-- 4 files changed, 165 insertions(+), 14 deletions(-) diff --git a/helper/include/odp/helper/linux.h b/helper/include/odp/helper/linux.h index 2e89833..238bcf8 100644 --- a/helper/include/odp/helper/linux.h +++ b/helper/include/odp/helper/linux.h @@ -122,7 +122,6 @@ int odph_linux_pthread_create(odph_linux_pthread_t *pthread_tbl, */ void odph_linux_pthread_join(odph_linux_pthread_t *thread_tbl, int num); - /** * Fork a process * @@ -200,6 +199,28 @@ int odph_odpthreads_create(odph_odpthread_t *thread_tbl, int odph_odpthreads_join(odph_odpthread_t *thread_tbl); /** + * Set CPU affinity of the current odp thread + * + * CPU affinity determines the CPU core on which the thread is + * eligible to run. + * + * @param cpu The affinity CPU core + * + * @return 0 on success, -1 on failure + */ +int odph_odpthread_setaffinity(const int cpu); + +/** + * Get CPU affinity of the current odp thread + * + * CPU affinity determines the CPU core on which the thread is + * eligible to run. + * + * @return positive cpu ID on success, -1 on failure + */ +int odph_odpthread_getaffinity(void); + +/** * Merge getopt options * * Given two sets of getopt options (each containing possibly both short diff --git a/helper/linux.c b/helper/linux.c index 6366694..8b9dbe8 100644 --- a/helper/linux.c +++ b/helper/linux.c @@ -12,6 +12,7 @@ #include <sys/types.h> #include <sys/wait.h> #include <sys/prctl.h> +#include <sys/syscall.h> #include <stdlib.h> #include <string.h> @@ -492,6 +493,59 @@ int odph_odpthreads_join(odph_odpthread_t *thread_tbl) return (retval < 0) ? retval : terminated; } +/* man gettid() notes: + * Glibc does not provide a wrapper for this system call; + */ +static inline pid_t __gettid(void) +{ + return (pid_t)syscall(SYS_gettid); +} + +int odph_odpthread_setaffinity(const int cpu) +{ + cpu_set_t cpuset; + + CPU_ZERO(&cpuset); + CPU_SET(cpu, &cpuset); + + /* determine main process or pthread based on + * equality of thread and thread group IDs. + */ + if (__gettid() == getpid()) { + return sched_setaffinity( + 0, /* pid zero means calling process */ + sizeof(cpu_set_t), &cpuset); + } + + /* on error, they return a nonzero error number. */ + return (0 == pthread_setaffinity_np( + pthread_self(), sizeof(cpu_set_t), &cpuset)) ? 0 : -1; +} + +int odph_odpthread_getaffinity(void) +{ + int cpu, result; + cpu_set_t cpuset; + + CPU_ZERO(&cpuset); + if (__gettid() == getpid()) { + result = sched_getaffinity( + 0, sizeof(cpu_set_t), &cpuset); + } else { + result = pthread_getaffinity_np( + pthread_self(), sizeof(cpu_set_t), &cpuset); + } + + /* ODP thread mean to run on single CPU core */ + if ((result == 0) && (CPU_COUNT(&cpuset) == 1)) { + for (cpu = 0; cpu < CPU_SETSIZE; cpu++) { + if (CPU_ISSET(cpu, &cpuset)) + return cpu; + } + } + return -1; +} + /* * return the number of elements in an array of getopt options, excluding the * terminating {0,0,0,0} diff --git a/helper/test/odpthreads.c b/helper/test/odpthreads.c index bba4fa5..9d1bd81 100644 --- a/helper/test/odpthreads.c +++ b/helper/test/odpthreads.c @@ -10,17 +10,48 @@ * the option passed to the program (--odph_proc, --odph_thread or both) */ +#include <unistd.h> +#include <stdlib.h> + #include <test_debug.h> #include <odp_api.h> #include <odp/helper/linux.h> #define NUMBER_WORKERS 16 + +/* register odp_term_local/global() calls atexit() */ +static void main_exit(void); + +/* ODP application instance */ +static odp_instance_t odp_instance; + static int worker_fn(void *arg TEST_UNUSED) { + int cpu; + odp_cpumask_t workers; + /* depend on the odp helper to call odp_init_local */ printf("Worker thread on CPU %d\n", odp_cpu_id()); + odp_cpumask_zero(&workers); + odp_cpumask_default_worker(&workers, NUMBER_WORKERS); + + /* verify CPU affinity was already set */ + cpu = odph_odpthread_getaffinity(); + if ((cpu < 0) || !odp_cpumask_isset(&workers, cpu)) { + printf("Worker thread(%d)'s CPU " + "affinity was invalid.\n", odp_cpu_id()); + return EXIT_FAILURE; + } + + /* verify helper API is workable by re-configure the same */ + if (odph_odpthread_setaffinity(cpu) != 0) { + printf("Re-configure worker thread(%d)'s " + "CPU affinity failed.\n", odp_cpu_id()); + return EXIT_FAILURE; + } + /* depend on the odp helper to call odp_term_local */ return 0; @@ -29,28 +60,55 @@ static int worker_fn(void *arg TEST_UNUSED) /* Create additional dataplane opdthreads */ int main(int argc, char *argv[]) { - odp_instance_t instance; odph_odpthread_params_t thr_params; odph_odpthread_t thread_tbl[NUMBER_WORKERS]; odp_cpumask_t cpu_mask; int num_workers; - int cpu; + int cpu, affinity; int ret; char cpumaskstr[ODP_CPUMASK_STR_SIZE]; /* let helper collect its own arguments (e.g. --odph_proc) */ odph_parse_options(argc, argv, NULL, NULL); - if (odp_init_global(&instance, NULL, NULL)) { + if (odp_init_global(&odp_instance, NULL, NULL)) { LOG_ERR("Error: ODP global init failed.\n"); exit(EXIT_FAILURE); } - if (odp_init_local(instance, ODP_THREAD_CONTROL)) { + if (odp_init_local(odp_instance, ODP_THREAD_CONTROL)) { LOG_ERR("Error: ODP local init failed.\n"); exit(EXIT_FAILURE); } + /* register termination callback */ + atexit(main_exit); + + odp_cpumask_zero(&cpu_mask); + /* allocate the 1st available control cpu to main process */ + if (odp_cpumask_default_control(&cpu_mask, 1) != 1) { + LOG_ERR("Allocate main process CPU core failed.\n"); + exit(EXIT_FAILURE); + } + + cpu = odp_cpumask_first(&cpu_mask); + if (odph_odpthread_setaffinity(cpu) != 0) { + LOG_ERR("Set main process affinify to " + "cpu(%d) failed.\n", cpu); + exit(EXIT_FAILURE); + } + + /* read back affinity to verify */ + affinity = odph_odpthread_getaffinity(); + if ((affinity < 0) || (cpu != affinity)) { + LOG_ERR("Verify main process affinity failed: " + "set(%d) read(%d).\n", cpu, affinity); + exit(EXIT_FAILURE); + } + cpu = 0; + affinity = 0; + odp_cpumask_zero(&cpu_mask); + /* discover how many opdthreads this system can support */ num_workers = odp_cpumask_default_worker(&cpu_mask, NUMBER_WORKERS); if (num_workers < NUMBER_WORKERS) { @@ -78,7 +136,7 @@ int main(int argc, char *argv[]) thr_params.start = worker_fn; thr_params.arg = NULL; thr_params.thr_type = ODP_THREAD_WORKER; - thr_params.instance = instance; + thr_params.instance = odp_instance; odph_odpthreads_create(&thread_tbl[0], &cpu_mask, &thr_params); @@ -86,15 +144,18 @@ int main(int argc, char *argv[]) if (ret < 0) exit(EXIT_FAILURE); + return 0; +} + +static void main_exit(void) +{ if (odp_term_local()) { LOG_ERR("Error: ODP local term failed.\n"); - exit(EXIT_FAILURE); + _exit(EXIT_FAILURE); } - if (odp_term_global(instance)) { + if (odp_term_global(odp_instance)) { LOG_ERR("Error: ODP global term failed.\n"); - exit(EXIT_FAILURE); + _exit(EXIT_FAILURE); } - - return 0; } diff --git a/test/validation/common/odp_cunit_common.c b/test/validation/common/odp_cunit_common.c index 7df9aa6..2337c92 100644 --- a/test/validation/common/odp_cunit_common.c +++ b/test/validation/common/odp_cunit_common.c @@ -333,9 +333,24 @@ int odp_cunit_update(odp_suiteinfo_t testsuites[]) int odp_cunit_register(odp_suiteinfo_t testsuites[]) { /* call test executable init hook, if any */ - if (global_init_term.global_init_ptr && - ((*global_init_term.global_init_ptr)(&instance) != 0)) - return -1; + if (global_init_term.global_init_ptr) { + if ((*global_init_term.global_init_ptr)(&instance) == 0) { + /* After ODP initialization, set main thread's + * CPU affinity to the 1st available control CPU core + */ + int cpu = 0; + odp_cpumask_t cpuset; + + odp_cpumask_zero(&cpuset); + if (odp_cpumask_default_control(&cpuset, 1) == 1) { + cpu = odp_cpumask_first(&cpuset); + odph_odpthread_setaffinity(cpu); + } + } else { + /* ODP initialization failed */ + return -1; + } + } CU_set_error_action(CUEA_ABORT); -- 2.7.4 _______________________________________________ lng-odp mailing list lng-odp@lists.linaro.org https://lists.linaro.org/mailman/listinfo/lng-odp