Reflow to < 80 chars.

[netbsd-mini2440.git] / sys / netiso / clnp_subr.c

/*      $NetBSD: clnp_subr.c,v 1.32 2009/03/18 15:14:32 cegger Exp $    */

/*-
 * Copyright (c) 1991, 1993
 *      The Regents of the University of California.  All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 *      @(#)clnp_subr.c 8.1 (Berkeley) 6/10/93
 */

/***********************************************************
                Copyright IBM Corporation 1987

                      All Rights Reserved

Permission to use, copy, modify, and distribute this software and its
documentation for any purpose and without fee is hereby granted,
provided that the above copyright notice appear in all copies and that
both that copyright notice and this permission notice appear in
supporting documentation, and that the name of IBM not be
used in advertising or publicity pertaining to distribution of the
software without specific, written prior permission.

IBM DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, INCLUDING
ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO EVENT SHALL
IBM BE LIABLE FOR ANY SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR
ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,
WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,
ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS
SOFTWARE.

******************************************************************/

/*
 * ARGO Project, Computer Sciences Dept., University of Wisconsin - Madison
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: clnp_subr.c,v 1.32 2009/03/18 15:14:32 cegger Exp $");

#include "opt_iso.h"

#ifdef ISO

#include <sys/param.h>
#include <sys/mbuf.h>
#include <sys/domain.h>
#include <sys/protosw.h>
#include <sys/socket.h>
#include <sys/socketvar.h>
#include <sys/errno.h>
#include <sys/time.h>
#include <sys/systm.h>

#include <net/if.h>
#include <net/route.h>
#include <net/if_dl.h>

#include <netiso/iso.h>
#include <netiso/iso_var.h>
#include <netiso/iso_pcb.h>
#include <netiso/iso_snpac.h>
#include <netiso/clnp.h>
#include <netiso/clnp_stat.h>
#include <netiso/argo_debug.h>
#include <netiso/esis.h>

/*
 * FUNCTION:            clnp_data_ck
 *
 * PURPOSE:             Check that the amount of data in the mbuf chain is
 *                      at least as much as the clnp header would have us
 *                      expect. Trim mbufs if longer than expected, drop
 *                      packet if shorter than expected.
 *
 * RETURNS:             success - ptr to mbuf chain
 *                      failure - 0
 *
 * SIDE EFFECTS:
 *
 * NOTES:
 */
struct mbuf    *
clnp_data_ck(
        struct mbuf *m,         /* ptr to mbuf chain containing hdr & data */
        int     length)         /* length (in bytes) of packet */
{
        int    len;             /* length of data */
        struct mbuf *mhead;     /* ptr to head of chain */

        len = -length;
        mhead = m;
        for (;;) {
                len += m->m_len;
                if (m->m_next == 0)
                        break;
                m = m->m_next;
        }
        if (len != 0) {
                if (len < 0) {
                        INCSTAT(cns_toosmall);
                        clnp_discard(mhead, GEN_INCOMPLETE);
                        return 0;
                }
                if (len <= m->m_len)
                        m->m_len -= len;
                else
                        m_adj(mhead, -len);
        }
        return mhead;
}

#ifdef notdef
/*
 * FUNCTION:            clnp_extract_addr
 *
 * PURPOSE:             Extract the source and destination address from the
 *                      supplied buffer. Place them in the supplied address buffers.
 *                      If insufficient data is supplied, then fail.
 *
 * RETURNS:             success - Address of first byte in the packet past
 *                      the address part.
 *                      failure - 0
 *
 * SIDE EFFECTS:
 *
 * NOTES:
 */
void *
clnp_extract_addr(
        void *        bufp,     /* ptr to buffer containing addresses */
        int             buflen, /* length of buffer */
        struct iso_addr *srcp,  /* ptr to source address buffer */
        struct iso_addr *destp) /* ptr to destination address
                                                 * buffer */
{
        size_t             len; /* argument to memcpy */

        /*
         * check that we have enough data. Plus1 is for length octet
         */
        len = (u_char)*bufp++;
        if (len > buflen)
                return NULL;
        destp->isoa_len = len;
        (void)memcpy(destp, bufp, len);
        buflen -= len;
        bufp += len;

        /*
         * check that we have enough data. Plus1 is for length octet
         */
        len = (u_char)*bufp++;
        if (len > buflen)
                return NULL;
        srcp->isoa_len = len;
        (void)memcpy(srcp, bufp, len);
        bufp += len;

        /*
         *      Insure that the addresses make sense
         */
        if (iso_ck_addr(srcp) && iso_ck_addr(destp))
                return bufp;
        else
                return NULL;
}
#endif                          /* notdef */

