source: branches/nat-traversal/libtransmission/natpmp.c @ 864

/******************************************************************************
 * $Id: natpmp.c 864 2006-09-17 23:00:51Z joshe $
 *
 * Copyright (c) 2006 Transmission authors and contributors
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 *****************************************************************************/

#include "transmission.h"

#define PMP_PORT                5351
#define PMP_MCAST_ADDR          "224.0.0.1"
#define PMP_INITIAL_DELAY       250     /* ms, 1/4 second */
#define PMP_TOTAL_DELAY         120000  /* ms, 2 minutes */
#define PMP_VERSION             0
#define PMP_OPCODE_GETIP        0
#define PMP_OPCODE_ADDUDP       1
#define PMP_OPCODE_ADDTCP       2
#define PMP_LIFETIME            3600    /* secs, one hour */
#define PMP_RESPCODE_OK         0
#define PMP_RESPCODE_BADVERS    1
#define PMP_RESPCODE_REFUSED    2
#define PMP_RESPCODE_NETDOWN    3
#define PMP_RESPCODE_NOMEM      4
#define PMP_RESPCODE_BADOPCODE  5

#define PMP_OPCODE_FROM_RESPONSE( op )  ( 0x80 ^ (op) )
#define PMP_OPCODE_TO_RESPONSE( op )    ( 0x80 | (op) )
#define PMP_OPCODE_IS_RESPONSE( op )    ( 0x80 & (op) )
#define PMP_TOBUF16( buf, num ) ( *( (uint16_t *) (buf) ) = htons( (num) ) )
#define PMP_TOBUF32( buf, num ) ( *( (uint32_t *) (buf) ) = htonl( (num) ) )
#define PMP_FROMBUF16( buf )    ( htons( *( (uint16_t *) (buf) ) ) )
#define PMP_FROMBUF32( buf )    ( htonl( *( (uint32_t *) (buf) ) ) )

typedef struct tr_natpmp_uptime_s
{
    time_t   when;
    uint32_t uptime;
} tr_natpmp_uptime_t;

typedef struct tr_natpmp_req_s
{
    unsigned int         adding : 1;
    unsigned int         nobodyhome : 1;
    int                  fd;
    int                  delay;
    uint64_t             retry;
    uint64_t             timeout;
    int                  port;
    tr_fd_t *            fdlimit;
    tr_natpmp_uptime_t * uptime;
} tr_natpmp_req_t;

struct tr_natpmp_s
{
#define PMP_STATE_IDLE          1
#define PMP_STATE_ADDING        2
#define PMP_STATE_DELETING      3
#define PMP_STATE_MAPPED        4
#define PMP_STATE_FAILED        5
#define PMP_STATE_NOBODYHOME    6
    char               state;
    unsigned int       active : 1;
    struct in_addr     dest;
    int                newport;
    int                mappedport;
    tr_fd_t         *  fdlimit;
    tr_lock_t          lock;
    uint64_t           renew;
    tr_natpmp_req_t *  req;
    tr_natpmp_uptime_t uptime;
    int                mcastfd;
};

static int
checktime( tr_natpmp_uptime_t * uptime, uint32_t seen );
static void
killsock( int * fd, tr_fd_t * fdlimit );
static tr_natpmp_req_t *
newreq( int adding, struct in_addr addr, int port, tr_fd_t * fdlimit,
        tr_natpmp_uptime_t * uptime );
static tr_tristate_t
pulsereq( tr_natpmp_req_t * req, uint64_t * renew );
static int
mcastsetup( tr_fd_t * fdlimit );
static void
mcastpulse( tr_natpmp_t * pmp );
static void
killreq( tr_natpmp_req_t ** req );
static int
sendrequest( int adding, int fd, int port );
static tr_tristate_t
readrequest( uint8_t * buf, int len, int adding, int port,
             tr_natpmp_uptime_t * uptime, uint64_t * renew );

tr_natpmp_t *
tr_natpmpInit( tr_fd_t * fdlimit )
{
    tr_natpmp_t * pmp;

    pmp = calloc( 1, sizeof( *pmp ) );
    if( NULL == pmp )
    {
        return NULL;
    }

    pmp->state       = PMP_STATE_IDLE;
    pmp->fdlimit     = fdlimit;
    pmp->mcastfd     = -1;

    if( tr_getDefaultRoute( &pmp->dest ) || INADDR_ANY == pmp->dest.s_addr )
    {
        pmp->dest.s_addr = INADDR_NONE;
    }

    if( INADDR_NONE == pmp->dest.s_addr )
    {
        tr_dbg( "nat-pmp device is unknown" );
    }
    else
    {
        char addrstr[INET_ADDRSTRLEN];
        tr_netNtop( &pmp->dest, addrstr, sizeof( addrstr ) );
        tr_dbg( "nat-pmp device is %s", addrstr );
    }

    tr_lockInit( &pmp->lock );

    return pmp;
}

