| /* |
| * tc_core.c TC core library. |
| * |
| * 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. |
| * |
| * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru> |
| * |
| */ |
| |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <unistd.h> |
| #include <syslog.h> |
| #include <fcntl.h> |
| #include <math.h> |
| #include <sys/socket.h> |
| #include <netinet/in.h> |
| #include <arpa/inet.h> |
| #include <string.h> |
| |
| #include "tc_core.h" |
| |
| static __u32 t2us=1; |
| static __u32 us2t=1; |
| static double tick_in_usec = 1; |
| |
| long tc_core_usec2tick(long usec) |
| { |
| return usec*tick_in_usec; |
| } |
| |
| long tc_core_tick2usec(long tick) |
| { |
| return tick/tick_in_usec; |
| } |
| |
| unsigned tc_calc_xmittime(unsigned rate, unsigned size) |
| { |
| return tc_core_usec2tick(1000000*((double)size/rate)); |
| } |
| |
| /* |
| rtab[pkt_len>>cell_log] = pkt_xmit_time |
| */ |
| |
| int tc_calc_rtable(unsigned bps, __u32 *rtab, int cell_log, unsigned mtu, |
| unsigned mpu) |
| { |
| int i; |
| unsigned overhead = (mpu >> 8) & 0xFF; |
| mpu = mpu & 0xFF; |
| |
| if (mtu == 0) |
| mtu = 2047; |
| |
| if (cell_log < 0) { |
| cell_log = 0; |
| while ((mtu>>cell_log) > 255) |
| cell_log++; |
| } |
| for (i=0; i<256; i++) { |
| unsigned sz = (i<<cell_log); |
| if (overhead) |
| sz += overhead; |
| if (sz < mpu) |
| sz = mpu; |
| rtab[i] = tc_core_usec2tick(1000000*((double)sz/bps)); |
| } |
| return cell_log; |
| } |
| |
| int tc_core_init() |
| { |
| FILE *fp = fopen("/proc/net/psched", "r"); |
| |
| if (fp == NULL) |
| return -1; |
| |
| if (fscanf(fp, "%08x%08x", &t2us, &us2t) != 2) { |
| fclose(fp); |
| return -1; |
| } |
| fclose(fp); |
| tick_in_usec = (double)t2us/us2t; |
| return 0; |
| } |