Subversion Repositories or1k

/*
 *	ROSE release 003
 *
 *	This code REQUIRES 2.1.0 or higher/ NET3.029
 *
 *	This module:
 *		This module is free software; you can redistribute it and/or
 *		modify it under the terms of the GNU General Public License
 *		as published by the Free Software Foundation; either version
 *		2 of the License, or (at your option) any later version.
 *
 *	Most of this code is based on the SDL diagrams published in the 7th
 *	ARRL Computer Networking Conference papers. The diagrams have mistakes
 *	in them, but are mostly correct. Before you modify the code could you
 *	read the SDL diagrams as the code is not obvious and probably very
 *	easy to break;
 *
 *	History
 *	ROSE 001	Jonathan(G4KLX)	Cloned from nr_in.c
 */
 
#include <linux/config.h>
#if defined(CONFIG_ROSE) || defined(CONFIG_ROSE_MODULE)
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/socket.h>
#include <linux/in.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/timer.h>
#include <linux/string.h>
#include <linux/sockios.h>
#include <linux/net.h>
#include <net/ax25.h>
#include <linux/inet.h>
#include <linux/netdevice.h>
#include <linux/skbuff.h>
#include <net/sock.h>
#include <net/ip.h>			/* For ip_rcv */
#include <asm/segment.h>
#include <asm/system.h>
#include <linux/fcntl.h>
#include <linux/mm.h>
#include <linux/interrupt.h>
#include <net/rose.h>
 
static int rose_queue_rx_frame(struct sock *sk, struct sk_buff *skb, int more)
{
	struct sk_buff *skbo, *skbn = skb;
 
	if (more) {
		sk->protinfo.rose->fraglen += skb->len;
		skb_queue_tail(&sk->protinfo.rose->frag_queue, skb);
		return 0;
	}
 
	if (!more && sk->protinfo.rose->fraglen > 0) {	/* End of fragment */
		sk->protinfo.rose->fraglen += skb->len;
		skb_queue_tail(&sk->protinfo.rose->frag_queue, skb);
 
		if ((skbn = alloc_skb(sk->protinfo.rose->fraglen, GFP_ATOMIC)) == NULL)
			return 1;
 
		skbn->free = 1;
		skbn->arp  = 1;
		skbn->sk   = sk;
		skbn->h.raw = skbn->data;
 
		skbo = skb_dequeue(&sk->protinfo.rose->frag_queue);
		memcpy(skb_put(skbn, skbo->len), skbo->data, skbo->len);
		kfree_skb(skbo, FREE_READ);
 
		while ((skbo = skb_dequeue(&sk->protinfo.rose->frag_queue)) != NULL) {
			skb_pull(skbo, ROSE_MIN_LEN);
			memcpy(skb_put(skbn, skbo->len), skbo->data, skbo->len);
			kfree_skb(skbo, FREE_READ);
		}
 
		sk->protinfo.rose->fraglen = 0;		
	}
 
	/* printk("FBB : lg=%ld\n", skbn->len); */
	return sock_queue_rcv_skb(sk, skbn);
}
 
/*
 * State machine for state 1, Awaiting Call Accepted State.
 * The handling of the timer(s) is in file rose_timer.c.
 * Handling of state 0 and connection release is in af_rose.c.
 */
static int rose_state1_machine(struct sock *sk, struct sk_buff *skb, int frametype)
{
	int len;
 
	switch (frametype) {
 
		case ROSE_CALL_ACCEPTED:
			sk->protinfo.rose->condition = 0x00;
			sk->protinfo.rose->timer     = 0;
			sk->protinfo.rose->vs        = 0;
			sk->protinfo.rose->va        = 0;
			sk->protinfo.rose->vr        = 0;
			sk->protinfo.rose->vl        = 0;
			sk->protinfo.rose->state     = ROSE_STATE_3;
			sk->state                    = TCP_ESTABLISHED;
			if (!sk->dead)
				sk->state_change(sk);
			break;
 
		case ROSE_CLEAR_REQUEST:
			rose_clear_queues(sk);
			rose_write_internal(sk, ROSE_CLEAR_CONFIRMATION);
			sk->protinfo.rose->neighbour->use--;
			sk->protinfo.rose->cause      = skb->data[3];
			sk->protinfo.rose->diagnostic = skb->data[4];
			sk->protinfo.rose->state = ROSE_STATE_0;
			sk->state                = TCP_CLOSE;
			sk->err                  = ECONNREFUSED;
			sk->shutdown            |= SEND_SHUTDOWN;
			if (!sk->dead)
				sk->state_change(sk);
			sk->dead                 = 1;
			len = 5;	/* Minimum size of the frame data */
			if (skb->len > len) {
				/* Address block */
				len += 1;
				len += (((skb->data[5] >> 4) & 0x0F) + 1) / 2;
				len += (((skb->data[5] >> 0) & 0x0F) + 1) / 2;
 
				if (skb->len > len) {
					/* Facilities */
					rose_parse_facilities(skb->data + len, &sk->protinfo.rose->facilities);
				}
			}
			break;
 
		default:
			break;
	}
 
	return 0;
}
 