void
tr_natpmpStart( tr_natpmp_t * pmp )
{
    tr_lockLock( &pmp->lock );

    if( !pmp->active )
    {
        tr_inf( "starting nat-pmp" );
        pmp->active = 1;
        if( 0 > pmp->mcastfd )
        {
            pmp->mcastfd = mcastsetup( pmp->fdlimit );
        }
        /* XXX should I change state? */
    }

    tr_lockUnlock( &pmp->lock );
}

void
tr_natpmpStop( tr_natpmp_t * pmp )
{
    tr_lockLock( &pmp->lock );

    if( pmp->active )
    {
        tr_inf( "stopping nat-pmp" );
        pmp->active = 0;
        killsock( &pmp->mcastfd, pmp->fdlimit );
        switch( pmp->state )
        {
            case PMP_STATE_IDLE:
                break;
            case PMP_STATE_ADDING:
                pmp->state = PMP_STATE_IDLE;
                tr_dbg( "nat-pmp state add -> idle" );
                if( NULL != pmp->req )
                {
                    killreq( &pmp->req );
                    pmp->mappedport = pmp->req->port;
                    pmp->state = PMP_STATE_DELETING;
                    tr_dbg( "nat-pmp state idle -> del" );
                }
                break;
            case PMP_STATE_DELETING:
                break;
            case PMP_STATE_MAPPED:
                pmp->state = PMP_STATE_DELETING;
                tr_dbg( "nat-pmp state mapped -> del" );
                break;
            case PMP_STATE_FAILED:
            case PMP_STATE_NOBODYHOME:
                break;
            default:
                assert( 0 );
                break;
        }
    }

    tr_lockUnlock( &pmp->lock );
}

int
tr_natpmpStatus( tr_natpmp_t * pmp )
{
    int ret;

    tr_lockLock( &pmp->lock );

    
    if( !pmp->active )
    {
        ret = ( PMP_STATE_DELETING == pmp->state ?
                TR_NAT_TRAVERSAL_UNMAPPING : TR_NAT_TRAVERSAL_DISABLED );
    }
    else if( 0 < pmp->mappedport )
    {
        ret = TR_NAT_TRAVERSAL_MAPPED;
    }
    else
    {
        switch( pmp->state )
        {
            case PMP_STATE_IDLE:
            case PMP_STATE_ADDING:
            case PMP_STATE_DELETING:
                ret = TR_NAT_TRAVERSAL_MAPPING;
                break;
            case PMP_STATE_FAILED:
                ret = TR_NAT_TRAVERSAL_ERROR;
                break;
            case PMP_STATE_NOBODYHOME:
                ret = TR_NAT_TRAVERSAL_NOTFOUND;
                break;
            case PMP_STATE_MAPPED:
            default:
                assert( 0 );
                ret = TR_NAT_TRAVERSAL_ERROR;
                break;
        }
    }

    tr_lockUnlock( &pmp->lock );

    return ret;
}

void
tr_natpmpForwardPort( tr_natpmp_t * pmp, int port )
{
    tr_lockLock( &pmp->lock );
    tr_inf( "nat-pmp set port %i", port );
    pmp->newport = port;
    tr_lockUnlock( &pmp->lock );
}

void
tr_natpmpClose( tr_natpmp_t * pmp )
{
    /* try to send at least one delete request if we have a port mapping */
    tr_natpmpStop( pmp );
    tr_natpmpPulse( pmp );

    tr_lockLock( &pmp->lock );
    killreq( &pmp->req );
    tr_lockClose( &pmp->lock );
    free( pmp );
}

