1*a97c2a1fSXin Li /******************************************************************************
2*a97c2a1fSXin Li *
3*a97c2a1fSXin Li * Copyright (C) 2015 The Android Open Source Project
4*a97c2a1fSXin Li *
5*a97c2a1fSXin Li * Licensed under the Apache License, Version 2.0 (the "License");
6*a97c2a1fSXin Li * you may not use this file except in compliance with the License.
7*a97c2a1fSXin Li * You may obtain a copy of the License at:
8*a97c2a1fSXin Li *
9*a97c2a1fSXin Li * http://www.apache.org/licenses/LICENSE-2.0
10*a97c2a1fSXin Li *
11*a97c2a1fSXin Li * Unless required by applicable law or agreed to in writing, software
12*a97c2a1fSXin Li * distributed under the License is distributed on an "AS IS" BASIS,
13*a97c2a1fSXin Li * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14*a97c2a1fSXin Li * See the License for the specific language governing permissions and
15*a97c2a1fSXin Li * limitations under the License.
16*a97c2a1fSXin Li *
17*a97c2a1fSXin Li *****************************************************************************
18*a97c2a1fSXin Li * Originally developed and contributed by Ittiam Systems Pvt. Ltd, Bangalore
19*a97c2a1fSXin Li */
20*a97c2a1fSXin Li /*****************************************************************************/
21*a97c2a1fSXin Li /* */
22*a97c2a1fSXin Li /* File Name : ithread.c */
23*a97c2a1fSXin Li /* */
24*a97c2a1fSXin Li /* Description : Contains abstraction for threads, mutex and semaphores*/
25*a97c2a1fSXin Li /* */
26*a97c2a1fSXin Li /* List of Functions : */
27*a97c2a1fSXin Li /* */
28*a97c2a1fSXin Li /* Issues / Problems : None */
29*a97c2a1fSXin Li /* */
30*a97c2a1fSXin Li /* Revision History : */
31*a97c2a1fSXin Li /* */
32*a97c2a1fSXin Li /* DD MM YYYY Author(s) Changes */
33*a97c2a1fSXin Li /* 07 09 2012 Harish Initial Version */
34*a97c2a1fSXin Li /*****************************************************************************/
35*a97c2a1fSXin Li /*****************************************************************************/
36*a97c2a1fSXin Li /* File Includes */
37*a97c2a1fSXin Li /*****************************************************************************/
38*a97c2a1fSXin Li #include <string.h>
39*a97c2a1fSXin Li #include "iv_datatypedef.h"
40*a97c2a1fSXin Li #include "ithread.h"
41*a97c2a1fSXin Li #include <sys/types.h>
42*a97c2a1fSXin Li
43*a97c2a1fSXin Li //#define PTHREAD_AFFINITY
44*a97c2a1fSXin Li //#define SYSCALL_AFFINITY
45*a97c2a1fSXin Li
46*a97c2a1fSXin Li #ifdef PTHREAD_AFFINITY
47*a97c2a1fSXin Li #define _GNU_SOURCE
48*a97c2a1fSXin Li #define __USE_GNU
49*a97c2a1fSXin Li #endif
50*a97c2a1fSXin Li
51*a97c2a1fSXin Li #include <pthread.h>
52*a97c2a1fSXin Li #include <sched.h>
53*a97c2a1fSXin Li #include <semaphore.h>
54*a97c2a1fSXin Li #include <unistd.h>
55*a97c2a1fSXin Li
56*a97c2a1fSXin Li #ifdef SYSCALL_AFFINITY
57*a97c2a1fSXin Li #include <sys/syscall.h>
58*a97c2a1fSXin Li #endif
59*a97c2a1fSXin Li
ithread_get_handle_size(void)60*a97c2a1fSXin Li UWORD32 ithread_get_handle_size(void)
61*a97c2a1fSXin Li {
62*a97c2a1fSXin Li return sizeof(pthread_t);
63*a97c2a1fSXin Li }
64*a97c2a1fSXin Li
ithread_get_mutex_lock_size(void)65*a97c2a1fSXin Li UWORD32 ithread_get_mutex_lock_size(void)
66*a97c2a1fSXin Li {
67*a97c2a1fSXin Li return sizeof(pthread_mutex_t);
68*a97c2a1fSXin Li }
69*a97c2a1fSXin Li
ithread_create(void * thread_handle,void * attribute,void * strt,void * argument)70*a97c2a1fSXin Li WORD32 ithread_create(void *thread_handle, void *attribute, void *strt, void *argument)
71*a97c2a1fSXin Li {
72*a97c2a1fSXin Li ((void)(attribute));
73*a97c2a1fSXin Li return pthread_create((pthread_t *)thread_handle, NULL,(void *(*)(void *)) strt, argument);
74*a97c2a1fSXin Li }
75*a97c2a1fSXin Li
ithread_join(void * thread_handle,void ** val_ptr)76*a97c2a1fSXin Li WORD32 ithread_join(void *thread_handle, void ** val_ptr)
77*a97c2a1fSXin Li {
78*a97c2a1fSXin Li pthread_t *pthread_handle = (pthread_t *)thread_handle;
79*a97c2a1fSXin Li ((void)(val_ptr));
80*a97c2a1fSXin Li return pthread_join(*pthread_handle, NULL);
81*a97c2a1fSXin Li }
82*a97c2a1fSXin Li
ithread_exit(void * val_ptr)83*a97c2a1fSXin Li void ithread_exit(void *val_ptr)
84*a97c2a1fSXin Li {
85*a97c2a1fSXin Li return pthread_exit(val_ptr);
86*a97c2a1fSXin Li }
87*a97c2a1fSXin Li
ithread_get_mutex_struct_size(void)88*a97c2a1fSXin Li WORD32 ithread_get_mutex_struct_size(void)
89*a97c2a1fSXin Li {
90*a97c2a1fSXin Li return(sizeof(pthread_mutex_t));
91*a97c2a1fSXin Li }
ithread_mutex_init(void * mutex)92*a97c2a1fSXin Li WORD32 ithread_mutex_init(void *mutex)
93*a97c2a1fSXin Li {
94*a97c2a1fSXin Li return pthread_mutex_init((pthread_mutex_t *) mutex, NULL);
95*a97c2a1fSXin Li }
96*a97c2a1fSXin Li
ithread_mutex_destroy(void * mutex)97*a97c2a1fSXin Li WORD32 ithread_mutex_destroy(void *mutex)
98*a97c2a1fSXin Li {
99*a97c2a1fSXin Li return pthread_mutex_destroy((pthread_mutex_t *) mutex);
100*a97c2a1fSXin Li }
101*a97c2a1fSXin Li
ithread_mutex_lock(void * mutex)102*a97c2a1fSXin Li WORD32 ithread_mutex_lock(void *mutex)
103*a97c2a1fSXin Li {
104*a97c2a1fSXin Li return pthread_mutex_lock((pthread_mutex_t *)mutex);
105*a97c2a1fSXin Li }
106*a97c2a1fSXin Li
ithread_mutex_unlock(void * mutex)107*a97c2a1fSXin Li WORD32 ithread_mutex_unlock(void *mutex)
108*a97c2a1fSXin Li {
109*a97c2a1fSXin Li return pthread_mutex_unlock((pthread_mutex_t *)mutex);
110*a97c2a1fSXin Li }
111*a97c2a1fSXin Li
ithread_yield(void)112*a97c2a1fSXin Li void ithread_yield(void)
113*a97c2a1fSXin Li {
114*a97c2a1fSXin Li sched_yield();
115*a97c2a1fSXin Li }
116*a97c2a1fSXin Li
ithread_sleep(UWORD32 u4_time)117*a97c2a1fSXin Li void ithread_sleep(UWORD32 u4_time)
118*a97c2a1fSXin Li {
119*a97c2a1fSXin Li usleep(u4_time * 1000 * 1000);
120*a97c2a1fSXin Li }
121*a97c2a1fSXin Li
ithread_msleep(UWORD32 u4_time_ms)122*a97c2a1fSXin Li void ithread_msleep(UWORD32 u4_time_ms)
123*a97c2a1fSXin Li {
124*a97c2a1fSXin Li usleep(u4_time_ms * 1000);
125*a97c2a1fSXin Li }
126*a97c2a1fSXin Li
ithread_usleep(UWORD32 u4_time_us)127*a97c2a1fSXin Li void ithread_usleep(UWORD32 u4_time_us)
128*a97c2a1fSXin Li {
129*a97c2a1fSXin Li usleep(u4_time_us);
130*a97c2a1fSXin Li }
131*a97c2a1fSXin Li
ithread_get_sem_struct_size(void)132*a97c2a1fSXin Li UWORD32 ithread_get_sem_struct_size(void)
133*a97c2a1fSXin Li {
134*a97c2a1fSXin Li return(sizeof(sem_t));
135*a97c2a1fSXin Li }
136*a97c2a1fSXin Li
ithread_sem_init(void * sem,WORD32 pshared,UWORD32 value)137*a97c2a1fSXin Li WORD32 ithread_sem_init(void *sem,WORD32 pshared,UWORD32 value)
138*a97c2a1fSXin Li {
139*a97c2a1fSXin Li return sem_init((sem_t *)sem,pshared,value);
140*a97c2a1fSXin Li }
141*a97c2a1fSXin Li
ithread_sem_post(void * sem)142*a97c2a1fSXin Li WORD32 ithread_sem_post(void *sem)
143*a97c2a1fSXin Li {
144*a97c2a1fSXin Li return sem_post((sem_t *)sem);
145*a97c2a1fSXin Li }
146*a97c2a1fSXin Li
ithread_sem_wait(void * sem)147*a97c2a1fSXin Li WORD32 ithread_sem_wait(void *sem)
148*a97c2a1fSXin Li {
149*a97c2a1fSXin Li return sem_wait((sem_t *)sem);
150*a97c2a1fSXin Li }
151*a97c2a1fSXin Li
ithread_sem_destroy(void * sem)152*a97c2a1fSXin Li WORD32 ithread_sem_destroy(void *sem)
153*a97c2a1fSXin Li {
154*a97c2a1fSXin Li return sem_destroy((sem_t *)sem);
155*a97c2a1fSXin Li }
156*a97c2a1fSXin Li
ithread_set_affinity(WORD32 core_id)157*a97c2a1fSXin Li WORD32 ithread_set_affinity(WORD32 core_id)
158*a97c2a1fSXin Li {
159*a97c2a1fSXin Li #ifdef PTHREAD_AFFINITY
160*a97c2a1fSXin Li cpu_set_t cpuset;
161*a97c2a1fSXin Li int num_cores = sysconf(_SC_NPROCESSORS_ONLN);
162*a97c2a1fSXin Li pthread_t cur_thread = pthread_self();
163*a97c2a1fSXin Li
164*a97c2a1fSXin Li if (core_id >= num_cores)
165*a97c2a1fSXin Li return -1;
166*a97c2a1fSXin Li
167*a97c2a1fSXin Li CPU_ZERO(&cpuset);
168*a97c2a1fSXin Li CPU_SET(core_id, &cpuset);
169*a97c2a1fSXin Li
170*a97c2a1fSXin Li return pthread_setaffinity_np(cur_thread, sizeof(cpu_set_t), &cpuset);
171*a97c2a1fSXin Li
172*a97c2a1fSXin Li #elif SYSCALL_AFFINITY
173*a97c2a1fSXin Li WORD32 i4_sys_res;
174*a97c2a1fSXin Li
175*a97c2a1fSXin Li pid_t pid = gettid();
176*a97c2a1fSXin Li
177*a97c2a1fSXin Li
178*a97c2a1fSXin Li i4_sys_res = syscall(__NR_sched_setaffinity, pid, sizeof(i4_mask), &i4_mask);
179*a97c2a1fSXin Li if (i4_sys_res)
180*a97c2a1fSXin Li {
181*a97c2a1fSXin Li //WORD32 err;
182*a97c2a1fSXin Li //err = errno;
183*a97c2a1fSXin Li //perror("Error in setaffinity syscall PERROR : ");
184*a97c2a1fSXin Li //LOG_ERROR("Error in the syscall setaffinity: mask=0x%x err=0x%x", i4_mask, i4_sys_res);
185*a97c2a1fSXin Li return -1;
186*a97c2a1fSXin Li }
187*a97c2a1fSXin Li #endif
188*a97c2a1fSXin Li ((void)(core_id));
189*a97c2a1fSXin Li return 1;
190*a97c2a1fSXin Li
191*a97c2a1fSXin Li }
192*a97c2a1fSXin Li
ithread_get_cond_struct_size(void)193*a97c2a1fSXin Li WORD32 ithread_get_cond_struct_size(void)
194*a97c2a1fSXin Li {
195*a97c2a1fSXin Li return (sizeof(pthread_cond_t));
196*a97c2a1fSXin Li }
197*a97c2a1fSXin Li
ithread_cond_init(void * cond)198*a97c2a1fSXin Li WORD32 ithread_cond_init(void *cond)
199*a97c2a1fSXin Li {
200*a97c2a1fSXin Li return pthread_cond_init((pthread_cond_t *)cond, NULL);
201*a97c2a1fSXin Li }
202*a97c2a1fSXin Li
ithread_cond_destroy(void * cond)203*a97c2a1fSXin Li WORD32 ithread_cond_destroy(void *cond)
204*a97c2a1fSXin Li {
205*a97c2a1fSXin Li return pthread_cond_destroy((pthread_cond_t *)cond);
206*a97c2a1fSXin Li }
207*a97c2a1fSXin Li
ithread_cond_wait(void * cond,void * mutex)208*a97c2a1fSXin Li WORD32 ithread_cond_wait(void *cond, void *mutex)
209*a97c2a1fSXin Li {
210*a97c2a1fSXin Li return pthread_cond_wait((pthread_cond_t *)cond, (pthread_mutex_t *)mutex);
211*a97c2a1fSXin Li }
212*a97c2a1fSXin Li
ithread_cond_signal(void * cond)213*a97c2a1fSXin Li WORD32 ithread_cond_signal(void *cond)
214*a97c2a1fSXin Li {
215*a97c2a1fSXin Li return pthread_cond_signal((pthread_cond_t *)cond);
216*a97c2a1fSXin Li }
217