/*
 * State machine for state 2, Awaiting Clear Confirmation State.
 * The handling of the timer(s) is in file rose_timer.c
 * Handling of state 0 and connection release is in af_rose.c.
 */
static int rose_state2_machine(struct sock *sk, struct sk_buff *skb, int frametype)
{
	int len;
 
	switch (frametype) {
 
		case ROSE_CLEAR_REQUEST:
			rose_write_internal(sk, ROSE_CLEAR_CONFIRMATION);
			sk->protinfo.rose->cause      = skb->data[3];
			sk->protinfo.rose->diagnostic = skb->data[4];
			len = 5;
			if (skb->len > len) {
				/* Address block */
				len += 1;
				len += (((skb->data[5] >> 4) & 0x0F) + 1) / 2;
				len += (((skb->data[5] >> 0) & 0x0F) + 1) / 2;
 
				if (skb->len > len) {
					/* Facilities */
					rose_parse_facilities(skb->data + len, &sk->protinfo.rose->facilities);
				}
			}
			/* fall in next case ... */
		case ROSE_CLEAR_CONFIRMATION:
			rose_clear_queues(sk);
			sk->protinfo.rose->neighbour->use--;
			sk->protinfo.rose->state = ROSE_STATE_0;
			sk->state                = TCP_CLOSE;
			sk->err                  = 0;
			sk->shutdown            |= SEND_SHUTDOWN;
			if (!sk->dead)
				sk->state_change(sk);
			sk->dead                 = 1;
			break;
 
		default:
			break;
	}
 
	return 0;
}
 
/*
 * State machine for state 3, Connected State.
 * The handling of the timer(s) is in file rose_timer.c
 * Handling of state 0 and connection release is in af_rose.c.
 */