/*
 * FUNCTION:            clnp_ours
 *
 * PURPOSE:             Decide whether the supplied packet is destined for
 *                      us, or that it should be forwarded on.
 *
 * RETURNS:             packet is for us - 1
 *                      packet is not for us - 0
 *
 * SIDE EFFECTS:
 *
 * NOTES:
 */
int
clnp_ours(
        struct iso_addr *dst)   /* ptr to destination address */
{
        struct iso_ifaddr *ia;  /* scan through interface addresses */

        for (ia = iso_ifaddr.tqh_first; ia != 0; ia = ia->ia_list.tqe_next) {
#ifdef ARGO_DEBUG
                if (argo_debug[D_ROUTE]) {
                        printf("clnp_ours: ia_sis %p, dst %p\n",
                            &ia->ia_addr, dst);
                }
#endif
                /*
                 * XXX Warning:
                 * We are overloading siso_tlen in the if's address, as an nsel length.
                 */
                if (dst->isoa_len == ia->ia_addr.siso_nlen &&
                    memcmp((void *) ia->ia_addr.siso_addr.isoa_genaddr,
                         (void *) dst->isoa_genaddr,
                         ia->ia_addr.siso_nlen - ia->ia_addr.siso_tlen) == 0)
                        return 1;
        }
        return 0;
}

/* Dec bit set if ifp qlen is greater than congest_threshold */
int             congest_threshold = 0;

/*
 * FUNCTION:            clnp_forward
 *
 * PURPOSE:             Forward the datagram passed
 *                      clnpintr guarantees that the header will be
 *                      contigious (a cluster mbuf will be used if necessary).
 *
 *                      If oidx is NULL, no options are present.
 *
 * RETURNS:             nothing
 *
 * SIDE EFFECTS:
 *
 * NOTES:
 */
