sys/netproto/ns/ns_error.c

   1 /*
   2  * Copyright (c) 1984, 1988, 1993
   3  *      The Regents of the University of California.  All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 3. All advertising materials mentioning features or use of this software
  14  *    must display the following acknowledgement:
  15  *      This product includes software developed by the University of
  16  *      California, Berkeley and its contributors.
  17  * 4. Neither the name of the University nor the names of its contributors
  18  *    may be used to endorse or promote products derived from this software
  19  *    without specific prior written permission.
  20  *
  21  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  31  * SUCH DAMAGE.
  32  *
  33  *      @(#)ns_error.c  8.1 (Berkeley) 6/10/93
  34  * $FreeBSD: src/sys/netns/ns_error.c,v 1.9 1999/08/28 00:49:49 peter Exp $
  35  * $DragonFly: src/sys/netproto/ns/ns_error.c,v 1.7 2004/02/16 20:37:20 dillon Exp $
  36  */
  37
  38 #include <sys/param.h>
  39 #include <sys/systm.h>
  40 #include <sys/malloc.h>
  41 #include <sys/mbuf.h>
  42 #include <sys/protosw.h>
  43 #include <sys/socket.h>
  44 #include <sys/time.h>
  45 #include <sys/kernel.h>
  46
  47 #include <net/route.h>
  48
  49 #include "ns.h"
  50 #include "ns_pcb.h"
  51 #include "idp.h"
  52 #include "ns_error.h"
  53
  54 extern int idpchsum;            /* from ns_input.c */
  55 extern void spp_ctlinput( int, caddr_t);        /* from spp_usrreq.c XXX */
  56
  57 struct   ns_errstat ns_errstat;
  58
  59 #ifdef lint
  60 #define NS_ERRPRINTFS 1
  61 #endif
  62
  63 #ifdef NS_ERRPRINTFS
  64 /*
  65  * NS_ERR routines: error generation, receive packet processing, and
  66  * routines to turnaround packets back to the originator.
  67  */
  68 int     ns_errprintfs = 0;
  69 #endif
  70
  71 int
  72 ns_err_x(c)
  73 int c;
  74 {
  75         u_short *w, *lim, *base = ns_errstat.ns_es_codes;
  76         u_short x = c;
  77
  78         /*
  79          * zero is a legit error code, handle specially
  80          */
  81         if (x == 0)
  82                 return (0);
  83         lim = base + NS_ERR_MAX - 1;
  84         for (w = base + 1; w < lim; w++) {
  85                 if (*w == 0)
  86                         *w = x;
  87                 if (*w == x)
  88                         break;
  89         }
  90         return (w - base);
  91 }
  92
  93 /*
  94  * Generate an error packet of type error
  95  * in response to bad packet.
  96  */
  97
  98 void
  99 ns_error(om, type, param)
 100         struct mbuf *om;
 101         int type;
 102         int param;
 103 {
 104         struct ns_epidp *ep;
 105         struct mbuf *m;
 106         struct idp *nip;
 107         struct idp *oip = mtod(om, struct idp *);
 108         extern int idpcksum;
 109
 110         /*
 111          * If this packet was sent to the echo port,
 112          * and nobody was there, just echo it.
 113          * (Yes, this is a wart!)
 114          */
 115         if (type == NS_ERR_NOSOCK &&
 116             oip->idp_dna.x_port == htons(2) &&
 117             (type = ns_echo(om))==0)
 118                 return;
 119
 120 #ifdef NS_ERRPRINTFS
 121         if (ns_errprintfs)
 122                 printf("ns_err_error(%x, %d, %d)\n", oip, type, param);
 123 #endif
 124         /*
 125          * Don't Generate error packets in response to multicasts.
 126          */
 127         if (oip->idp_dna.x_host.c_host[0] & 1)
 128                 goto freeit;
 129
 130         ns_errstat.ns_es_error++;
 131         /*
 132          * Make sure that the old IDP packet had 30 bytes of data to return;
 133          * if not, don't bother.  Also don't EVER error if the old
 134          * packet protocol was NS_ERR.
 135          */
 136         if (oip->idp_len < sizeof(struct idp)) {
 137                 ns_errstat.ns_es_oldshort++;
 138                 goto freeit;
 139         }
 140         if (oip->idp_pt == NSPROTO_ERROR) {
 141                 ns_errstat.ns_es_oldns_err++;
 142                 goto freeit;
 143         }
 144
 145         /*
 146          * First, formulate ns_err message
 147          */
 148         m = m_gethdr(M_DONTWAIT, MT_HEADER);
 149         if (m == NULL)
 150                 goto freeit;
 151         m->m_len = sizeof(*ep);
 152         MH_ALIGN(m, m->m_len);
 153         ep = mtod(m, struct ns_epidp *);
 154         if ((u_int)type > NS_ERR_TOO_BIG)
 155                 panic("ns_err_error");
 156         ns_errstat.ns_es_outhist[ns_err_x(type)]++;
 157         ep->ns_ep_errp.ns_err_num = htons((u_short)type);
 158         ep->ns_ep_errp.ns_err_param = htons((u_short)param);
 159         bcopy((caddr_t)oip, (caddr_t)&ep->ns_ep_errp.ns_err_idp, 42);
 160         nip = &ep->ns_ep_idp;
 161         nip->idp_len = sizeof(*ep);
 162         nip->idp_len = htons((u_short)nip->idp_len);
 163         nip->idp_pt = NSPROTO_ERROR;
 164         nip->idp_tc = 0;
 165         nip->idp_dna = oip->idp_sna;
 166         nip->idp_sna = oip->idp_dna;
 167         if (idpcksum) {
 168                 nip->idp_sum = 0;
 169                 nip->idp_sum = ns_cksum(m, sizeof(*ep));
 170         } else
 171                 nip->idp_sum = 0xffff;
 172         (void) ns_output(m, (struct route *)0, 0);
 173
 174 freeit:
 175         m_freem(om);
 176 }
 177
 178 void
 179 ns_printhost(p)
 180 struct ns_addr *p;
 181 {
 182
 183         printf("<net:%x%x,host:%x%x%x,port:%x>",
 184                         p->x_net.s_net[0],
 185                         p->x_net.s_net[1],
 186                         p->x_host.s_host[0],
 187                         p->x_host.s_host[1],
 188                         p->x_host.s_host[2],
 189                         p->x_port);
 190
 191 }
 192
 193 /*
 194  * Process a received NS_ERR message.
 195  */
 196 void
 197 ns_err_input(m)
 198         struct mbuf *m;
 199 {
 200         struct ns_errp *ep;
 201 #ifdef  NS_ERRPRINTFS
 202         struct ns_epidp *epidp = mtod(m, struct ns_epidp *);
 203 #endif
 204         int i;
 205         int type, code, param;
 206
 207         /*
 208          * Locate ns_err structure in mbuf, and check
 209          * that not corrupted and of at least minimum length.
 210          */
 211 #ifdef NS_ERRPRINTFS
 212         if (ns_errprintfs) {
 213                 printf("ns_err_input from ");
 214                 ns_printhost(&epidp->ns_ep_idp.idp_sna);
 215                 printf("len %d\n", ntohs(epidp->ns_ep_idp.idp_len));
 216         }
 217 #endif
 218         i = sizeof (struct ns_epidp);
 219         if (((m->m_flags & M_EXT) || m->m_len < i) &&
 220                 (m = m_pullup(m, i)) == 0)  {
 221                 ns_errstat.ns_es_tooshort++;
 222                 return;
 223         }
 224         ep = &(mtod(m, struct ns_epidp *)->ns_ep_errp);
 225         type = ntohs(ep->ns_err_num);
 226         param = ntohs(ep->ns_err_param);
 227         ns_errstat.ns_es_inhist[ns_err_x(type)]++;
 228
 229 #ifdef NS_ERRPRINTFS
 230         /*
 231          * Message type specific processing.
 232          */
 233         if (ns_errprintfs)
 234                 printf("ns_err_input, type %d param %d\n", type, param);
 235 #endif
 236         if (type >= NS_ERR_TOO_BIG) {
 237                 goto badcode;
 238         }
 239         ns_errstat.ns_es_outhist[ns_err_x(type)]++;
 240         switch (type) {
 241
 242         case NS_ERR_UNREACH_HOST:
 243                 code = PRC_UNREACH_NET;
 244                 goto deliver;
 245
 246         case NS_ERR_TOO_OLD:
 247                 code = PRC_TIMXCEED_INTRANS;
 248                 goto deliver;
 249
 250         case NS_ERR_TOO_BIG:
 251                 code = PRC_MSGSIZE;
 252                 goto deliver;
 253
 254         case NS_ERR_FULLUP:
 255                 code = PRC_QUENCH;
 256                 goto deliver;
 257
 258         case NS_ERR_NOSOCK:
 259                 code = PRC_UNREACH_PORT;
 260                 goto deliver;
 261
 262         case NS_ERR_UNSPEC_T:
 263         case NS_ERR_BADSUM_T:
 264         case NS_ERR_BADSUM:
 265         case NS_ERR_UNSPEC:
 266                 code = PRC_PARAMPROB;
 267                 goto deliver;
 268
 269         deliver:
 270                 /*
 271                  * Problem with datagram; advise higher level routines.
 272                  */
 273 #ifdef NS_ERRPRINTFS
 274                 if (ns_errprintfs)
 275                         printf("deliver to protocol %d\n",
 276                                        ep->ns_err_idp.idp_pt);
 277 #endif
 278                 switch(ep->ns_err_idp.idp_pt) {
 279                 case NSPROTO_SPP:
 280                         spp_ctlinput(code, (caddr_t)ep);
 281                         break;
 282
 283                 default:
 284                         idp_ctlinput(code, (caddr_t)ep);
 285                 }
 286
 287                 goto freeit;
 288
 289         default:
 290         badcode:
 291                 ns_errstat.ns_es_badcode++;
 292                 goto freeit;
 293
 294         }
 295 freeit:
 296         m_freem(m);
 297 }
 298
 299 int
 300 ns_echo(m)
 301 struct mbuf *m;
 302 {
 303         struct idp *idp = mtod(m, struct idp *);
 304         struct echo {
 305             struct idp  ec_idp;
 306             u_short             ec_op; /* Operation, 1 = request, 2 = reply */
 307         } *ec = (struct echo *)idp;
 308         struct ns_addr temp;
 309
 310         if (idp->idp_pt!=NSPROTO_ECHO) return(NS_ERR_NOSOCK);
 311         if (ec->ec_op!=htons(1)) return(NS_ERR_UNSPEC);
 312
 313         ec->ec_op = htons(2);
 314
 315         temp = idp->idp_dna;
 316         idp->idp_dna = idp->idp_sna;
 317         idp->idp_sna = temp;
 318
 319         if (idp->idp_sum != 0xffff) {
 320                 idp->idp_sum = 0;
 321                 idp->idp_sum = ns_cksum(m,
 322                     (int)(((ntohs(idp->idp_len) - 1)|1)+1));
 323         }
 324         (void) ns_output(m, (struct route *)0, NS_FORWARDING);
 325         return(0);
 326 }