| /* Copied from tbf.cpp |
| * |
| * Copyright (C) 2012 Ivan Klyuchnikov |
| * Copyright (C) 2012 Andreas Eversberg <jolly@eversberg.eu> |
| * Copyright (C) 2013 by Holger Hans Peter Freyther |
| * |
| * This program 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 2 |
| * of the License, or (at your option) any later version. |
| * |
| * This program 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 this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. |
| */ |
| |
| #include <tbf.h> |
| #include <bts.h> |
| |
| #include <stdio.h> |
| |
| extern "C" { |
| #include <osmocom/core/msgb.h> |
| } |
| |
| /* reset LLC frame */ |
| void gprs_llc::reset() |
| { |
| index = 0; |
| length = 0; |
| } |
| |
| void gprs_llc::reset_frame_space() |
| { |
| index = 0; |
| } |
| |
| void gprs_llc::enqueue(struct msgb *llc_msg) |
| { |
| msgb_enqueue(&queue, llc_msg); |
| } |
| |
| void gprs_llc::put_frame(const uint8_t *data, size_t len) |
| { |
| /* only put frames when we are empty */ |
| OSMO_ASSERT(index == 0 && length == 0); |
| |
| /* TODO: bounds check */ |
| memcpy(frame, data, len); |
| length = len; |
| } |
| |
| void gprs_llc::clear(BTS *bts) |
| { |
| struct msgb *msg; |
| |
| while ((msg = msgb_dequeue(&queue))) { |
| bts->dropped_frame(); |
| msgb_free(msg); |
| } |
| } |
| |
| void gprs_llc::init() |
| { |
| INIT_LLIST_HEAD(&queue); |
| } |
| |
| struct msgb *gprs_llc::dequeue() |
| { |
| return msgb_dequeue(&queue); |
| } |
| |
| |
| void gprs_llc::calc_pdu_lifetime(BTS *bts, const uint16_t pdu_delay_csec, struct timeval *tv) |
| { |
| uint16_t delay_csec; |
| if (bts->bts_data()->force_llc_lifetime) |
| delay_csec = bts->bts_data()->force_llc_lifetime; |
| else |
| delay_csec = pdu_delay_csec; |
| |
| /* keep timestap at 0 for infinite delay */ |
| if (delay_csec != 0xffff) { |
| /* calculate timestamp of timeout */ |
| gettimeofday(tv, NULL); |
| tv->tv_usec += (delay_csec % 100) * 10000; |
| tv->tv_sec += delay_csec / 100; |
| if (tv->tv_usec > 999999) { |
| tv->tv_usec -= 1000000; |
| tv->tv_sec++; |
| } |
| } |
| } |