void
clnp_forward(
        struct mbuf    *m,              /* pkt to forward */
        int             len,            /* length of pkt */
        struct iso_addr *dst,           /* destination address */
        struct clnp_optidx *oidx,       /* option index */
        int             seg_off,        /* offset of segmentation part */
        struct snpa_hdr *inbound_shp)   /* subnetwork header of inbound
                                         * packet */
{
        struct clnp_fixed *clnp;        /* ptr to fixed part of header */
        int             error;          /* return value of route function */
        const struct sockaddr *next_hop;        /* next hop for dgram */
        struct ifnet   *ifp;            /* ptr to outgoing interface */
        struct iso_ifaddr *ia = 0;      /* ptr to iso name for ifp */
        struct route route;             /* filled in by clnp_route */
        struct rtentry *rt;
        extern int      iso_systype;

        clnp = mtod(m, struct clnp_fixed *);
        memset((void *) & route, 0, sizeof(route));     /* MUST be done before
                                                         * "bad:" */

        /*
         *      Don't forward multicast or broadcast packets
         */
        if ((inbound_shp) && (IS_MULTICAST(inbound_shp->snh_dhost))) {
#ifdef ARGO_DEBUG
                if (argo_debug[D_FORWARD]) {
                        printf("clnp_forward: dropping multicast packet\n");
                }
#endif
                clnp->cnf_type &= ~CNF_ERR_OK;  /* so we don't generate an ER */
                clnp_discard(m, 0);
                INCSTAT(cns_cantforward);
                goto done;
        }
#ifdef ARGO_DEBUG
        if (argo_debug[D_FORWARD]) {
                printf("clnp_forward: %d bytes, to %s, options %p\n", len,
                       clnp_iso_addrp(dst), oidx);
        }
#endif

        /*
         *      Decrement ttl, and if zero drop datagram
         *      Can't compare ttl as less than zero 'cause its a unsigned
         */
        if ((clnp->cnf_ttl == 0) || (--clnp->cnf_ttl == 0)) {
#ifdef ARGO_DEBUG
                if (argo_debug[D_FORWARD]) {
                        printf("clnp_forward: discarding datagram because ttl is zero\n");
                }
#endif
                INCSTAT(cns_ttlexpired);
                clnp_discard(m, TTL_EXPTRANSIT);
                goto done;
        }
        /*
         *      Route packet; special case for source rt
         */
        if CLNPSRCRT_VALID
                (oidx) {
                /*
                 *      Update src route first
                 */
                clnp_update_srcrt(m, oidx);
                error = clnp_srcroute(m, oidx, &route, &next_hop, &ia, dst);
        } else {
                error = clnp_route(dst, &route, 0, &next_hop, &ia);
        }
        if (error || ia == 0) {
#ifdef ARGO_DEBUG
                if (argo_debug[D_FORWARD]) {
                        printf("clnp_forward: can't route packet (errno %d)\n", error);
                }
#endif
                clnp_discard(m, ADDR_DESTUNREACH);
                INCSTAT(cns_cantforward);
                goto done;
        }
        ifp = ia->ia_ifp;

#ifdef ARGO_DEBUG
        if (argo_debug[D_FORWARD]) {
                printf("clnp_forward: packet routed to %s\n",
                       clnp_iso_addrp(&satocsiso(next_hop)->siso_addr));
        }
#endif

        INCSTAT(cns_forward);

        /*
         *      If we are an intermediate system and
         *      we are routing outbound on the same ifp that the packet
         *      arrived upon, and we know the next hop snpa,
         *      then generate a redirect request
         */
        if ((iso_systype & SNPA_IS) && (inbound_shp) &&
            (ifp == inbound_shp->snh_ifp))
                esis_rdoutput(inbound_shp, m, oidx, dst, rtcache_validate(&route));
        /*
         *      If options are present, update them
         */
        if (oidx) {
                struct iso_addr *mysrc = &ia->ia_addr.siso_addr;
                if (mysrc == NULL) {
                        clnp_discard(m, ADDR_DESTUNREACH);
                        INCSTAT(cns_cantforward);
                        clnp_stat.cns_forward--;
                        goto done;
                } else {
                        (void) clnp_dooptions(m, oidx, ifp, mysrc);
                }
        }
#ifdef  DECBIT
        if (ifp->if_snd.ifq_len > congest_threshold) {
                /*
                 *      Congestion! Set the Dec Bit and thank Dave Oran
                 */
#ifdef ARGO_DEBUG
                if (argo_debug[D_FORWARD]) {
                        printf("clnp_forward: congestion experienced\n");
                }
#endif
                if ((oidx) && (oidx->cni_qos_formatp)) {
                        char *         qosp = CLNP_OFFTOOPT(m, oidx->cni_qos_formatp);
                        u_char          qos = *qosp;
#ifdef ARGO_DEBUG
                        if (argo_debug[D_FORWARD]) {
                                printf("clnp_forward: setting congestion bit (qos x%x)\n", qos);
                        }
#endif
                        if ((qos & CLNPOVAL_GLOBAL) == CLNPOVAL_GLOBAL) {
                                qos |= CLNPOVAL_CONGESTED;
                                INCSTAT(cns_congest_set);
                                *qosp = qos;
                        }
                }
        }
#endif                          /* DECBIT */

        /*
         *      Dispatch the datagram if it is small enough, otherwise fragment
         */
        if ((rt = rtcache_validate(&route)) == NULL)
                ;
        else if (len <= SN_MTU(ifp, rt)) {
                iso_gen_csum(m, CLNP_CKSUM_OFF, (int) clnp->cnf_hdr_len);
                (void) (*ifp->if_output) (ifp, m, next_hop, rt);
        } else {
                (void) clnp_fragment(ifp, m, next_hop, len, seg_off, /* flags */ 0, rt);
        }

done:
        /*
         *      Free route
         */
        rtcache_free(&route);
}

#ifdef  notdef
/*
 * FUNCTION:            clnp_insert_addr
 *
 * PURPOSE:                     Insert the address part into a clnp datagram.
 *
 * RETURNS:                     Address of first byte after address part in datagram.
 *
 * SIDE EFFECTS:
 *
 * NOTES:                       Assume that there is enough space for the address part.
 */