void
tr_natpmpPulse( tr_natpmp_t * pmp )
{
    tr_lockLock( &pmp->lock );

    if( 0 <= pmp->mcastfd )
    {
        mcastpulse( pmp );
    }

    if( pmp->active || PMP_STATE_DELETING == pmp->state )
    {
        switch( pmp->state )
        {
            case PMP_STATE_IDLE:
                if( 0 < pmp->newport )
                {
                    pmp->state = PMP_STATE_ADDING;
                    tr_dbg( "nat-pmp state idle -> add with port %i",
                            pmp->newport );
                }
                break;

            case PMP_STATE_ADDING:
                if( NULL == pmp->req )
                {
                    if( 0 >= pmp->newport )
                    {
                        tr_dbg( "nat-pmp state add -> idle, no port" );
                        pmp->state = PMP_STATE_IDLE;
                    }
                    else if( INADDR_NONE == pmp->dest.s_addr )
                    {
                        tr_dbg( "nat-pmp state add -> fail, no default route" );
                        pmp->state = PMP_STATE_FAILED;
                    }
                    else
                    {
                        pmp->req = newreq( 1, pmp->dest, pmp->newport,
                                           pmp->fdlimit, &pmp->uptime );
                        if( NULL == pmp->req )
                        {
                            pmp->state = PMP_STATE_FAILED;
                            tr_dbg( "nat-pmp state add -> fail on req init" );
                        }
                    }
                }
                if( PMP_STATE_ADDING == pmp->state )
                {
                    switch( pulsereq( pmp->req, &pmp->renew ) )
                    {
                        case TR_ERROR:
                            if( pmp->req->nobodyhome )
                            {
                                pmp->state = PMP_STATE_NOBODYHOME;
                                tr_dbg( "nat-pmp state add -> nobodyhome on pulse" );
                            }
                            else
                            {
                                pmp->state = PMP_STATE_FAILED;
                                tr_dbg( "nat-pmp state add -> fail on pulse" );
                            }
                            killreq( &pmp->req );
                            break;
                        case TR_OK:
                            pmp->mappedport = pmp->req->port;
                            killreq( &pmp->req );
                            pmp->state = PMP_STATE_MAPPED;
                            tr_dbg( "nat-pmp state add -> mapped with port %i",
                                    pmp->mappedport);
                            tr_inf( "nat-pmp mapped port %i", pmp->mappedport );
                            break;
                        case TR_WAIT:
                            break;
                    }
                }
                break;

            case PMP_STATE_DELETING:
                if( NULL == pmp->req )
                {
                    assert( 0 < pmp->mappedport );
                    pmp->req = newreq( 0, pmp->dest, pmp->newport,
                                       pmp->fdlimit, &pmp->uptime );
                    if( NULL == pmp->req )
                    {
                        pmp->state = PMP_STATE_FAILED;
                        tr_dbg( "nat-pmp state del -> fail on req init" );
                    }
                }
                if( PMP_STATE_DELETING == pmp->state )
                {
                    switch( pulsereq( pmp->req, &pmp->renew ) )
                    {
                        case TR_ERROR:
                            if( pmp->req->nobodyhome )
                            {
                                pmp->state = PMP_STATE_NOBODYHOME;
                                tr_dbg( "nat-pmp state del -> nobodyhome on pulse" );
                            }
                            else
                            {
                                pmp->state = PMP_STATE_FAILED;
                                tr_dbg( "nat-pmp state del -> fail on pulse" );
                            }
                            killreq( &pmp->req );
                            break;
                        case TR_OK:
                            tr_dbg( "nat-pmp state del -> idle with port %i",
                                    pmp->req->port);
                            tr_inf( "nat-pmp unmapped port %i", pmp->req->port );
                            pmp->mappedport = -1;
                            killreq( &pmp->req );
                            pmp->state = PMP_STATE_IDLE;
                            break;
                        case TR_WAIT:
                            break;
                    }
                }
                break;

            case PMP_STATE_MAPPED:
                if( pmp->newport != pmp->mappedport )
                {
                    tr_dbg( "nat-pmp state mapped -> del, port from %i to %i",
                            pmp->mappedport, pmp->newport );
                    pmp->state = PMP_STATE_DELETING;
                }
                else if( tr_date() > pmp->renew )
                {
                    pmp->state = PMP_STATE_ADDING;
                    tr_dbg( "nat-pmp state mapped -> add for renewal" );
                }
                break;

            case PMP_STATE_FAILED:
            case PMP_STATE_NOBODYHOME:
                break;

            default:
                assert( 0 );
                break;
        }
    }

    tr_lockUnlock( &pmp->lock );
}

