sys/net/i4b/layer2/i4b_tei.c

   1 /*
   2  * Copyright (c) 1997, 2000 Hellmuth Michaelis. All rights reserved.
   3  *
   4  * Redistribution and use in source and binary forms, with or without
   5  * modification, are permitted provided that the following conditions
   6  * are met:
   7  * 1. Redistributions of source code must retain the above copyright
   8  *    notice, this list of conditions and the following disclaimer.
   9  * 2. Redistributions in binary form must reproduce the above copyright
  10  *    notice, this list of conditions and the following disclaimer in the
  11  *    documentation and/or other materials provided with the distribution.
  12  *
  13  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  14  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  15  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  16  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  17  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  18  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  19  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  20  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  21  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  22  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  23  * SUCH DAMAGE.
  24  *
  25  *---------------------------------------------------------------------------
  26  *
  27  *      i4b_tei.c - tei handling procedures
  28  *      -----------------------------------
  29  *
  30  *      $Id: i4b_tei.c,v 1.25 2000/09/01 14:11:51 hm Exp $
  31  *
  32  * $FreeBSD: src/sys/i4b/layer2/i4b_tei.c,v 1.6.2.2 2001/08/10 14:08:41 obrien Exp $
  33  *
  34  *      last edit-date: [Fri Oct 13 15:56:35 2000]
  35  *
  36  *---------------------------------------------------------------------------*/
  37
  38 #ifdef __FreeBSD__
  39 #include "i4bq921.h"
  40 #else
  41 #define NI4BQ921        1
  42 #endif
  43 #if NI4BQ921 > 0
  44
  45 #include <sys/param.h>
  46 #include <sys/systm.h>
  47 #include <sys/syslog.h>
  48 #include <sys/mbuf.h>
  49 #include <sys/socket.h>
  50 #include <net/if.h>
  51
  52 #if defined(__NetBSD__) && __NetBSD_Version__ >= 104230000
  53 #include <sys/callout.h>
  54 #endif
  55
  56 #ifdef __FreeBSD__
  57 #include <machine/i4b_debug.h>
  58 #else
  59 #include <i4b/i4b_debug.h>
  60 #include <i4b/i4b_ioctl.h>
  61 #endif
  62
  63 #include <i4b/include/i4b_global.h>
  64 #include <i4b/include/i4b_l1l2.h>
  65 #include <i4b/include/i4b_l2l3.h>
  66 #include <i4b/include/i4b_mbuf.h>
  67
  68 #include <i4b/layer2/i4b_l2.h>
  69 #include <i4b/layer2/i4b_l2fsm.h>
  70
  71 /*---------------------------------------------------------------------------*
  72  *      handle a received TEI management frame
  73  *---------------------------------------------------------------------------*/
  74 void
  75 i4b_tei_rxframe(int unit, struct mbuf *m)
  76 {
  77         l2_softc_t *l2sc = &l2_softc[unit];
  78         u_char *ptr = m->m_data;
  79
  80         switch(*(ptr + OFF_MT))
  81         {
  82                 case MT_ID_ASSIGN:
  83                         if( (*(ptr + OFF_RIL) == l2sc->last_ril) &&
  84                             (*(ptr + OFF_RIH) == l2sc->last_rih))
  85                         {
  86                                 l2sc->tei = GET_TEIFROMAI(*(ptr+OFF_AI));
  87                                 l2sc->tei_valid = TEI_VALID;
  88
  89                                 if(l2sc->T202 == TIMER_ACTIVE)
  90                                         i4b_T202_stop(l2sc);
  91
  92                                 MDL_Status_Ind(l2sc->unit, STI_TEIASG, l2sc->tei);
  93
  94                                 log(LOG_INFO, "i4b: unit %d, assigned TEI = %d = 0x%02x\n", l2sc->unit, l2sc->tei, l2sc->tei);
  95
  96                                 NDBGL2(L2_TEI_MSG, "TEI ID Assign - TEI = %d", l2sc->tei);
  97
  98                                 i4b_next_l2state(l2sc, EV_MDASGRQ);
  99                         }
 100                         break;
 101
 102                 case MT_ID_DENY:
 103                         if( (*(ptr + OFF_RIL) == l2sc->last_ril) &&
 104                             (*(ptr + OFF_RIH) == l2sc->last_rih))
 105                         {
 106                                 l2sc->tei_valid = TEI_INVALID;
 107                                 l2sc->tei = GET_TEIFROMAI(*(ptr+OFF_AI));
 108
 109                                 if(l2sc->tei == GROUP_TEI)
 110                                 {
 111                                         log(LOG_WARNING, "i4b: unit %d, denied TEI, no TEI values available from exchange!\n", l2sc->unit);
 112                                         NDBGL2(L2_TEI_ERR, "TEI ID Denied, No TEI values available from exchange!");
 113                                 }
 114                                 else
 115                                 {
 116                                         log(LOG_WARNING, "i4b: unit %d, denied TEI = %d = 0x%02x\n", l2sc->unit, l2sc->tei, l2sc->tei);
 117                                         NDBGL2(L2_TEI_ERR, "TEI ID Denied - TEI = %d", l2sc->tei);
 118                                 }
 119                                 MDL_Status_Ind(l2sc->unit, STI_TEIASG, -1);
 120                                 i4b_next_l2state(l2sc, EV_MDERRRS);
 121                         }
 122                         break;
 123
 124                 case MT_ID_CHK_REQ:
 125                         if( (l2sc->tei_valid == TEI_VALID) &&
 126                             ( (l2sc->tei == GET_TEIFROMAI(*(ptr+OFF_AI))) ||
 127                               (GROUP_TEI == GET_TEIFROMAI(*(ptr+OFF_AI))) ))
 128                         {
 129                                 static int lasttei = -1;
 130
 131                                 if(l2sc->tei != lasttei)
 132                                 {
 133                                         NDBGL2(L2_TEI_MSG, "TEI ID Check Req - TEI = %d", l2sc->tei);
 134                                         lasttei = l2sc->tei;
 135                                 }
 136
 137                                 if(l2sc->T202 == TIMER_ACTIVE)
 138                                         i4b_T202_stop(l2sc);
 139                                 i4b_tei_chkresp(l2sc);
 140                         }
 141                         break;
 142
 143                 case MT_ID_REMOVE:
 144                         if( (l2sc->tei_valid == TEI_VALID) &&
 145                             ( (l2sc->tei == GET_TEIFROMAI(*(ptr+OFF_AI))) ||
 146                               (l2sc->tei == GET_TEIFROMAI(*(ptr+OFF_AI)))))
 147                         {
 148                                 l2sc->tei_valid = TEI_INVALID;
 149                                 l2sc->tei = GET_TEIFROMAI(*(ptr+OFF_AI));
 150
 151                                 log(LOG_INFO, "i4b: unit %d, removed TEI = %d = 0x%02x\n", l2sc->unit, l2sc->tei, l2sc->tei);
 152                                 NDBGL2(L2_TEI_MSG, "TEI ID Remove - TEI = %d", l2sc->tei);
 153                                 MDL_Status_Ind(l2sc->unit, STI_TEIASG, -1);
 154                                 i4b_next_l2state(l2sc, EV_MDREMRQ);
 155                         }
 156                         break;
 157
 158                 default:
 159                         NDBGL2(L2_TEI_ERR, "UNKNOWN TEI MGMT Frame, type = 0x%x", *(ptr + OFF_MT));
 160                         i4b_print_frame(m->m_len, m->m_data);
 161                         break;
 162         }
 163         i4b_Dfreembuf(m);
 164 }
 165
 166 /*---------------------------------------------------------------------------*
 167  *      allocate and fill up a TEI management frame for sending
 168  *---------------------------------------------------------------------------*/
 169 static struct mbuf *
 170 build_tei_mgmt_frame(l2_softc_t *l2sc, unsigned char type)
 171 {
 172         struct mbuf *m;
 173
 174         if((m = i4b_Dgetmbuf(TEI_MGMT_FRM_LEN)) == NULL)
 175                 return(NULL);
 176
 177         m->m_data[TEIM_SAPIO] = 0xfc;   /* SAPI = 63, CR = 0, EA = 0 */
 178         m->m_data[TEIM_TEIO]  = 0xff;   /* TEI = 127, EA = 1 */
 179         m->m_data[TEIM_UIO]   = UI;     /* UI */
 180         m->m_data[TEIM_MEIO]  = MEI;    /* MEI */
 181         m->m_data[TEIM_MTO]   = type;   /* message type */
 182
 183         switch(type)
 184         {
 185                 case MT_ID_REQEST:
 186                         i4b_make_rand_ri(l2sc);
 187                         m->m_data[TEIM_RILO] = l2sc->last_ril;
 188                         m->m_data[TEIM_RIHO] = l2sc->last_rih;
 189                         m->m_data[TEIM_AIO] = (GROUP_TEI << 1) | 0x01;
 190                         break;
 191
 192                 case MT_ID_CHK_RSP:
 193                         i4b_make_rand_ri(l2sc);
 194                         m->m_data[TEIM_RILO] = l2sc->last_ril;
 195                         m->m_data[TEIM_RIHO] = l2sc->last_rih;
 196                         m->m_data[TEIM_AIO] = (l2sc->tei << 1) | 0x01;
 197                         break;
 198
 199                 case MT_ID_VERIFY:
 200                         m->m_data[TEIM_RILO] = 0;
 201                         m->m_data[TEIM_RIHO] = 0;
 202                         m->m_data[TEIM_AIO] = (l2sc->tei << 1) | 0x01;
 203                         break;
 204
 205                 default:
 206                         i4b_Dfreembuf(m);
 207                         panic("build_tei_mgmt_frame: invalid type");
 208                         break;
 209         }
 210         l2sc->stat.tx_tei++;
 211         return(m);
 212 }
 213
 214 /*---------------------------------------------------------------------------*
 215  *      i4b_tei_assign - TEI assignment procedure (Q.921, 5.3.2, pp 24)
 216  *      T202func and N202 _MUST_ be set prior to calling this function !
 217  *---------------------------------------------------------------------------*/
 218 void
 219 i4b_tei_assign(l2_softc_t *l2sc)
 220 {
 221         struct mbuf *m;
 222
 223         NDBGL2(L2_TEI_MSG, "tx TEI ID_Request");
 224
 225         m = build_tei_mgmt_frame(l2sc, MT_ID_REQEST);
 226
 227         if(m == NULL)
 228                 panic("i4b_tei_assign: no mbuf");
 229
 230         i4b_T202_start(l2sc);
 231
 232         PH_Data_Req(l2sc->unit, m, MBUF_FREE);
 233 }
 234
 235 /*---------------------------------------------------------------------------*
 236  *      i4b_tei_assign - TEI verify procedure (Q.921, 5.3.5, pp 29)
 237  *      T202func and N202 _MUST_ be set prior to calling this function !
 238  *---------------------------------------------------------------------------*/
 239 void
 240 i4b_tei_verify(l2_softc_t *l2sc)
 241 {
 242         struct mbuf *m;
 243
 244         NDBGL2(L2_TEI_MSG, "tx TEI ID_Verify");
 245
 246         m = build_tei_mgmt_frame(l2sc, MT_ID_VERIFY);
 247
 248         if(m == NULL)
 249                 panic("i4b_tei_verify: no mbuf");
 250
 251         i4b_T202_start(l2sc);
 252
 253         PH_Data_Req(l2sc->unit, m, MBUF_FREE);
 254 }
 255
 256 /*---------------------------------------------------------------------------*
 257  *      i4b_tei_chkresp - TEI check response procedure (Q.921, 5.3.5, pp 29)
 258  *---------------------------------------------------------------------------*/
 259 void
 260 i4b_tei_chkresp(l2_softc_t *l2sc)
 261 {
 262         struct mbuf *m;
 263         static int lasttei = 0;
 264
 265         if(l2sc->tei != lasttei)
 266         {
 267                 lasttei = l2sc->tei;
 268                 NDBGL2(L2_TEI_MSG, "tx TEI ID_Check_Response");
 269         }
 270
 271         m = build_tei_mgmt_frame(l2sc, MT_ID_CHK_RSP);
 272
 273         if(m == NULL)
 274                 panic("i4b_tei_chkresp: no mbuf");
 275
 276         PH_Data_Req(l2sc->unit, m, MBUF_FREE);
 277 }
 278
 279 /*---------------------------------------------------------------------------*
 280  *      generate some 16 bit "random" number used for TEI mgmt Ri field
 281  *---------------------------------------------------------------------------*/
 282 void
 283 i4b_make_rand_ri(l2_softc_t *l2sc)
 284 {
 285
 286 #if defined(__FreeBSD__)
 287
 288         u_short val;
 289
 290 #ifdef RANDOMDEV
 291         read_random((char *)&val, sizeof(val));
 292 #else
 293         val = (u_short)random();
 294 #endif /* RANDOMDEV */
 295
 296 #else
 297
 298         register u_short val;
 299         register int i;
 300         static int called = 42;
 301
 302         val = (l2sc->last_rih << 8) | l2sc->last_ril;
 303
 304         val += ++called;
 305
 306         for(i=0; i < 50 ; i++, val++)
 307         {
 308                 val |= l2sc->unit+i;
 309                 val <<= i;
 310                 val ^= (time.tv_sec >> 16) ^ time.tv_usec;
 311                 val <<= i;
 312                 val ^= time.tv_sec ^ (time.tv_usec >> 16);
 313
 314                 if(val != 0 && val != 0xffff)
 315                         break;
 316         }
 317 #endif
 318         l2sc->last_rih = (val >> 8) & 0x00ff;
 319         l2sc->last_ril = val & 0x00ff;
 320 }
 321
 322 #endif /* NI4BQ921 > 0 */