void *
clnp_insert_addr(
        void *        bufp,     /* address of where addr part goes */
        struct iso_addr *srcp,  /* ptr to src addr */
        struct iso_addr *dstp)  /* ptr to dst addr */
{
        *bufp++ = dstp->isoa_len;
        (void)memcpy(bufp, dstp, dstp->isoa_len);
        bufp += dstp->isoa_len;

        *bufp++ = srcp->isoa_len;
        (void)memcpy(bufp, srcp, srcp->isoa_len);
        bufp += srcp->isoa_len;

        return bufp;
}

#endif                          /* notdef */

/*
 * FUNCTION:            clnp_route
 *
 * PURPOSE:             Route a clnp datagram to the first hop toward its
 *                      destination. In many cases, the first hop will be
 *                      the destination. The address of a route
 *                      is specified. If a routing entry is present in
 *                      that route, and it is still up to the same destination,
 *                      then no further action is necessary. Otherwise, a
 *                      new routing entry will be allocated.
 *
 * RETURNS:             route found - 0
 *                      unix error code
 *
 * SIDE EFFECTS:
 *
 * NOTES:               It is up to the caller to free the routing entry
 *                      allocated in route.
 */
int
clnp_route(
        struct iso_addr *dst,           /* ptr to datagram destination */
        struct route *ro,               /* existing route structure */
        int             flags,          /* flags for routing */
        const struct sockaddr **first_hop,      /* result: fill in with ptr to
                                                 * firsthop */
        struct iso_ifaddr **ifa)        /* result: fill in with ptr to ifa */
{
        struct rtentry *rt;
        int rc;
        union {
                struct sockaddr         dst;
                struct sockaddr_iso     dsti;
        } u;

        if (flags & SO_DONTROUTE) {
                struct iso_ifaddr *ia;

                if ((rc = sockaddr_iso_init(&u.dsti, dst)) != 0)
                        return rc;
                rtcache_setdst(ro, &u.dst);

                if (rtcache_getdst(ro) == NULL)
                        return EADDRNOTAVAIL;
                ia = iso_localifa(satocsiso(rtcache_getdst(ro)));
                if (ia == NULL)
                        return EADDRNOTAVAIL;
                if (ifa != NULL)
                        *ifa = ia;
                if (first_hop != NULL)
                        *first_hop = rtcache_getdst(ro);
                return 0;
        }

        /* set up new route structure */
        if ((rc = sockaddr_iso_init(&u.dsti, dst)) != 0)
                return rc;
        if ((rt = rtcache_lookup(ro, &u.dst)) == NULL) {
                rtcache_free(ro);
                return ENETUNREACH;
        }
        rt->rt_use++;
        if (ifa != NULL)
                if ((*ifa = (struct iso_ifaddr *)rt->rt_ifa) == NULL)
                        panic("clnp_route");
        if (first_hop != NULL) {
                if (rt->rt_flags & RTF_GATEWAY)
                        *first_hop = rt->rt_gateway;
                else
                        *first_hop = rtcache_getdst(ro);
        }
        return 0;
}

/*
 * FUNCTION:            clnp_srcroute
 *
 * PURPOSE:             Source route the datagram. If complete source
 *                      routing is specified but not possible, then
 *                      return an error. If src routing is terminated, then
 *                      try routing on destination.
 *                      Usage of first_hop,
 *                      ifp, and error return is identical to clnp_route.
 *
 * RETURNS:             0 or unix error code
 *
 * SIDE EFFECTS:
 *
 * NOTES:               Remember that option index pointers are really
 *                      offsets from the beginning of the mbuf.
 */
int
clnp_srcroute(
        struct mbuf *options,           /* ptr to options */
        struct clnp_optidx *oidx,       /* index to options */
        struct route *ro,               /* route structure */
        const struct sockaddr **first_hop,      /* RETURN: fill in with ptr to
                                                 * firsthop */
        struct iso_ifaddr **ifa,        /* RETURN: fill in with ptr to ifa */
        struct iso_addr *final_dst)     /* final destination */
{
        struct iso_addr dst;    /* first hop specified by src rt */
        int             error = 0;      /* return code */

