2 * llc_station.c - station component of LLC
4 * Copyright (c) 1997 by Procom Technology, Inc.
5 * 2001-2003 by Arnaldo Carvalho de Melo <acme@conectiva.com.br>
7 * This program can be redistributed or modified under the terms of the
8 * GNU General Public License as published by the Free Software Foundation.
9 * This program is distributed without any warranty or implied warranty
10 * of merchantability or fitness for a particular purpose.
12 * See the GNU General Public License for more details.
14 #include <linux/init.h>
15 #include <linux/module.h>
16 #include <linux/slab.h>
18 #include <net/llc_sap.h>
19 #include <net/llc_conn.h>
20 #include <net/llc_c_ac.h>
21 #include <net/llc_s_ac.h>
22 #include <net/llc_c_ev.h>
23 #include <net/llc_c_st.h>
24 #include <net/llc_s_ev.h>
25 #include <net/llc_s_st.h>
26 #include <net/llc_pdu.h>
29 * struct llc_station - LLC station component
31 * SAP and connection resource manager, one per adapter.
33 * @mac_sa: MAC source address
34 * @sap_list: list of related SAPs
35 * @ev_q: events entering state mach.
36 * @mac_pdu_q: PDUs ready to send to MAC
40 struct sk_buff_head list;
43 struct sk_buff_head mac_pdu_q;
46 typedef int (*llc_station_ev_t)(struct sk_buff *skb);
48 typedef int (*llc_station_action_t)(struct sk_buff *skb);
50 /* Station component state table structure */
51 struct llc_station_state_trans {
53 llc_station_action_t *ev_actions;
56 static struct llc_station llc_main_station;
58 static int llc_stat_ev_rx_null_dsap_xid_c(struct sk_buff *skb)
60 struct llc_pdu_un *pdu = llc_pdu_un_hdr(skb);
62 return LLC_PDU_IS_CMD(pdu) && /* command PDU */
63 LLC_PDU_TYPE_IS_U(pdu) && /* U type PDU */
64 LLC_U_PDU_CMD(pdu) == LLC_1_PDU_CMD_XID &&
65 !pdu->dsap ? 0 : 1; /* NULL DSAP value */
68 static int llc_stat_ev_rx_null_dsap_test_c(struct sk_buff *skb)
70 struct llc_pdu_un *pdu = llc_pdu_un_hdr(skb);
72 return LLC_PDU_IS_CMD(pdu) && /* command PDU */
73 LLC_PDU_TYPE_IS_U(pdu) && /* U type PDU */
74 LLC_U_PDU_CMD(pdu) == LLC_1_PDU_CMD_TEST &&
75 !pdu->dsap ? 0 : 1; /* NULL DSAP */
79 * llc_station_send_pdu - queues PDU to send
80 * @skb: Address of the PDU
82 * Queues a PDU to send to the MAC layer.
84 static void llc_station_send_pdu(struct sk_buff *skb)
86 skb_queue_tail(&llc_main_station.mac_pdu_q, skb);
87 while ((skb = skb_dequeue(&llc_main_station.mac_pdu_q)) != NULL)
88 if (dev_queue_xmit(skb))
92 static int llc_station_ac_send_xid_r(struct sk_buff *skb)
94 u8 mac_da[ETH_ALEN], dsap;
96 struct sk_buff *nskb = llc_alloc_frame(NULL, skb->dev, LLC_PDU_TYPE_U,
97 sizeof(struct llc_xid_info));
102 llc_pdu_decode_sa(skb, mac_da);
103 llc_pdu_decode_ssap(skb, &dsap);
104 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, 0, dsap, LLC_PDU_RSP);
105 llc_pdu_init_as_xid_rsp(nskb, LLC_XID_NULL_CLASS_2, 127);
106 rc = llc_mac_hdr_init(nskb, skb->dev->dev_addr, mac_da);
109 llc_station_send_pdu(nskb);
117 static int llc_station_ac_send_test_r(struct sk_buff *skb)
119 u8 mac_da[ETH_ALEN], dsap;
122 struct sk_buff *nskb;
124 /* The test request command is type U (llc_len = 3) */
125 data_size = ntohs(eth_hdr(skb)->h_proto) - 3;
126 nskb = llc_alloc_frame(NULL, skb->dev, LLC_PDU_TYPE_U, data_size);
131 llc_pdu_decode_sa(skb, mac_da);
132 llc_pdu_decode_ssap(skb, &dsap);
133 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, 0, dsap, LLC_PDU_RSP);
134 llc_pdu_init_as_test_rsp(nskb, skb);
135 rc = llc_mac_hdr_init(nskb, skb->dev->dev_addr, mac_da);
138 llc_station_send_pdu(nskb);
146 /* state transition for LLC_STATION_EV_RX_NULL_DSAP_XID_C event */
147 static llc_station_action_t llc_stat_up_state_actions_2[] = {
148 [0] = llc_station_ac_send_xid_r,
152 static struct llc_station_state_trans llc_stat_up_state_trans_2 = {
153 .ev = llc_stat_ev_rx_null_dsap_xid_c,
154 .ev_actions = llc_stat_up_state_actions_2,
157 /* state transition for LLC_STATION_EV_RX_NULL_DSAP_TEST_C event */
158 static llc_station_action_t llc_stat_up_state_actions_3[] = {
159 [0] = llc_station_ac_send_test_r,
163 static struct llc_station_state_trans llc_stat_up_state_trans_3 = {
164 .ev = llc_stat_ev_rx_null_dsap_test_c,
165 .ev_actions = llc_stat_up_state_actions_3,
168 /* array of pointers; one to each transition */
169 static struct llc_station_state_trans *llc_stat_up_state_trans [] = {
170 &llc_stat_up_state_trans_2,
171 &llc_stat_up_state_trans_3,
176 * llc_exec_station_trans_actions - executes actions for transition
177 * @trans: Address of the transition
178 * @skb: Address of the event that caused the transition
180 * Executes actions of a transition of the station state machine. Returns
181 * 0 if all actions complete successfully, nonzero otherwise.
183 static u16 llc_exec_station_trans_actions(struct llc_station_state_trans *trans,
187 llc_station_action_t *next_action = trans->ev_actions;
189 for (; next_action && *next_action; next_action++)
190 if ((*next_action)(skb))
196 * llc_find_station_trans - finds transition for this event
197 * @skb: Address of the event
199 * Search thru events of the current state of the station until list
200 * exhausted or it's obvious that the event is not valid for the current
201 * state. Returns the address of the transition if cound, %NULL otherwise.
203 static struct llc_station_state_trans *
204 llc_find_station_trans(struct sk_buff *skb)
207 struct llc_station_state_trans *rc = NULL;
208 struct llc_station_state_trans **next_trans;
210 for (next_trans = llc_stat_up_state_trans; next_trans[i]; i++)
211 if (!next_trans[i]->ev(skb)) {
219 * llc_station_free_ev - frees an event
220 * @skb: Address of the event
224 static void llc_station_free_ev(struct sk_buff *skb)
230 * llc_station_next_state - processes event and goes to the next state
231 * @skb: Address of the event
233 * Processes an event, executes any transitions related to that event and
234 * updates the state of the station.
236 static u16 llc_station_next_state(struct sk_buff *skb)
239 struct llc_station_state_trans *trans;
241 trans = llc_find_station_trans(skb);
243 /* got the state to which we next transition; perform the
244 * actions associated with this transition before actually
245 * transitioning to the next state
247 rc = llc_exec_station_trans_actions(trans, skb);
249 /* event not recognized in current state; re-queue it for
250 * processing again at a later time; return failure
253 llc_station_free_ev(skb);
258 * llc_station_service_events - service events in the queue
260 * Get an event from the station event queue (if any); attempt to service
261 * the event; if event serviced, get the next event (if any) on the event
262 * queue; if event not service, re-queue the event on the event queue and
263 * attempt to service the next event; when serviced all events in queue,
264 * finished; if don't transition to different state, just service all
265 * events once; if transition to new state, service all events again.
266 * Caller must hold llc_main_station.ev_q.lock.
268 static void llc_station_service_events(void)
272 while ((skb = skb_dequeue(&llc_main_station.ev_q.list)) != NULL)
273 llc_station_next_state(skb);
277 * llc_station_state_process - queue event and try to process queue.
278 * @skb: Address of the event
280 * Queues an event (on the station event queue) for handling by the
281 * station state machine and attempts to process any queued-up events.
283 static void llc_station_state_process(struct sk_buff *skb)
285 spin_lock_bh(&llc_main_station.ev_q.lock);
286 skb_queue_tail(&llc_main_station.ev_q.list, skb);
287 llc_station_service_events();
288 spin_unlock_bh(&llc_main_station.ev_q.lock);
292 * llc_station_rcv - send received pdu to the station state machine
293 * @skb: received frame.
295 * Sends data unit to station state machine.
297 static void llc_station_rcv(struct sk_buff *skb)
299 llc_station_state_process(skb);
302 void __init llc_station_init(void)
304 skb_queue_head_init(&llc_main_station.mac_pdu_q);
305 skb_queue_head_init(&llc_main_station.ev_q.list);
306 spin_lock_init(&llc_main_station.ev_q.lock);
307 llc_set_station_handler(llc_station_rcv);
310 void llc_station_exit(void)
312 llc_set_station_handler(NULL);