gauthier
c7518ecf42
git-svn-id: http://svn.eurecom.fr/openair4G/trunk@7885 818b1a75-f10b-46b9-bf7c-635c3b92a50f
256 lines
7.4 KiB
C
256 lines
7.4 KiB
C
/*******************************************************************************
|
|
OpenAirInterface
|
|
Copyright(c) 1999 - 2014 Eurecom
|
|
|
|
OpenAirInterface is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
|
|
OpenAirInterface is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with OpenAirInterface.The full GNU General Public License is
|
|
included in this distribution in the file called "COPYING". If not,
|
|
see <http://www.gnu.org/licenses/>.
|
|
|
|
Contact Information
|
|
OpenAirInterface Admin: openair_admin@eurecom.fr
|
|
OpenAirInterface Tech : openair_tech@eurecom.fr
|
|
OpenAirInterface Dev : openair4g-devel@lists.eurecom.fr
|
|
|
|
Address : Eurecom, Campus SophiaTech, 450 Route des Chappes, CS 50193 - 06904 Biot Sophia Antipolis cedex, FRANCE
|
|
|
|
*******************************************************************************/
|
|
|
|
/*! \file sched_ulsch.c
|
|
* \brief ULSCH decoding thread (RTAI)
|
|
* \author R. Knopp, F. Kaltenberger
|
|
* \date 2011
|
|
* \version 0.1
|
|
* \company Eurecom
|
|
* \email: knopp@eurecom.fr,florian.kaltenberger@eurecom.fr
|
|
* \note
|
|
* \warning
|
|
*/
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <sched.h>
|
|
|
|
#include "rt_wrapper.h"
|
|
|
|
#include <sys/mman.h>
|
|
|
|
#include "PHY/types.h"
|
|
#include "PHY/defs.h"
|
|
#include "PHY/extern.h"
|
|
|
|
#include "SCHED/defs.h"
|
|
|
|
#include "MAC_INTERFACE/extern.h"
|
|
|
|
#ifdef CBMIMO1
|
|
#include "ARCH/CBMIMO1/DEVICE_DRIVER/cbmimo1_device.h"
|
|
#include "ARCH/CBMIMO1/DEVICE_DRIVER/extern.h"
|
|
#include "ARCH/CBMIMO1/DEVICE_DRIVER/defs.h"
|
|
#endif // CBMIMO1
|
|
|
|
|
|
|
|
#define DEBUG_PHY
|
|
|
|
/// Mutex for instance count on ulsch scheduling
|
|
pthread_mutex_t ulsch_mutex[NUMBER_OF_UE_MAX];
|
|
/// Condition variable for ulsch thread
|
|
pthread_cond_t ulsch_cond[NUMBER_OF_UE_MAX];
|
|
|
|
pthread_t ulsch_threads[NUMBER_OF_UE_MAX];
|
|
pthread_attr_t attr_ulsch_threads;
|
|
|
|
// activity indicators for harq_pid's
|
|
int ulsch_instance_cnt[NUMBER_OF_UE_MAX];
|
|
// process ids for cpu
|
|
int ulsch_cpuid[NUMBER_OF_UE_MAX];
|
|
// subframe number for each harq_pid (needed to store ack in right place for UL)
|
|
int ulsch_subframe[NUMBER_OF_UE_MAX];
|
|
|
|
extern int oai_exit;
|
|
|
|
/*
|
|
extern int ulsch_errors;
|
|
extern int ulsch_received;
|
|
extern int ulsch_errors_last;
|
|
extern int ulsch_received_last;
|
|
extern int ulsch_fer;
|
|
extern int current_ulsch_cqi;
|
|
*/
|
|
|
|
/** ULSCH Decoding Thread */
|
|
static void * ulsch_thread(void *param)
|
|
{
|
|
|
|
//unsigned long cpuid;
|
|
unsigned int ulsch_thread_index = (unsigned int)param;
|
|
|
|
RTIME time_in,time_out;
|
|
#ifdef RTAI
|
|
RT_TASK *task;
|
|
char ulsch_thread_name[64];
|
|
#endif
|
|
|
|
int eNB_id = 0, UE_id = 0;
|
|
PHY_VARS_eNB *phy_vars_eNB = PHY_vars_eNB_g[eNB_id];
|
|
|
|
if ((ulsch_thread_index <0) || (ulsch_thread_index>NUMBER_OF_UE_MAX)) {
|
|
LOG_E(PHY,"[SCHED][ULSCH] Illegal ulsch_thread_index %d!!!!\n",ulsch_thread_index);
|
|
return 0;
|
|
}
|
|
|
|
#ifdef RTAI
|
|
sprintf(ulsch_thread_name,"ULSCH_THREAD%d",ulsch_thread_index);
|
|
|
|
LOG_I(PHY,"[SCHED][ULSCH] starting ulsch_thread %s for process %d\n",
|
|
ulsch_thread_name,
|
|
ulsch_thread_index);
|
|
|
|
task = rt_task_init_schmod(nam2num(ulsch_thread_name), 0, 0, 0, SCHED_FIFO, 0xF);
|
|
|
|
if (task==NULL) {
|
|
LOG_E(PHY,"[SCHED][ULSCH] Problem starting ulsch_thread_index %d!!!!\n",ulsch_thread_index);
|
|
return 0;
|
|
} else {
|
|
LOG_I(PHY,"[SCHED][ULSCH] ulsch_thread for process %d started with id %p\n",
|
|
ulsch_thread_index,
|
|
task);
|
|
}
|
|
|
|
#endif
|
|
|
|
mlockall(MCL_CURRENT | MCL_FUTURE);
|
|
|
|
//rt_set_runnable_on_cpuid(task,1);
|
|
//cpuid = rtai_cpuid();
|
|
|
|
#ifdef HARD_RT
|
|
rt_make_hard_real_time();
|
|
#endif
|
|
|
|
//ulsch_cpuid[ulsch_thread_index] = cpuid;
|
|
|
|
while (!oai_exit) {
|
|
|
|
if (pthread_mutex_lock(&ulsch_mutex[ulsch_thread_index]) != 0) {
|
|
LOG_E(PHY,"[SCHED][ULSCH] error locking mutex.\n");
|
|
} else {
|
|
|
|
while (ulsch_instance_cnt[ulsch_thread_index] < 0) {
|
|
pthread_cond_wait(&ulsch_cond[ulsch_thread_index],&ulsch_mutex[ulsch_thread_index]);
|
|
}
|
|
|
|
if (pthread_mutex_unlock(&ulsch_mutex[ulsch_thread_index]) != 0) {
|
|
LOG_E(PHY,"[SCHED][ULSCH] error unlocking mutex.\n");
|
|
}
|
|
}
|
|
|
|
if (oai_exit) break;
|
|
|
|
LOG_D(PHY,"[SCHED][ULSCH] Frame %d: Calling ulsch_decoding with ulsch_thread_index = %d\n",phy_vars_eNB->proc[0].frame_tx,ulsch_thread_index);
|
|
|
|
time_in = rt_get_time_ns();
|
|
|
|
ulsch_decoding_procedures(ulsch_subframe[ulsch_thread_index]<<1,ulsch_thread_index,phy_vars_eNB,0);
|
|
|
|
time_out = rt_get_time_ns();
|
|
|
|
if (pthread_mutex_lock(&ulsch_mutex[ulsch_thread_index]) != 0) {
|
|
msg("[openair][SCHED][ULSCH] error locking mutex.\n");
|
|
} else {
|
|
ulsch_instance_cnt[ulsch_thread_index]--;
|
|
|
|
if (pthread_mutex_unlock(&ulsch_mutex[ulsch_thread_index]) != 0) {
|
|
msg("[openair][SCHED][ULSCH] error unlocking mutex.\n");
|
|
}
|
|
}
|
|
}
|
|
|
|
#ifdef HARD_RT
|
|
rt_make_soft_real_time();
|
|
#endif
|
|
|
|
msg("[openair][SCHED][ULSCH] ULSCH thread %d exiting\n",ulsch_thread_index);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int init_ulsch_threads(void)
|
|
{
|
|
|
|
int error_code, return_code=0;
|
|
struct sched_param p;
|
|
int ulsch_thread_index;
|
|
|
|
// later loop on all harq_pids, do 0 for now
|
|
for (ulsch_thread_index=0; ulsch_thread_index<NUMBER_OF_UE_MAX; ulsch_thread_index++) {
|
|
|
|
pthread_mutex_init(&ulsch_mutex[ulsch_thread_index],NULL);
|
|
|
|
pthread_cond_init(&ulsch_cond[ulsch_thread_index],NULL);
|
|
|
|
pthread_attr_init (&attr_ulsch_threads);
|
|
pthread_attr_setstacksize(&attr_ulsch_threads,OPENAIR_THREAD_STACK_SIZE);
|
|
|
|
//attr_ulsch_threads.priority = 1;
|
|
|
|
p.sched_priority = OPENAIR_THREAD_PRIORITY;
|
|
pthread_attr_setschedparam (&attr_ulsch_threads, &p);
|
|
#ifndef RTAI_ISNT_POSIX
|
|
pthread_attr_setschedpolicy (&attr_ulsch_threads, SCHED_FIFO);
|
|
#endif
|
|
|
|
ulsch_instance_cnt[ulsch_thread_index] = -1;
|
|
rt_printk("[openair][SCHED][ULSCH][INIT] Allocating ULSCH thread for ulsch_thread_index %d\n",ulsch_thread_index);
|
|
error_code = pthread_create(&ulsch_threads[ulsch_thread_index],
|
|
&attr_ulsch_threads,
|
|
ulsch_thread,
|
|
(void *)ulsch_thread_index);
|
|
|
|
if (error_code!= 0) {
|
|
rt_printk("[openair][SCHED][ULSCH][INIT] Could not allocate ulsch_thread %d, error %d\n",ulsch_thread_index,error_code);
|
|
return_code+=error_code;
|
|
//return(error_code);
|
|
} else {
|
|
rt_printk("[openair][SCHED][ULSCH][INIT] Allocate ulsch_thread %d successful\n",ulsch_thread_index);
|
|
//return(0);
|
|
}
|
|
}
|
|
|
|
return(return_code);
|
|
}
|
|
|
|
void cleanup_ulsch_threads(void)
|
|
{
|
|
|
|
int ulsch_thread_index;
|
|
|
|
for (ulsch_thread_index=0; ulsch_thread_index<NUMBER_OF_UE_MAX; ulsch_thread_index++) {
|
|
|
|
// pthread_exit(&ulsch_threads[ulsch_thread_index]);
|
|
rt_printk("[openair][SCHED][ULSCH] Scheduling ulsch_thread %d to exit\n",ulsch_thread_index);
|
|
|
|
ulsch_instance_cnt[ulsch_thread_index] = 0;
|
|
|
|
if (pthread_cond_signal(&ulsch_cond[ulsch_thread_index]) != 0)
|
|
rt_printk("[openair][SCHED][ULSCH] ERROR pthread_cond_signal\n");
|
|
else
|
|
rt_printk("[openair][SCHED][ULSCH] Signalled ulsch_thread %d to exit\n",ulsch_thread_index);
|
|
|
|
rt_printk("[openair][SCHED][ULSCH] Exiting ...\n");
|
|
pthread_cond_destroy(&ulsch_cond[ulsch_thread_index]);
|
|
pthread_mutex_destroy(&ulsch_mutex[ulsch_thread_index]);
|
|
}
|
|
}
|