        /*
         *      Check if we have run out of routes
         *      If so, then try to route on destination.
         */
        if CLNPSRCRT_TERM
                (oidx, options) {
                dst.isoa_len = final_dst->isoa_len;
                if (sizeof(dst.isoa_genaddr) < (size_t)dst.isoa_len)
                        return EINVAL;
                (void)memcpy(dst.isoa_genaddr, final_dst->isoa_genaddr,
                    (size_t)dst.isoa_len);
        } else {
                /*
                 * setup dst based on src rt specified
                 */
                dst.isoa_len = CLNPSRCRT_CLEN(oidx, options);
                if (sizeof(dst.isoa_genaddr) < (unsigned)dst.isoa_len)
                        return EINVAL;
                (void)memcpy(dst.isoa_genaddr, CLNPSRCRT_CADDR(oidx, options),
                    (size_t)dst.isoa_len);
        }

        /*
         *      try to route it
         */
        error = clnp_route(&dst, ro, 0, first_hop, ifa);
        if (error != 0)
                return error;

        /*
         *      If complete src rt, first hop must be equal to dst
         */
        if ((CLNPSRCRT_TYPE(oidx, options) == CLNPOVAL_COMPRT) &&
            (!iso_addrmatch1(&satocsiso(*first_hop)->siso_addr, &dst))) {
#ifdef ARGO_DEBUG
                if (argo_debug[D_OPTIONS]) {
                        printf("clnp_srcroute: complete src route failed\n");
                }
#endif
                return EHOSTUNREACH;    /* RAH? would like ESRCRTFAILED */
        }
        return error;
}

/*
 * FUNCTION:            clnp_echoreply
 *
 * PURPOSE:                     generate an echo reply packet and transmit
 *
 * RETURNS:                     result of clnp_output
 *
 * SIDE EFFECTS:
 */
int
clnp_echoreply(
    struct mbuf    *ec_m,               /* echo request */
    int             ec_len,             /* length of ec */
    struct sockaddr_iso *ec_src,        /* src of ec */
    struct sockaddr_iso *ec_dst,        /* destination of ec (i.e., us) */
    struct clnp_optidx *ec_oidxp) /* options index to ec packet */
{
        struct isopcb   isopcb;
        int             flags = CLNP_NOCACHE | CLNP_ECHOR;
        int             ret;

        /* fill in fake isopcb to pass to output function */
        memset(&isopcb, 0, sizeof(isopcb));
        isopcb.isop_laddr = ec_dst;
        isopcb.isop_faddr = ec_src;

        /*
         * forget copying the options for now. If implemented, need only copy
         * record route option, but it must be reset to zero length
         */

        ret = clnp_output(ec_m, &isopcb, ec_len, flags);

#ifdef ARGO_DEBUG
        if (argo_debug[D_OUTPUT]) {
                printf("clnp_echoreply: output returns %d\n", ret);
        }
#endif
        return ret;
}

/*
 * FUNCTION:            clnp_badmtu
 *
 * PURPOSE:             print notice of route with mtu not initialized.
 *
 * RETURNS:             mtu of ifp.
 *
 * SIDE EFFECTS:        prints notice, slows down system.
 */
int
clnp_badmtu(
        struct ifnet   *ifp,    /* outgoing interface */
        struct rtentry *rt,     /* dst route */
        int             line,   /* where the dirty deed occurred */
        const char     *file)   /* where the dirty deed occurred */
{
        printf("sending on route %p with no mtu, line %d of file %s\n",
            rt, line, file);
#ifdef ARGO_DEBUG
        printf("route dst is ");
        dump_isoaddr(satocsiso(rt_getkey(rt)));
#endif
        return ifp->if_mtu;
}

/*
 * FUNCTION:            clnp_ypocb - backwards bcopy
 *
 * PURPOSE:             bcopy starting at end of src rather than beginning.
 *
 * RETURNS:             none
 *
 * SIDE EFFECTS:
 *
 * NOTES:               No attempt has been made to make this efficient
 */
void
clnp_ypocb(
        void *        from,     /* src buffer */
        void *        to,       /* dst buffer */
        u_int           len)    /* number of bytes */
{
        while (len--)
                *((char *)to + len) = *((char *)from + len);
}
#endif                          /* ISO */