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_sframe.c - s frame handling routines
28 * ----------------------------------------
29 *
30 * $Id: i4b_sframe.c,v 1.1 2003/04/06 04:37:51 tg Exp $
31 *
32 * $FreeBSD$
33 *
34 * last edit-date: [Fri Jan 5 11:33:47 2001]
35 *
36 *---------------------------------------------------------------------------*/
37
38 #include <sys/cdefs.h>
39 __KERNEL_RCSID(0, "$NetBSD: i4b_sframe.c,v 1.5 2002/05/21 10:31:11 martin Exp $");
40
41 #ifdef __FreeBSD__
42 #include "i4bq921.h"
43 #else
44 #define NI4BQ921 1
45 #endif
46 #if NI4BQ921 > 0
47
48 #include <sys/param.h>
49 #include <sys/kernel.h>
50 #include <sys/systm.h>
51 #include <sys/mbuf.h>
52 #include <sys/socket.h>
53 #include <net/if.h>
54
55 #include <sys/timeout.h>
56
57 #ifdef __FreeBSD__
58 #include <machine/i4b_debug.h>
59 #include <machine/i4b_ioctl.h>
60 #else
61 #include <netisdn/i4b_debug.h>
62 #include <netisdn/i4b_ioctl.h>
63 #endif
64
65 #include <netisdn/i4b_l2.h>
66 #include <netisdn/i4b_l1l2.h>
67 #include <netisdn/i4b_isdnq931.h>
68 #include <netisdn/i4b_mbuf.h>
69 #include <netisdn/i4b_l2fsm.h>
70 #include <netisdn/i4b_l3l4.h>
71
72 /*---------------------------------------------------------------------------*
73 * process s frame
74 *---------------------------------------------------------------------------*/
75 void
i4b_rxd_s_frame(l2_softc_t * l2sc,struct isdn_l3_driver * drv,struct mbuf * m)76 i4b_rxd_s_frame(l2_softc_t *l2sc, struct isdn_l3_driver *drv, struct mbuf *m)
77 {
78 u_char *ptr = m->m_data;
79
80 if(!((l2sc->tei_valid == TEI_VALID) &&
81 (l2sc->tei == GETTEI(*(ptr+OFF_TEI)))))
82 {
83 i4b_Dfreembuf(m);
84 return;
85 }
86
87 l2sc->rxd_CR = GETCR(*(ptr + OFF_SAPI));
88 l2sc->rxd_PF = GETSPF(*(ptr + OFF_SNR));
89 l2sc->rxd_NR = GETSNR(*(ptr + OFF_SNR));
90
91 i4b_rxd_ack(l2sc, drv, l2sc->rxd_NR);
92
93 switch(*(ptr + OFF_SRCR))
94 {
95 case RR:
96 l2sc->stat.rx_rr++; /* update statistics */
97 NDBGL2(L2_S_MSG, "rx'd RR, N(R) = %d", l2sc->rxd_NR);
98 i4b_next_l2state(l2sc, drv, EV_RXRR);
99 break;
100
101 case RNR:
102 l2sc->stat.rx_rnr++; /* update statistics */
103 NDBGL2(L2_S_MSG, "rx'd RNR, N(R) = %d", l2sc->rxd_NR);
104 i4b_next_l2state(l2sc, drv, EV_RXRNR);
105 break;
106
107 case REJ:
108 l2sc->stat.rx_rej++; /* update statistics */
109 NDBGL2(L2_S_MSG, "rx'd REJ, N(R) = %d", l2sc->rxd_NR);
110 i4b_next_l2state(l2sc, drv, EV_RXREJ);
111 break;
112
113 default:
114 l2sc->stat.err_rx_bads++; /* update statistics */
115 NDBGL2(L2_S_ERR, "ERROR, unknown code, frame = ");
116 i4b_print_frame(m->m_len, m->m_data);
117 break;
118 }
119 i4b_Dfreembuf(m);
120 }
121
122 /*---------------------------------------------------------------------------*
123 * transmit RR command
124 *---------------------------------------------------------------------------*/
125 void
i4b_tx_rr_command(l2_softc_t * l2sc,pbit_t pbit)126 i4b_tx_rr_command(l2_softc_t *l2sc, pbit_t pbit)
127 {
128 struct mbuf *m;
129
130 NDBGL2(L2_S_MSG, "tx RR, isdnif = %d", l2sc->drv->isdnif);
131
132 m = i4b_build_s_frame(l2sc, CR_CMD_TO_NT, pbit, RR);
133
134 l2sc->driver->ph_data_req(l2sc->l1_token, m, MBUF_FREE);
135
136 l2sc->stat.tx_rr++; /* update statistics */
137 }
138
139 /*---------------------------------------------------------------------------*
140 * transmit RR response
141 *---------------------------------------------------------------------------*/
142 void
i4b_tx_rr_response(l2_softc_t * l2sc,fbit_t fbit)143 i4b_tx_rr_response(l2_softc_t *l2sc, fbit_t fbit)
144 {
145 struct mbuf *m;
146
147 NDBGL2(L2_S_MSG, "tx RR, isdnif = %d", l2sc->drv->isdnif);
148
149 m = i4b_build_s_frame(l2sc, CR_RSP_TO_NT, fbit, RR);
150
151 l2sc->driver->ph_data_req(l2sc->l1_token, m, MBUF_FREE);
152
153 l2sc->stat.tx_rr++; /* update statistics */
154 }
155
156 /*---------------------------------------------------------------------------*
157 * transmit RNR command
158 *---------------------------------------------------------------------------*/
159 void
i4b_tx_rnr_command(l2_softc_t * l2sc,pbit_t pbit)160 i4b_tx_rnr_command(l2_softc_t *l2sc, pbit_t pbit)
161 {
162 struct mbuf *m;
163
164 NDBGL2(L2_S_MSG, "tx RNR, isdnif = %d", l2sc->drv->isdnif);
165
166 m = i4b_build_s_frame(l2sc, CR_CMD_TO_NT, pbit, RNR);
167
168 l2sc->driver->ph_data_req(l2sc->l1_token, m, MBUF_FREE);
169
170 l2sc->stat.tx_rnr++; /* update statistics */
171 }
172
173 /*---------------------------------------------------------------------------*
174 * transmit RNR response
175 *---------------------------------------------------------------------------*/
176 void
i4b_tx_rnr_response(l2_softc_t * l2sc,fbit_t fbit)177 i4b_tx_rnr_response(l2_softc_t *l2sc, fbit_t fbit)
178 {
179 struct mbuf *m;
180
181 NDBGL2(L2_S_MSG, "tx RNR, isdnif = %d", l2sc->drv->isdnif);
182
183 m = i4b_build_s_frame(l2sc, CR_RSP_TO_NT, fbit, RNR);
184
185 l2sc->driver->ph_data_req(l2sc->l1_token, m, MBUF_FREE);
186
187 l2sc->stat.tx_rnr++; /* update statistics */
188 }
189
190 /*---------------------------------------------------------------------------*
191 * transmit REJ response
192 *---------------------------------------------------------------------------*/
193 void
i4b_tx_rej_response(l2_softc_t * l2sc,fbit_t fbit)194 i4b_tx_rej_response(l2_softc_t *l2sc, fbit_t fbit)
195 {
196 struct mbuf *m;
197
198 NDBGL2(L2_S_MSG, "tx REJ, isdnif = %d", l2sc->drv->isdnif);
199
200 m = i4b_build_s_frame(l2sc, CR_RSP_TO_NT, fbit, REJ);
201
202 l2sc->driver->ph_data_req(l2sc->l1_token, m, MBUF_FREE);
203
204 l2sc->stat.tx_rej++; /* update statistics */
205 }
206
207 /*---------------------------------------------------------------------------*
208 * build S-frame for sending
209 *---------------------------------------------------------------------------*/
210 struct mbuf *
i4b_build_s_frame(l2_softc_t * l2sc,crbit_to_nt_t crbit,pbit_t pbit,u_char type)211 i4b_build_s_frame(l2_softc_t *l2sc, crbit_to_nt_t crbit, pbit_t pbit, u_char type)
212 {
213 struct mbuf *m;
214
215 if((m = i4b_Dgetmbuf(S_FRAME_LEN)) == NULL)
216 return(NULL);
217
218 PUTSAPI(SAPI_CCP, crbit, m->m_data[OFF_SAPI]);
219
220 PUTTEI(l2sc->tei, m->m_data[OFF_TEI]);
221
222 m->m_data[OFF_SRCR] = type;
223
224 m->m_data[OFF_SNR] = (l2sc->vr << 1) | (pbit & 0x01);
225
226 return(m);
227 }
228
229 #endif /* NI4BQ921 > 0 */
230