toxcore/toxav/bwcontroler.c

/**  bwcontroler.c
 *
 *   Copyright (C) 2013-2015 Tox project All Rights Reserved.
 *
 *   This file is part of Tox.
 *
 *   Tox 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.
 *
 *   Tox 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 Tox. If not, see <http://www.gnu.org/licenses/>.
 *
 */

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif /* HAVE_CONFIG_H */

#include <assert.h>
#include "bwcontroler.h"
#include "../toxcore/logger.h"
#include "../toxcore/util.h"

#define BWC_PACKET_ID 196
#define BWC_SEND_INTERVAL_MS 1000
#define BWC_REFRESH_INTERVAL_MS 10000
#define BWC_AVG_PKT_COUNT 20

/**
 * 
 */

struct BWControler_s {
    void (*mcb) (BWControler *, uint32_t, float, void *);
    void *mcb_data;

    Messenger *m;
    uint32_t friend_number;

    struct {
        uint32_t lru; /* Last recv update time stamp */
        uint32_t lsu; /* Last sent update time stamp */
        uint32_t lfu; /* Last refresh time stamp */

        uint32_t lost;
        uint32_t recv;
    } cycle;

    struct {
        uint32_t rb_s[BWC_AVG_PKT_COUNT];
        RingBuffer *rb;
    } rcvpkt; /* To calculate average received packet */
};

int bwc_handle_data(Messenger *m, uint32_t friendnumber, const uint8_t *data, uint16_t length, void *object);
void send_update(BWControler *bwc);

BWControler *bwc_new(Messenger *m, uint32_t friendnumber,
                     void (*mcb) (BWControler *, uint32_t, float, void *),
                     void *udata)
{
    BWControler *retu = calloc(sizeof(struct BWControler_s), 1);

    retu->mcb = mcb;
    retu->mcb_data = udata;
    retu->m = m;
    retu->friend_number = friendnumber;
    retu->cycle.lsu = retu->cycle.lfu = current_time_monotonic();
    retu->rcvpkt.rb = rb_new(BWC_AVG_PKT_COUNT);

    /* Fill with zeros */
    int i = 0;
    for (; i < BWC_AVG_PKT_COUNT; i ++)
        rb_write(retu->rcvpkt.rb, retu->rcvpkt.rb_s + i);
    
     m_callback_rtp_packet(m, friendnumber, BWC_PACKET_ID, bwc_handle_data, retu);

    return retu;
}
void bwc_kill(BWControler *bwc)
{
    if (!bwc)
        return;
    
    m_callback_rtp_packet(bwc->m, bwc->friend_number, BWC_PACKET_ID, NULL, NULL);
    
    rb_kill(bwc->rcvpkt.rb);
    free(bwc);
}
void bwc_feed_avg(BWControler* bwc, uint32_t bytes)
{
    uint32_t *p;
    
    rb_read(bwc->rcvpkt.rb, (void**) &p);
    rb_write(bwc->rcvpkt.rb, p);
    
    *p = bytes;
}
void bwc_add_lost(BWControler *bwc, uint32_t bytes)
{
    if (!bwc)
        return;

    if (!bytes) {
        uint32_t* t_avg[BWC_AVG_PKT_COUNT], c = 1;
        
        rb_data(bwc->rcvpkt.rb, (void**) t_avg);
        
        int i = 0;
        for (; i < BWC_AVG_PKT_COUNT; i ++) {
            bytes += *(t_avg[i]);
            
            if (*(t_avg[i]))
                c++;
        }
        
        bytes /= c;
    }
    
    bwc->cycle.lost += bytes;
    send_update(bwc);
}
void bwc_add_recv(BWControler *bwc, uint32_t bytes)
{
    if (!bwc || !bytes)
        return;
    
    bwc->cycle.recv += bytes;
    send_update(bwc);
}


struct BWCMessage {
    uint8_t core_type; /* Aligner for payload type which is always 196 */

    uint32_t lost;
    uint32_t recv;
} __attribute__((packed));

/* Check alignment */
typedef char __fail_if_misaligned [ sizeof(struct BWCMessage) == 9 ? 1 : -1 ];

void send_update(BWControler *bwc)
{
    if (current_time_monotonic() - bwc->cycle.lfu > BWC_REFRESH_INTERVAL_MS) {
        
        bwc->cycle.lost /= 10;
        bwc->cycle.recv /= 10;
        bwc->cycle.lfu = current_time_monotonic();
    }
    else if (current_time_monotonic() - bwc->cycle.lsu > BWC_SEND_INTERVAL_MS) {
        
        if (bwc->cycle.lost)
        {
            LOGGER_DEBUG ("%p Sent update", bwc);

            struct BWCMessage msg;
            msg.core_type = BWC_PACKET_ID;
            msg.lost = htonl(bwc->cycle.lost);
            msg.recv = htonl(bwc->cycle.recv);

            if (-1 == send_custom_lossy_packet(bwc->m, bwc->friend_number, (uint8_t *)&msg, sizeof(msg)))
                LOGGER_WARNING("BWC send failed (len: %d)! std error: %s", sizeof(msg), strerror(errno));
        }
        
        bwc->cycle.lsu = current_time_monotonic();
    }
}
int on_update (BWControler *bwc, struct BWCMessage *msg)
{
    LOGGER_DEBUG ("%p Got update from peer", bwc);
    
    /* Peer must respect time boundary */
    if (current_time_monotonic() < bwc->cycle.lru + BWC_SEND_INTERVAL_MS) {
        LOGGER_DEBUG("%p Rejecting extra update", bwc);
        return -1;
    }
    
    bwc->cycle.lru = current_time_monotonic();

    msg->recv = ntohl(msg->recv);
    msg->lost = ntohl(msg->lost);
    
    LOGGER_DEBUG ("recved: %u lost: %u", msg->recv, msg->lost);
    
    if (msg->lost && bwc->mcb)
        bwc->mcb(bwc, bwc->friend_number,
                 ((float) (msg->lost) / (msg->recv + msg->lost)),
                 bwc->mcb_data);

    return 0;
}
int bwc_handle_data(Messenger* m, uint32_t friendnumber, const uint8_t* data, uint16_t length, void* object)
{
    if (length != sizeof(struct BWCMessage))
        return;

    /* NOTE the data is mutable */
    return on_update(object, (struct BWCMessage *) data);
}