static int rose_state3_machine(struct sock *sk, struct sk_buff *skb, int frametype, int ns, int nr, int q, int d, int m)
{
	int queued = 0;
	int len;
 
	switch (frametype) {
 
		case ROSE_RESET_REQUEST:
			rose_write_internal(sk, ROSE_RESET_CONFIRMATION);
			sk->protinfo.rose->condition = 0x00;
			sk->protinfo.rose->timer     = 0;
			sk->protinfo.rose->vs        = 0;
			sk->protinfo.rose->vr        = 0;
			sk->protinfo.rose->va        = 0;
			sk->protinfo.rose->vl        = 0;
			break;
 
		case ROSE_CLEAR_REQUEST:
			rose_clear_queues(sk);
			rose_write_internal(sk, ROSE_CLEAR_CONFIRMATION);
			sk->protinfo.rose->neighbour->use--;
			sk->protinfo.rose->cause      = skb->data[3];
			sk->protinfo.rose->diagnostic = skb->data[4];
			sk->protinfo.rose->state = ROSE_STATE_0;
			sk->state                = TCP_CLOSE;
			sk->err                  = 0;
			sk->shutdown            |= SEND_SHUTDOWN;
			if (!sk->dead)
				sk->state_change(sk);
			sk->dead                 = 1;
			len = 5;
			if (skb->len > len) {
				/* Address block */
				len += 1;
				len += (((skb->data[5] >> 4) & 0x0F) + 1) / 2;
				len += (((skb->data[5] >> 0) & 0x0F) + 1) / 2;
 
				if (skb->len > len) {
					/* Facilities */
					rose_parse_facilities(skb->data + len, &sk->protinfo.rose->facilities);
				}
			}
			break;
 
		case ROSE_RR:
		case ROSE_RNR:
			if (!rose_validate_nr(sk, nr)) {
				rose_clear_queues(sk);
				rose_write_internal(sk, ROSE_RESET_REQUEST);
				sk->protinfo.rose->condition = 0x00;
				sk->protinfo.rose->vs        = 0;
				sk->protinfo.rose->vr        = 0;
				sk->protinfo.rose->va        = 0;
				sk->protinfo.rose->vl        = 0;
				sk->protinfo.rose->state     = ROSE_STATE_4;
				sk->protinfo.rose->timer     = sk->protinfo.rose->t2;
			} else {
				rose_frames_acked(sk, nr);
				/* F6FBB : only set the flag ! */
				if (frametype == ROSE_RNR)
					sk->protinfo.rose->condition |= ROSE_COND_PEER_RX_BUSY;
				else {
					sk->protinfo.rose->condition &= ~ROSE_COND_PEER_RX_BUSY;
				}
			}
			break;
 
		case ROSE_DATA:	/* XXX */
			sk->protinfo.rose->condition &= ~ROSE_COND_PEER_RX_BUSY;
			if (!rose_validate_nr(sk, nr)) {
				rose_clear_queues(sk);
				rose_write_internal(sk, ROSE_RESET_REQUEST);
				sk->protinfo.rose->condition = 0x00;
				sk->protinfo.rose->vs        = 0;
				sk->protinfo.rose->vr        = 0;
				sk->protinfo.rose->va        = 0;
				sk->protinfo.rose->vl        = 0;
				sk->protinfo.rose->state     = ROSE_STATE_4;
				sk->protinfo.rose->timer     = sk->protinfo.rose->t2;
				break;
			}
			rose_frames_acked(sk, nr);
			if (ns == sk->protinfo.rose->vr) {
				if (rose_queue_rx_frame(sk, skb, m) == 0) {
					sk->protinfo.rose->vr = (sk->protinfo.rose->vr + 1) % ROSE_MODULUS;
					queued = 1;
				} else {
					/* should never happen ! */
					rose_clear_queues(sk);
					rose_write_internal(sk, ROSE_RESET_REQUEST);
					sk->protinfo.rose->condition = 0x00;
					sk->protinfo.rose->vs        = 0;
					sk->protinfo.rose->vr        = 0;
					sk->protinfo.rose->va        = 0;
					sk->protinfo.rose->vl        = 0;
					sk->protinfo.rose->state     = ROSE_STATE_4;
					sk->protinfo.rose->timer     = sk->protinfo.rose->t2;
					break;
				}
				/* F6FBB : check if room enough for a full window */
				if (sk->rmem_alloc > (sk->rcvbuf - ROSE_MAX_WINDOW_LEN)) {
					sk->protinfo.rose->condition |= ROSE_COND_OWN_RX_BUSY;
				}
			}
			/*
			 * If the window is full, ack the frame, else start the
			 * acknowledge hold back timer.
			 */
			if (((sk->protinfo.rose->vl + sysctl_rose_window_size) % ROSE_MODULUS) == sk->protinfo.rose->vr) {
				sk->protinfo.rose->condition &= ~ROSE_COND_ACK_PENDING;
				sk->protinfo.rose->timer      = 0;
				rose_enquiry_response(sk);
			} else {
				sk->protinfo.rose->condition |= ROSE_COND_ACK_PENDING;
				sk->protinfo.rose->timer      = sk->protinfo.rose->hb;
			}
			break;
 
		default:
			printk(KERN_WARNING "rose: unknown %02X in state 3\n", frametype);
			break;
	}
 
	return queued;
}
 
/*
 * State machine for state 4, Awaiting Reset Confirmation State.
 * The handling of the timer(s) is in file rose_timer.c
 * Handling of state 0 and connection release is in af_rose.c.
 */