static int
checktime( tr_natpmp_uptime_t * uptime, uint32_t cursecs )
{
    time_t   now;
    int      ret;
    uint32_t estimated;

    now = time( NULL );
    ret = 0;
    if( 0 < uptime->when )
    {
        estimated = ( ( now - uptime->when ) * 7 / 8 ) + uptime->uptime;
        if( estimated > cursecs )
        {
            ret = 1;
        }
    }

    uptime->when   = now;
    uptime->uptime = cursecs;

    return ret;
}

static void
killsock( int * fd, tr_fd_t * fdlimit )
{
    if( 0 <= *fd )
    {
        tr_netClose( *fd );
        *fd = -1;
        tr_fdSocketClosed( fdlimit, 0 );
    }
}

static tr_natpmp_req_t *
newreq( int adding, struct in_addr addr, int port, tr_fd_t * fdlimit,
        tr_natpmp_uptime_t * uptime )
{
    tr_natpmp_req_t * ret;
    uint64_t          now;

    ret = calloc( 1, sizeof( *ret ) );
    if( NULL == ret )
    {
        goto err;
    }
    ret->fd = -1;
    if( tr_fdSocketWillCreate( fdlimit, 0 ) )
    {
        goto err;
    }
    ret->fd = tr_netOpenUDP( addr, htons( PMP_PORT ) );
    if( 0 > ret->fd )
    {
        goto err;
    }
    if( sendrequest( adding, ret->fd, port ) )
    {
        goto err;
    }

    now          = tr_date();
    ret->adding  = adding;
    ret->delay   = PMP_INITIAL_DELAY;
    ret->retry   = now + PMP_INITIAL_DELAY;
    ret->timeout = now + PMP_TOTAL_DELAY;
    ret->port    = port;
    ret->fdlimit = fdlimit;
    ret->uptime  = uptime;

    return ret;

  err:
    if( NULL != ret )
    {
        killsock( &ret->fd, fdlimit );
    }
    free( ret );

    return NULL;
}

static tr_tristate_t
pulsereq( tr_natpmp_req_t * req, uint64_t * renew )
{
    struct sockaddr_in sin;
    uint8_t            buf[16];
    int                res;
    uint64_t           now;

    now = tr_date();

    if( now >= req->timeout )
    {
        tr_dbg( "nat-pmp request timed out" );
        req->nobodyhome = 1;
        return TR_ERROR;
    }

    if( now >= req->retry )
    {
        if( sendrequest( req->adding, req->fd, req->port ) )
        {
            return TR_ERROR;
        }
        req->delay *= 2;
        req->timeout = now + req->delay;
    }

    res = tr_netRecvFrom( req->fd, buf, sizeof( buf ), &sin );
    if( TR_NET_BLOCK & res )
    {
        return TR_WAIT;
    }
    else if( TR_NET_CLOSE & res )
    {
        if( ECONNRESET == errno || ECONNREFUSED == errno )
        {
            tr_dbg( "nat-pmp not supported by device" );
            req->nobodyhome = 1;
        }
        else
        {
            tr_inf( "error reading nat-pmp response (%s)", strerror( errno ) );
        }
        return TR_ERROR;
    }

    tr_dbg( "nat-pmp read %i byte response", res );

    return readrequest( buf, res, req->adding, req->port, req->uptime, renew );
}

static int
mcastsetup( tr_fd_t * fdlimit )
{
    int fd;
    struct in_addr addr;

    if( tr_fdSocketWillCreate( fdlimit, 0 ) )
    {
        return -1;
    }

    addr.s_addr = inet_addr( PMP_MCAST_ADDR );
    fd = tr_netMcastOpen( PMP_PORT, addr );
    if( 0 > fd )
    {
        tr_fdSocketClosed( fdlimit, 0 );
        return -1;
    }

    tr_dbg( "nat-pmp create multicast socket %i", fd );

    return fd;
}

static void
mcastpulse( tr_natpmp_t * pmp )
{
    struct sockaddr_in sin;
    uint8_t            buf[16];
    int                res;
    char               dbgstr[INET_ADDRSTRLEN];

    res = tr_netRecvFrom( pmp->mcastfd, buf, sizeof( buf ), &sin );
    if( TR_NET_BLOCK & res )
    {
        return;
    }
    else if( TR_NET_CLOSE & res )
    {
        tr_err( "error reading nat-pmp multicast message" );
        killsock( &pmp->mcastfd, pmp->fdlimit );
        return;
    }

    tr_netNtop( &sin.sin_addr, dbgstr, sizeof( dbgstr ) );
    tr_dbg( "nat-pmp read %i byte multicast packet from %s", res, dbgstr );

    if( pmp->dest.s_addr != sin.sin_addr.s_addr )
    {
        tr_dbg( "nat-pmp ignoring multicast packet from unknown host %s",
                dbgstr );
        return;
    }

    if( TR_OK == readrequest( buf, res, 0, -1, &pmp->uptime, &pmp->renew ) &&
        PMP_STATE_FAILED == pmp->state )
    {
        tr_dbg( "nat-pmp state fail -> idle" );
        pmp->state = PMP_STATE_IDLE;
    }
}

