Conflicts: cmake_targets/tools/build_helper openair1/SCHED/phy_procedures_lte_eNb.c openair2/LAYER2/MAC/eNB_scheduler.c
256 lines
7.9 KiB
C
256 lines
7.9 KiB
C
/*
|
|
* Licensed to the OpenAirInterface (OAI) Software Alliance under one or more
|
|
* contributor license agreements. See the NOTICE file distributed with
|
|
* this work for additional information regarding copyright ownership.
|
|
* The OpenAirInterface Software Alliance licenses this file to You under
|
|
* the OAI Public License, Version 1.0 (the "License"); you may not use this file
|
|
* except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.openairinterface.org/?page_id=698
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*-------------------------------------------------------------------------------
|
|
* For more information about the OpenAirInterface (OAI) Software Alliance:
|
|
* contact@openairinterface.org
|
|
*/
|
|
|
|
#include <pthread.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
|
|
#include <signal.h>
|
|
#include <time.h>
|
|
#include <errno.h>
|
|
|
|
#include "assertions.h"
|
|
#include "intertask_interface.h"
|
|
#include "timer.h"
|
|
#include "log.h"
|
|
#include "queue.h"
|
|
|
|
#if defined (LOG_D) && defined (LOG_E)
|
|
# define TMR_DEBUG(x, args...) LOG_D(TMR, x, ##args)
|
|
# define TMR_ERROR(x, args...) LOG_E(TMR, x, ##args)
|
|
#endif
|
|
|
|
#ifndef TMR_DEBUG
|
|
# define TMR_DEBUG(x, args...) do { fprintf(stdout, "[TMR][D]"x, ##args); } while(0)
|
|
#endif
|
|
#ifndef TMR_ERROR
|
|
# define TMR_ERROR(x, args...) do { fprintf(stdout, "[TMR][E]"x, ##args); } while(0)
|
|
#endif
|
|
|
|
int timer_handle_signal(siginfo_t *info);
|
|
|
|
struct timer_elm_s {
|
|
task_id_t task_id; ///< Task ID which has requested the timer
|
|
int32_t instance; ///< Instance of the task which has requested the timer
|
|
timer_t timer; ///< Unique timer id
|
|
timer_type_t type; ///< Timer type
|
|
void *timer_arg; ///< Optional argument that will be passed when timer expires
|
|
STAILQ_ENTRY(timer_elm_s) entries; ///< Pointer to next element
|
|
};
|
|
|
|
typedef struct timer_desc_s {
|
|
STAILQ_HEAD(timer_list_head, timer_elm_s) timer_queue;
|
|
pthread_mutex_t timer_list_mutex;
|
|
struct timespec timeout;
|
|
} timer_desc_t;
|
|
|
|
static timer_desc_t timer_desc;
|
|
|
|
#define TIMER_SEARCH(vAR, tIMERfIELD, tIMERvALUE, tIMERqUEUE) \
|
|
do { \
|
|
STAILQ_FOREACH(vAR, tIMERqUEUE, entries) { \
|
|
if (((vAR)->tIMERfIELD == tIMERvALUE)) \
|
|
break; \
|
|
} \
|
|
} while(0)
|
|
|
|
int timer_handle_signal(siginfo_t *info)
|
|
{
|
|
struct timer_elm_s *timer_p;
|
|
MessageDef *message_p;
|
|
timer_has_expired_t *timer_expired_p;
|
|
task_id_t task_id;
|
|
int32_t instance;
|
|
|
|
/* Get back pointer to timer list element */
|
|
timer_p = (struct timer_elm_s *)info->si_ptr;
|
|
|
|
// LG: To many traces for msc timer:
|
|
TMR_DEBUG("Timer with id 0x%lx has expired\n", (long)timer_p->timer);
|
|
|
|
task_id = timer_p->task_id;
|
|
instance = timer_p->instance;
|
|
message_p = itti_alloc_new_message(TASK_TIMER, TIMER_HAS_EXPIRED);
|
|
|
|
timer_expired_p = &message_p->ittiMsg.timer_has_expired;
|
|
|
|
timer_expired_p->timer_id = (long)timer_p->timer;
|
|
timer_expired_p->arg = timer_p->timer_arg;
|
|
|
|
/* Timer is a one shot timer, remove it */
|
|
if (timer_p->type == TIMER_ONE_SHOT) {
|
|
// if (timer_delete(timer_p->timer) < 0) {
|
|
// TMR_DEBUG("Failed to delete timer 0x%lx\n", (long)timer_p->timer);
|
|
// }
|
|
// TMR_DEBUG("Removed timer 0x%lx\n", (long)timer_p->timer);
|
|
// pthread_mutex_lock(&timer_desc.timer_list_mutex);
|
|
// STAILQ_REMOVE(&timer_desc.timer_queue, timer_p, timer_elm_s, entries);
|
|
// pthread_mutex_unlock(&timer_desc.timer_list_mutex);
|
|
// free(timer_p);
|
|
// timer_p = NULL;
|
|
if (timer_remove((long)timer_p->timer) != 0) {
|
|
TMR_DEBUG("Failed to delete timer 0x%lx\n", (long)timer_p->timer);
|
|
}
|
|
}
|
|
|
|
/* Notify task of timer expiry */
|
|
if (itti_send_msg_to_task(task_id, instance, message_p) < 0) {
|
|
TMR_DEBUG("Failed to send msg TIMER_HAS_EXPIRED to task %u\n", task_id);
|
|
free(message_p);
|
|
return -1;
|
|
}
|
|
|
|
#if defined(ENB_AGENT_SB_IF)
|
|
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
int timer_setup(
|
|
uint32_t interval_sec,
|
|
uint32_t interval_us,
|
|
task_id_t task_id,
|
|
int32_t instance,
|
|
timer_type_t type,
|
|
void *timer_arg,
|
|
long *timer_id)
|
|
{
|
|
struct sigevent se;
|
|
struct itimerspec its;
|
|
struct timer_elm_s *timer_p;
|
|
timer_t timer;
|
|
|
|
if (timer_id == NULL) {
|
|
return -1;
|
|
}
|
|
|
|
AssertFatal (type < TIMER_TYPE_MAX, "Invalid timer type (%d/%d)!\n", type, TIMER_TYPE_MAX);
|
|
|
|
/* Allocate new timer list element */
|
|
timer_p = malloc(sizeof(struct timer_elm_s));
|
|
|
|
if (timer_p == NULL) {
|
|
TMR_ERROR("Failed to create new timer element\n");
|
|
return -1;
|
|
}
|
|
|
|
memset(&timer, 0, sizeof(timer_t));
|
|
memset(&se, 0, sizeof(struct sigevent));
|
|
|
|
timer_p->task_id = task_id;
|
|
timer_p->instance = instance;
|
|
timer_p->type = type;
|
|
timer_p->timer_arg = timer_arg;
|
|
|
|
/* Setting up alarm */
|
|
/* Set and enable alarm */
|
|
se.sigev_notify = SIGEV_SIGNAL;
|
|
se.sigev_signo = SIGTIMER;
|
|
se.sigev_value.sival_ptr = timer_p;
|
|
|
|
/* At the timer creation, the timer structure will be filled in with timer_id,
|
|
* which is unique for this process. This id is allocated by kernel and the
|
|
* value might be used to distinguish timers.
|
|
*/
|
|
if (timer_create(CLOCK_REALTIME, &se, &timer) < 0) {
|
|
TMR_ERROR("Failed to create timer: (%s:%d)\n", strerror(errno), errno);
|
|
free(timer_p);
|
|
return -1;
|
|
}
|
|
|
|
/* Fill in the first expiration value. */
|
|
its.it_value.tv_sec = interval_sec;
|
|
its.it_value.tv_nsec = interval_us * 1000;
|
|
|
|
if (type == TIMER_PERIODIC) {
|
|
/* Asked for periodic timer. We set the interval time */
|
|
its.it_interval.tv_sec = interval_sec;
|
|
its.it_interval.tv_nsec = interval_us * 1000;
|
|
} else {
|
|
/* Asked for one-shot timer. Do not set the interval field */
|
|
its.it_interval.tv_sec = 0;
|
|
its.it_interval.tv_nsec = 0;
|
|
}
|
|
|
|
timer_settime(timer, 0, &its, NULL);
|
|
/* Simply set the timer_id argument. so it can be used by caller */
|
|
*timer_id = (long)timer;
|
|
TMR_DEBUG("Requesting new %s timer with id 0x%lx that expires within "
|
|
"%d sec and %d usec\n",
|
|
type == TIMER_PERIODIC ? "periodic" : "single shot",
|
|
*timer_id, interval_sec, interval_us);
|
|
|
|
timer_p->timer = timer;
|
|
|
|
/* Lock the queue and insert the timer at the tail */
|
|
pthread_mutex_lock(&timer_desc.timer_list_mutex);
|
|
STAILQ_INSERT_TAIL(&timer_desc.timer_queue, timer_p, entries);
|
|
pthread_mutex_unlock(&timer_desc.timer_list_mutex);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int timer_remove(long timer_id)
|
|
{
|
|
int rc = 0;
|
|
struct timer_elm_s *timer_p;
|
|
|
|
TMR_DEBUG("Removing timer 0x%lx\n", timer_id);
|
|
|
|
pthread_mutex_lock(&timer_desc.timer_list_mutex);
|
|
TIMER_SEARCH(timer_p, timer, ((timer_t)timer_id), &timer_desc.timer_queue);
|
|
|
|
/* We didn't find the timer in list */
|
|
if (timer_p == NULL) {
|
|
pthread_mutex_unlock(&timer_desc.timer_list_mutex);
|
|
TMR_ERROR("Didn't find timer 0x%lx in list\n", timer_id);
|
|
return -1;
|
|
}
|
|
|
|
STAILQ_REMOVE(&timer_desc.timer_queue, timer_p, timer_elm_s, entries);
|
|
pthread_mutex_unlock(&timer_desc.timer_list_mutex);
|
|
|
|
if (timer_delete(timer_p->timer) < 0) {
|
|
TMR_ERROR("Failed to delete timer 0x%lx\n", (long)timer_p->timer);
|
|
rc = -1;
|
|
}
|
|
|
|
free(timer_p);
|
|
timer_p = NULL;
|
|
return rc;
|
|
}
|
|
|
|
int timer_init(void)
|
|
{
|
|
TMR_DEBUG("Initializing TIMER task interface\n");
|
|
|
|
memset(&timer_desc, 0, sizeof(timer_desc_t));
|
|
|
|
STAILQ_INIT(&timer_desc.timer_queue);
|
|
pthread_mutex_init(&timer_desc.timer_list_mutex, NULL);
|
|
|
|
TMR_DEBUG("Initializing TIMER task interface: DONE\n");
|
|
return 0;
|
|
}
|