static int rose_state4_machine(struct sock *sk, struct sk_buff *skb, int frametype)
{
	int len;
 
	switch (frametype) {
 
		case ROSE_RESET_REQUEST:
			rose_write_internal(sk, ROSE_RESET_CONFIRMATION);
		case ROSE_RESET_CONFIRMATION:
			sk->protinfo.rose->timer     = 0;
			sk->protinfo.rose->condition = 0x00;
			sk->protinfo.rose->va        = 0;
			sk->protinfo.rose->vr        = 0;
			sk->protinfo.rose->vs        = 0;
			sk->protinfo.rose->vl        = 0;
			sk->protinfo.rose->state     = ROSE_STATE_3;
			break;
 
		case ROSE_CLEAR_REQUEST:
			rose_clear_queues(sk);
			rose_write_internal(sk, ROSE_CLEAR_CONFIRMATION);
			sk->protinfo.rose->neighbour->use--;
			sk->protinfo.rose->cause      = skb->data[3];
			sk->protinfo.rose->diagnostic = skb->data[4];
			sk->protinfo.rose->timer = 0;
			sk->protinfo.rose->state = ROSE_STATE_0;
			sk->state                = TCP_CLOSE;
			sk->err                  = 0;
			sk->shutdown            |= SEND_SHUTDOWN;
			if (!sk->dead)
				sk->state_change(sk);
			sk->dead                 = 1;
			len = 5;
			if (skb->len > len) {
				/* Address block */
				len += 1;
				len += (((skb->data[5] >> 4) & 0x0F) + 1) / 2;
				len += (((skb->data[5] >> 0) & 0x0F) + 1) / 2;
 
				if (skb->len > len) {
					/* Facilities */
					rose_parse_facilities(skb->data + len, &sk->protinfo.rose->facilities);
				}
			}
			break;
 
		default:
			break;
	}
 
	return 0;
}
 
/*
 * State machine for state 5, Awaiting Call Acceptance State.
 * The handling of the timer(s) is in file rose_timer.c
 * Handling of state 0 and connection release is in af_rose.c.
 */
static int rose_state5_machine(struct sock *sk, struct sk_buff *skb, int frametype)
{
	int len;
 
	switch (frametype) {
 
		case ROSE_CLEAR_REQUEST:
			rose_clear_queues(sk);
			rose_write_internal(sk, ROSE_CLEAR_CONFIRMATION);
			sk->protinfo.rose->neighbour->use--;
			sk->protinfo.rose->cause      = skb->data[3];
			sk->protinfo.rose->diagnostic = skb->data[4];
			sk->protinfo.rose->state = ROSE_STATE_0;
			sk->state                = TCP_CLOSE;
			sk->err                  = 0;
			sk->shutdown            |= SEND_SHUTDOWN;
			if (!sk->dead)
				sk->state_change(sk);
			sk->dead                 = 1;
			len = 5;
			if (skb->len > len) {
				/* Address block */
				len += 1;
				len += (((skb->data[5] >> 4) & 0x0F) + 1) / 2;
				len += (((skb->data[5] >> 0) & 0x0F) + 1) / 2;
 
				if (skb->len > len) {
					/* Facilities */
					rose_parse_facilities(skb->data + len, &sk->protinfo.rose->facilities);
				}
			}
			break;
	}
 
	return 0;
}
 
/* Higher level upcall for a LAPB frame */
int rose_process_rx_frame(struct sock *sk, struct sk_buff *skb)
{
	int queued = 0, frametype, ns, nr, q, d, m;
 
	if (sk->protinfo.rose->state == ROSE_STATE_0)
		return 0;
 
	del_timer(&sk->timer);
 
	frametype = rose_decode(skb, &ns, &nr, &q, &d, &m);
 
	switch (sk->protinfo.rose->state) {
		case ROSE_STATE_1:
			queued = rose_state1_machine(sk, skb, frametype);
			break;
		case ROSE_STATE_2:
			queued = rose_state2_machine(sk, skb, frametype);
			break;
		case ROSE_STATE_3:
			queued = rose_state3_machine(sk, skb, frametype, ns, nr, q, d, m);
			break;
		case ROSE_STATE_4:
			queued = rose_state4_machine(sk, skb, frametype);
			break;
		case ROSE_STATE_5:
			queued = rose_state5_machine(sk, skb, frametype);
			break;
	}
 
	rose_set_timer(sk);
 
	return queued;
}
 
#endif