static void
killreq( tr_natpmp_req_t ** req )
{
    if( NULL != *req )
    {
        killsock( &(*req)->fd, (*req)->fdlimit );
        free( *req );
        *req = NULL;
    }
}

static int
sendrequest( int adding, int fd, int port )
{
    uint8_t buf[12];
    int res;

    buf[0] = PMP_VERSION;
    buf[1] = PMP_OPCODE_ADDTCP;
    buf[2] = 0;
    buf[3] = 0;
    PMP_TOBUF16( buf + 4, port );
    if( adding )
    {
        PMP_TOBUF16( buf + 6, port );
        PMP_TOBUF32( buf + 8, PMP_LIFETIME );
    }
    else
    {
        PMP_TOBUF16( buf + 6, 0 );
        PMP_TOBUF32( buf + 8, 0 );
    }

    res = tr_netSend( fd, buf, sizeof( buf ) );
    /* XXX is it all right to assume the entire thing is written? */

    /* XXX I should handle blocking here */

    return ( ( TR_NET_CLOSE | TR_NET_BLOCK ) & res  ? 1 : 0 );
}

static tr_tristate_t
readrequest( uint8_t * buf, int len, int adding, int port,
             tr_natpmp_uptime_t * uptime, uint64_t * renew )
{
    uint8_t            version, opcode, wantedopcode;
    uint16_t           rescode, privport, pubport;
    uint32_t           seconds, lifetime;

    if( 4 > len )
    {
        tr_err( "read truncated %i byte nat-pmp response packet", len );
        return TR_ERROR;
    }
    version      = buf[0];
    opcode       = buf[1];
    rescode      = PMP_FROMBUF16( buf + 2 );
    wantedopcode = ( 0 < port ? PMP_OPCODE_ADDTCP : PMP_OPCODE_GETIP );

    if( !PMP_OPCODE_IS_RESPONSE( opcode ) )
    {
        tr_dbg( "nat-pmp ignoring request packet" );
        return TR_WAIT;
    }
    opcode = PMP_OPCODE_FROM_RESPONSE( opcode );

    if( PMP_VERSION != version )
    {
        tr_err( "bad nat-pmp version %hhu", buf[0] );
        return TR_ERROR;
    }
    if( wantedopcode != opcode )
    {
        tr_err( "bad nat-pmp opcode %hhu", opcode );
        return TR_ERROR;
    }
    if( PMP_RESPCODE_OK != rescode )
    {
        tr_err( "bad nat-pmp result code %hu", rescode );
        return TR_ERROR;
    }

    if( 8 > len )
    {
        tr_err( "read truncated %i byte nat-pmp response packet", len );
        return TR_ERROR;
    }
    seconds = PMP_FROMBUF32( buf + 4 );

    if( checktime( uptime, seconds ) )
    {
        *renew = 0;
        tr_inf( "detected nat-pmp device reset" );
        /* XXX should reset retry counter here */
        return TR_WAIT;
    }

    if( 0 <= port )
    {
        assert( PMP_OPCODE_ADDTCP == wantedopcode );
        if( 16 > len )
        {
            tr_err( "read truncated %i byte nat-pmp response packet", len );
            return TR_ERROR;
        }
        privport = PMP_FROMBUF16( buf + 8 );
        pubport  = PMP_FROMBUF16( buf + 10 );
        lifetime = PMP_FROMBUF32( buf + 12 );

        if( port != privport )
        {
            /* private port doesn't match, ignore it */
            tr_dbg( "nat-pmp ignoring message for port %i, expected port %i",
                    privport, port );
            return TR_WAIT;
        }

        if( adding )
        {
            if( port != pubport )
            {
                /* XXX should just start announcing the pub port we're given */
                return TR_ERROR;
            }
            tr_dbg( "nat-pmp set renew to half of %u", lifetime );
            *renew = tr_date() + ( lifetime / 2 * 1000 );
        }
    }

    return TR_OK;
}