![YOSHIFUJI Hideaki](/assets/img/avatar_default.png)
Signed-off-by: YOSHIFUJI Hideaki <yoshfuji@linux-ipv6.org> Signed-off-by: David S. Miller <davem@davemloft.net>
1007 lines
28 KiB
C
1007 lines
28 KiB
C
/*********************************************************************
|
|
*
|
|
* Filename: ircomm_tty_attach.c
|
|
* Version:
|
|
* Description: Code for attaching the serial driver to IrCOMM
|
|
* Status: Experimental.
|
|
* Author: Dag Brattli <dagb@cs.uit.no>
|
|
* Created at: Sat Jun 5 17:42:00 1999
|
|
* Modified at: Tue Jan 4 14:20:49 2000
|
|
* Modified by: Dag Brattli <dagb@cs.uit.no>
|
|
*
|
|
* Copyright (c) 1999-2000 Dag Brattli, All Rights Reserved.
|
|
* Copyright (c) 2000-2003 Jean Tourrilhes <jt@hpl.hp.com>
|
|
*
|
|
* This program 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.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
* MA 02111-1307 USA
|
|
*
|
|
********************************************************************/
|
|
|
|
#include <linux/sched.h>
|
|
#include <linux/init.h>
|
|
|
|
#include <net/irda/irda.h>
|
|
#include <net/irda/irlmp.h>
|
|
#include <net/irda/iriap.h>
|
|
#include <net/irda/irttp.h>
|
|
#include <net/irda/irias_object.h>
|
|
#include <net/irda/parameters.h>
|
|
|
|
#include <net/irda/ircomm_core.h>
|
|
#include <net/irda/ircomm_param.h>
|
|
#include <net/irda/ircomm_event.h>
|
|
|
|
#include <net/irda/ircomm_tty.h>
|
|
#include <net/irda/ircomm_tty_attach.h>
|
|
|
|
static void ircomm_tty_ias_register(struct ircomm_tty_cb *self);
|
|
static void ircomm_tty_discovery_indication(discinfo_t *discovery,
|
|
DISCOVERY_MODE mode,
|
|
void *priv);
|
|
static void ircomm_tty_getvalue_confirm(int result, __u16 obj_id,
|
|
struct ias_value *value, void *priv);
|
|
static void ircomm_tty_start_watchdog_timer(struct ircomm_tty_cb *self,
|
|
int timeout);
|
|
static void ircomm_tty_watchdog_timer_expired(void *data);
|
|
|
|
static int ircomm_tty_state_idle(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info);
|
|
static int ircomm_tty_state_search(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info);
|
|
static int ircomm_tty_state_query_parameters(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info);
|
|
static int ircomm_tty_state_query_lsap_sel(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info);
|
|
static int ircomm_tty_state_setup(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info);
|
|
static int ircomm_tty_state_ready(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info);
|
|
|
|
char *ircomm_tty_state[] = {
|
|
"IRCOMM_TTY_IDLE",
|
|
"IRCOMM_TTY_SEARCH",
|
|
"IRCOMM_TTY_QUERY_PARAMETERS",
|
|
"IRCOMM_TTY_QUERY_LSAP_SEL",
|
|
"IRCOMM_TTY_SETUP",
|
|
"IRCOMM_TTY_READY",
|
|
"*** ERROR *** ",
|
|
};
|
|
|
|
#ifdef CONFIG_IRDA_DEBUG
|
|
static char *ircomm_tty_event[] = {
|
|
"IRCOMM_TTY_ATTACH_CABLE",
|
|
"IRCOMM_TTY_DETACH_CABLE",
|
|
"IRCOMM_TTY_DATA_REQUEST",
|
|
"IRCOMM_TTY_DATA_INDICATION",
|
|
"IRCOMM_TTY_DISCOVERY_REQUEST",
|
|
"IRCOMM_TTY_DISCOVERY_INDICATION",
|
|
"IRCOMM_TTY_CONNECT_CONFIRM",
|
|
"IRCOMM_TTY_CONNECT_INDICATION",
|
|
"IRCOMM_TTY_DISCONNECT_REQUEST",
|
|
"IRCOMM_TTY_DISCONNECT_INDICATION",
|
|
"IRCOMM_TTY_WD_TIMER_EXPIRED",
|
|
"IRCOMM_TTY_GOT_PARAMETERS",
|
|
"IRCOMM_TTY_GOT_LSAPSEL",
|
|
"*** ERROR ****",
|
|
};
|
|
#endif /* CONFIG_IRDA_DEBUG */
|
|
|
|
static int (*state[])(struct ircomm_tty_cb *self, IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb, struct ircomm_tty_info *info) =
|
|
{
|
|
ircomm_tty_state_idle,
|
|
ircomm_tty_state_search,
|
|
ircomm_tty_state_query_parameters,
|
|
ircomm_tty_state_query_lsap_sel,
|
|
ircomm_tty_state_setup,
|
|
ircomm_tty_state_ready,
|
|
};
|
|
|
|
/*
|
|
* Function ircomm_tty_attach_cable (driver)
|
|
*
|
|
* Try to attach cable (IrCOMM link). This function will only return
|
|
* when the link has been connected, or if an error condition occurs.
|
|
* If success, the return value is the resulting service type.
|
|
*/
|
|
int ircomm_tty_attach_cable(struct ircomm_tty_cb *self)
|
|
{
|
|
IRDA_DEBUG(0, "%s()\n", __FUNCTION__ );
|
|
|
|
IRDA_ASSERT(self != NULL, return -1;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
|
|
|
|
/* Check if somebody has already connected to us */
|
|
if (ircomm_is_connected(self->ircomm)) {
|
|
IRDA_DEBUG(0, "%s(), already connected!\n", __FUNCTION__ );
|
|
return 0;
|
|
}
|
|
|
|
/* Make sure nobody tries to write before the link is up */
|
|
self->tty->hw_stopped = 1;
|
|
|
|
ircomm_tty_ias_register(self);
|
|
|
|
ircomm_tty_do_event(self, IRCOMM_TTY_ATTACH_CABLE, NULL, NULL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_detach_cable (driver)
|
|
*
|
|
* Detach cable, or cable has been detached by peer
|
|
*
|
|
*/
|
|
void ircomm_tty_detach_cable(struct ircomm_tty_cb *self)
|
|
{
|
|
IRDA_DEBUG(0, "%s()\n", __FUNCTION__ );
|
|
|
|
IRDA_ASSERT(self != NULL, return;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
del_timer(&self->watchdog_timer);
|
|
|
|
/* Remove discovery handler */
|
|
if (self->ckey) {
|
|
irlmp_unregister_client(self->ckey);
|
|
self->ckey = NULL;
|
|
}
|
|
/* Remove IrCOMM hint bits */
|
|
if (self->skey) {
|
|
irlmp_unregister_service(self->skey);
|
|
self->skey = NULL;
|
|
}
|
|
|
|
if (self->iriap) {
|
|
iriap_close(self->iriap);
|
|
self->iriap = NULL;
|
|
}
|
|
|
|
/* Remove LM-IAS object */
|
|
if (self->obj) {
|
|
irias_delete_object(self->obj);
|
|
self->obj = NULL;
|
|
}
|
|
|
|
ircomm_tty_do_event(self, IRCOMM_TTY_DETACH_CABLE, NULL, NULL);
|
|
|
|
/* Reset some values */
|
|
self->daddr = self->saddr = 0;
|
|
self->dlsap_sel = self->slsap_sel = 0;
|
|
|
|
memset(&self->settings, 0, sizeof(struct ircomm_params));
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_ias_register (self)
|
|
*
|
|
* Register with LM-IAS depending on which service type we are
|
|
*
|
|
*/
|
|
static void ircomm_tty_ias_register(struct ircomm_tty_cb *self)
|
|
{
|
|
__u8 oct_seq[6];
|
|
__u16 hints;
|
|
|
|
IRDA_DEBUG(0, "%s()\n", __FUNCTION__ );
|
|
|
|
IRDA_ASSERT(self != NULL, return;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
/* Compute hint bits based on service */
|
|
hints = irlmp_service_to_hint(S_COMM);
|
|
if (self->service_type & IRCOMM_3_WIRE_RAW)
|
|
hints |= irlmp_service_to_hint(S_PRINTER);
|
|
|
|
/* Advertise IrCOMM hint bit in discovery */
|
|
if (!self->skey)
|
|
self->skey = irlmp_register_service(hints);
|
|
/* Set up a discovery handler */
|
|
if (!self->ckey)
|
|
self->ckey = irlmp_register_client(hints,
|
|
ircomm_tty_discovery_indication,
|
|
NULL, (void *) self);
|
|
|
|
/* If already done, no need to do it again */
|
|
if (self->obj)
|
|
return;
|
|
|
|
if (self->service_type & IRCOMM_3_WIRE_RAW) {
|
|
/* Register IrLPT with LM-IAS */
|
|
self->obj = irias_new_object("IrLPT", IAS_IRLPT_ID);
|
|
irias_add_integer_attrib(self->obj, "IrDA:IrLMP:LsapSel",
|
|
self->slsap_sel, IAS_KERNEL_ATTR);
|
|
} else {
|
|
/* Register IrCOMM with LM-IAS */
|
|
self->obj = irias_new_object("IrDA:IrCOMM", IAS_IRCOMM_ID);
|
|
irias_add_integer_attrib(self->obj, "IrDA:TinyTP:LsapSel",
|
|
self->slsap_sel, IAS_KERNEL_ATTR);
|
|
|
|
/* Code the parameters into the buffer */
|
|
irda_param_pack(oct_seq, "bbbbbb",
|
|
IRCOMM_SERVICE_TYPE, 1, self->service_type,
|
|
IRCOMM_PORT_TYPE, 1, IRCOMM_SERIAL);
|
|
|
|
/* Register parameters with LM-IAS */
|
|
irias_add_octseq_attrib(self->obj, "Parameters", oct_seq, 6,
|
|
IAS_KERNEL_ATTR);
|
|
}
|
|
irias_insert_object(self->obj);
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_ias_unregister (self)
|
|
*
|
|
* Remove our IAS object and client hook while connected.
|
|
*
|
|
*/
|
|
static void ircomm_tty_ias_unregister(struct ircomm_tty_cb *self)
|
|
{
|
|
/* Remove LM-IAS object now so it is not reused.
|
|
* IrCOMM deals very poorly with multiple incoming connections.
|
|
* It should looks a lot more like IrNET, and "dup" a server TSAP
|
|
* to the application TSAP (based on various rules).
|
|
* This is a cheap workaround allowing multiple clients to
|
|
* connect to us. It will not always work.
|
|
* Each IrCOMM socket has an IAS entry. Incoming connection will
|
|
* pick the first one found. So, when we are fully connected,
|
|
* we remove our IAS entries so that the next IAS entry is used.
|
|
* We do that for *both* client and server, because a server
|
|
* can also create client instances.
|
|
* Jean II */
|
|
if (self->obj) {
|
|
irias_delete_object(self->obj);
|
|
self->obj = NULL;
|
|
}
|
|
|
|
#if 0
|
|
/* Remove discovery handler.
|
|
* While we are connected, we no longer need to receive
|
|
* discovery events. This would be the case if there is
|
|
* multiple IrLAP interfaces. Jean II */
|
|
if (self->ckey) {
|
|
irlmp_unregister_client(self->ckey);
|
|
self->ckey = NULL;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_send_initial_parameters (self)
|
|
*
|
|
* Send initial parameters to the remote IrCOMM device. These parameters
|
|
* must be sent before any data.
|
|
*/
|
|
int ircomm_tty_send_initial_parameters(struct ircomm_tty_cb *self)
|
|
{
|
|
IRDA_ASSERT(self != NULL, return -1;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
|
|
|
|
if (self->service_type & IRCOMM_3_WIRE_RAW)
|
|
return 0;
|
|
|
|
/*
|
|
* Set default values, but only if the application for some reason
|
|
* haven't set them already
|
|
*/
|
|
IRDA_DEBUG(2, "%s(), data-rate = %d\n", __FUNCTION__ ,
|
|
self->settings.data_rate);
|
|
if (!self->settings.data_rate)
|
|
self->settings.data_rate = 9600;
|
|
IRDA_DEBUG(2, "%s(), data-format = %d\n", __FUNCTION__ ,
|
|
self->settings.data_format);
|
|
if (!self->settings.data_format)
|
|
self->settings.data_format = IRCOMM_WSIZE_8; /* 8N1 */
|
|
|
|
IRDA_DEBUG(2, "%s(), flow-control = %d\n", __FUNCTION__ ,
|
|
self->settings.flow_control);
|
|
/*self->settings.flow_control = IRCOMM_RTS_CTS_IN|IRCOMM_RTS_CTS_OUT;*/
|
|
|
|
/* Do not set delta values for the initial parameters */
|
|
self->settings.dte = IRCOMM_DTR | IRCOMM_RTS;
|
|
|
|
/* Only send service type parameter when we are the client */
|
|
if (self->client)
|
|
ircomm_param_request(self, IRCOMM_SERVICE_TYPE, FALSE);
|
|
ircomm_param_request(self, IRCOMM_DATA_RATE, FALSE);
|
|
ircomm_param_request(self, IRCOMM_DATA_FORMAT, FALSE);
|
|
|
|
/* For a 3 wire service, we just flush the last parameter and return */
|
|
if (self->settings.service_type == IRCOMM_3_WIRE) {
|
|
ircomm_param_request(self, IRCOMM_FLOW_CONTROL, TRUE);
|
|
return 0;
|
|
}
|
|
|
|
/* Only 9-wire service types continue here */
|
|
ircomm_param_request(self, IRCOMM_FLOW_CONTROL, FALSE);
|
|
#if 0
|
|
ircomm_param_request(self, IRCOMM_XON_XOFF, FALSE);
|
|
ircomm_param_request(self, IRCOMM_ENQ_ACK, FALSE);
|
|
#endif
|
|
/* Notify peer that we are ready to receive data */
|
|
ircomm_param_request(self, IRCOMM_DTE, TRUE);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_discovery_indication (discovery)
|
|
*
|
|
* Remote device is discovered, try query the remote IAS to see which
|
|
* device it is, and which services it has.
|
|
*
|
|
*/
|
|
static void ircomm_tty_discovery_indication(discinfo_t *discovery,
|
|
DISCOVERY_MODE mode,
|
|
void *priv)
|
|
{
|
|
struct ircomm_tty_cb *self;
|
|
struct ircomm_tty_info info;
|
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
|
|
|
|
/* Important note :
|
|
* We need to drop all passive discoveries.
|
|
* The LSAP management of IrComm is deficient and doesn't deal
|
|
* with the case of two instance connecting to each other
|
|
* simultaneously (it will deadlock in LMP).
|
|
* The proper fix would be to use the same technique as in IrNET,
|
|
* to have one server socket and separate instances for the
|
|
* connecting/connected socket.
|
|
* The workaround is to drop passive discovery, which drastically
|
|
* reduce the probability of this happening.
|
|
* Jean II */
|
|
if(mode == DISCOVERY_PASSIVE)
|
|
return;
|
|
|
|
info.daddr = discovery->daddr;
|
|
info.saddr = discovery->saddr;
|
|
|
|
/* FIXME. We have a locking problem on the hashbin here.
|
|
* We probably need to use hashbin_find_next(), but we first
|
|
* need to ensure that "line" is unique. - Jean II */
|
|
self = (struct ircomm_tty_cb *) hashbin_get_first(ircomm_tty);
|
|
while (self != NULL) {
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
ircomm_tty_do_event(self, IRCOMM_TTY_DISCOVERY_INDICATION,
|
|
NULL, &info);
|
|
|
|
self = (struct ircomm_tty_cb *) hashbin_get_next(ircomm_tty);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_disconnect_indication (instance, sap, reason, skb)
|
|
*
|
|
* Link disconnected
|
|
*
|
|
*/
|
|
void ircomm_tty_disconnect_indication(void *instance, void *sap,
|
|
LM_REASON reason,
|
|
struct sk_buff *skb)
|
|
{
|
|
struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
|
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
|
|
|
|
IRDA_ASSERT(self != NULL, return;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
if (!self->tty)
|
|
return;
|
|
|
|
/* This will stop control data transfers */
|
|
self->flow = FLOW_STOP;
|
|
|
|
/* Stop data transfers */
|
|
self->tty->hw_stopped = 1;
|
|
|
|
ircomm_tty_do_event(self, IRCOMM_TTY_DISCONNECT_INDICATION, NULL,
|
|
NULL);
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_getvalue_confirm (result, obj_id, value, priv)
|
|
*
|
|
* Got result from the IAS query we make
|
|
*
|
|
*/
|
|
static void ircomm_tty_getvalue_confirm(int result, __u16 obj_id,
|
|
struct ias_value *value,
|
|
void *priv)
|
|
{
|
|
struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) priv;
|
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
|
|
|
|
IRDA_ASSERT(self != NULL, return;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
/* We probably don't need to make any more queries */
|
|
iriap_close(self->iriap);
|
|
self->iriap = NULL;
|
|
|
|
/* Check if request succeeded */
|
|
if (result != IAS_SUCCESS) {
|
|
IRDA_DEBUG(4, "%s(), got NULL value!\n", __FUNCTION__ );
|
|
return;
|
|
}
|
|
|
|
switch (value->type) {
|
|
case IAS_OCT_SEQ:
|
|
IRDA_DEBUG(2, "%s(), got octet sequence\n", __FUNCTION__ );
|
|
|
|
irda_param_extract_all(self, value->t.oct_seq, value->len,
|
|
&ircomm_param_info);
|
|
|
|
ircomm_tty_do_event(self, IRCOMM_TTY_GOT_PARAMETERS, NULL,
|
|
NULL);
|
|
break;
|
|
case IAS_INTEGER:
|
|
/* Got LSAP selector */
|
|
IRDA_DEBUG(2, "%s(), got lsapsel = %d\n", __FUNCTION__ ,
|
|
value->t.integer);
|
|
|
|
if (value->t.integer == -1) {
|
|
IRDA_DEBUG(0, "%s(), invalid value!\n", __FUNCTION__ );
|
|
} else
|
|
self->dlsap_sel = value->t.integer;
|
|
|
|
ircomm_tty_do_event(self, IRCOMM_TTY_GOT_LSAPSEL, NULL, NULL);
|
|
break;
|
|
case IAS_MISSING:
|
|
IRDA_DEBUG(0, "%s(), got IAS_MISSING\n", __FUNCTION__ );
|
|
break;
|
|
default:
|
|
IRDA_DEBUG(0, "%s(), got unknown type!\n", __FUNCTION__ );
|
|
break;
|
|
}
|
|
irias_delete_value(value);
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_connect_confirm (instance, sap, qos, max_sdu_size, skb)
|
|
*
|
|
* Connection confirmed
|
|
*
|
|
*/
|
|
void ircomm_tty_connect_confirm(void *instance, void *sap,
|
|
struct qos_info *qos,
|
|
__u32 max_data_size,
|
|
__u8 max_header_size,
|
|
struct sk_buff *skb)
|
|
{
|
|
struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
|
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
|
|
|
|
IRDA_ASSERT(self != NULL, return;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
self->client = TRUE;
|
|
self->max_data_size = max_data_size;
|
|
self->max_header_size = max_header_size;
|
|
self->flow = FLOW_START;
|
|
|
|
ircomm_tty_do_event(self, IRCOMM_TTY_CONNECT_CONFIRM, NULL, NULL);
|
|
|
|
/* No need to kfree_skb - see ircomm_ttp_connect_confirm() */
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_connect_indication (instance, sap, qos, max_sdu_size,
|
|
* skb)
|
|
*
|
|
* we are discovered and being requested to connect by remote device !
|
|
*
|
|
*/
|
|
void ircomm_tty_connect_indication(void *instance, void *sap,
|
|
struct qos_info *qos,
|
|
__u32 max_data_size,
|
|
__u8 max_header_size,
|
|
struct sk_buff *skb)
|
|
{
|
|
struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance;
|
|
int clen;
|
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
|
|
|
|
IRDA_ASSERT(self != NULL, return;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
self->client = FALSE;
|
|
self->max_data_size = max_data_size;
|
|
self->max_header_size = max_header_size;
|
|
self->flow = FLOW_START;
|
|
|
|
clen = skb->data[0];
|
|
if (clen)
|
|
irda_param_extract_all(self, skb->data+1,
|
|
IRDA_MIN(skb->len, clen),
|
|
&ircomm_param_info);
|
|
|
|
ircomm_tty_do_event(self, IRCOMM_TTY_CONNECT_INDICATION, NULL, NULL);
|
|
|
|
/* No need to kfree_skb - see ircomm_ttp_connect_indication() */
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_link_established (self)
|
|
*
|
|
* Called when the IrCOMM link is established
|
|
*
|
|
*/
|
|
void ircomm_tty_link_established(struct ircomm_tty_cb *self)
|
|
{
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
|
|
|
|
IRDA_ASSERT(self != NULL, return;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
if (!self->tty)
|
|
return;
|
|
|
|
del_timer(&self->watchdog_timer);
|
|
|
|
/*
|
|
* IrCOMM link is now up, and if we are not using hardware
|
|
* flow-control, then declare the hardware as running. Otherwise we
|
|
* will have to wait for the peer device (DCE) to raise the CTS
|
|
* line.
|
|
*/
|
|
if ((self->flags & ASYNC_CTS_FLOW) && ((self->settings.dce & IRCOMM_CTS) == 0)) {
|
|
IRDA_DEBUG(0, "%s(), waiting for CTS ...\n", __FUNCTION__ );
|
|
return;
|
|
} else {
|
|
IRDA_DEBUG(1, "%s(), starting hardware!\n", __FUNCTION__ );
|
|
|
|
self->tty->hw_stopped = 0;
|
|
|
|
/* Wake up processes blocked on open */
|
|
wake_up_interruptible(&self->open_wait);
|
|
}
|
|
|
|
schedule_work(&self->tqueue);
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_start_watchdog_timer (self, timeout)
|
|
*
|
|
* Start the watchdog timer. This timer is used to make sure that any
|
|
* connection attempt is successful, and if not, we will retry after
|
|
* the timeout
|
|
*/
|
|
static void ircomm_tty_start_watchdog_timer(struct ircomm_tty_cb *self,
|
|
int timeout)
|
|
{
|
|
IRDA_ASSERT(self != NULL, return;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
irda_start_timer(&self->watchdog_timer, timeout, (void *) self,
|
|
ircomm_tty_watchdog_timer_expired);
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_watchdog_timer_expired (data)
|
|
*
|
|
* Called when the connect procedure have taken to much time.
|
|
*
|
|
*/
|
|
static void ircomm_tty_watchdog_timer_expired(void *data)
|
|
{
|
|
struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) data;
|
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__ );
|
|
|
|
IRDA_ASSERT(self != NULL, return;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
ircomm_tty_do_event(self, IRCOMM_TTY_WD_TIMER_EXPIRED, NULL, NULL);
|
|
}
|
|
|
|
|
|
/*
|
|
* Function ircomm_tty_do_event (self, event, skb)
|
|
*
|
|
* Process event
|
|
*
|
|
*/
|
|
int ircomm_tty_do_event(struct ircomm_tty_cb *self, IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb, struct ircomm_tty_info *info)
|
|
{
|
|
IRDA_ASSERT(self != NULL, return -1;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;);
|
|
|
|
IRDA_DEBUG(2, "%s: state=%s, event=%s\n", __FUNCTION__ ,
|
|
ircomm_tty_state[self->state], ircomm_tty_event[event]);
|
|
|
|
return (*state[self->state])(self, event, skb, info);
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_next_state (self, state)
|
|
*
|
|
* Switch state
|
|
*
|
|
*/
|
|
static inline void ircomm_tty_next_state(struct ircomm_tty_cb *self, IRCOMM_TTY_STATE state)
|
|
{
|
|
/*
|
|
IRDA_ASSERT(self != NULL, return;);
|
|
IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;);
|
|
|
|
IRDA_DEBUG(2, "%s: next state=%s, service type=%d\n", __FUNCTION__ ,
|
|
ircomm_tty_state[self->state], self->service_type);
|
|
*/
|
|
self->state = state;
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_state_idle (self, event, skb, info)
|
|
*
|
|
* Just hanging around
|
|
*
|
|
*/
|
|
static int ircomm_tty_state_idle(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info)
|
|
{
|
|
int ret = 0;
|
|
|
|
IRDA_DEBUG(2, "%s: state=%s, event=%s\n", __FUNCTION__ ,
|
|
ircomm_tty_state[self->state], ircomm_tty_event[event]);
|
|
switch (event) {
|
|
case IRCOMM_TTY_ATTACH_CABLE:
|
|
/* Try to discover any remote devices */
|
|
ircomm_tty_start_watchdog_timer(self, 3*HZ);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_SEARCH);
|
|
|
|
irlmp_discovery_request(DISCOVERY_DEFAULT_SLOTS);
|
|
break;
|
|
case IRCOMM_TTY_DISCOVERY_INDICATION:
|
|
self->daddr = info->daddr;
|
|
self->saddr = info->saddr;
|
|
|
|
if (self->iriap) {
|
|
IRDA_WARNING("%s(), busy with a previous query\n",
|
|
__FUNCTION__);
|
|
return -EBUSY;
|
|
}
|
|
|
|
self->iriap = iriap_open(LSAP_ANY, IAS_CLIENT, self,
|
|
ircomm_tty_getvalue_confirm);
|
|
|
|
iriap_getvaluebyclass_request(self->iriap,
|
|
self->saddr, self->daddr,
|
|
"IrDA:IrCOMM", "Parameters");
|
|
|
|
ircomm_tty_start_watchdog_timer(self, 3*HZ);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_QUERY_PARAMETERS);
|
|
break;
|
|
case IRCOMM_TTY_CONNECT_INDICATION:
|
|
del_timer(&self->watchdog_timer);
|
|
|
|
/* Accept connection */
|
|
ircomm_connect_response(self->ircomm, NULL);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_READY);
|
|
break;
|
|
case IRCOMM_TTY_WD_TIMER_EXPIRED:
|
|
/* Just stay idle */
|
|
break;
|
|
case IRCOMM_TTY_DETACH_CABLE:
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_IDLE);
|
|
break;
|
|
default:
|
|
IRDA_DEBUG(2, "%s(), unknown event: %s\n", __FUNCTION__ ,
|
|
ircomm_tty_event[event]);
|
|
ret = -EINVAL;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_state_search (self, event, skb, info)
|
|
*
|
|
* Trying to discover an IrCOMM device
|
|
*
|
|
*/
|
|
static int ircomm_tty_state_search(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info)
|
|
{
|
|
int ret = 0;
|
|
|
|
IRDA_DEBUG(2, "%s: state=%s, event=%s\n", __FUNCTION__ ,
|
|
ircomm_tty_state[self->state], ircomm_tty_event[event]);
|
|
|
|
switch (event) {
|
|
case IRCOMM_TTY_DISCOVERY_INDICATION:
|
|
self->daddr = info->daddr;
|
|
self->saddr = info->saddr;
|
|
|
|
if (self->iriap) {
|
|
IRDA_WARNING("%s(), busy with a previous query\n",
|
|
__FUNCTION__);
|
|
return -EBUSY;
|
|
}
|
|
|
|
self->iriap = iriap_open(LSAP_ANY, IAS_CLIENT, self,
|
|
ircomm_tty_getvalue_confirm);
|
|
|
|
if (self->service_type == IRCOMM_3_WIRE_RAW) {
|
|
iriap_getvaluebyclass_request(self->iriap, self->saddr,
|
|
self->daddr, "IrLPT",
|
|
"IrDA:IrLMP:LsapSel");
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_QUERY_LSAP_SEL);
|
|
} else {
|
|
iriap_getvaluebyclass_request(self->iriap, self->saddr,
|
|
self->daddr,
|
|
"IrDA:IrCOMM",
|
|
"Parameters");
|
|
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_QUERY_PARAMETERS);
|
|
}
|
|
ircomm_tty_start_watchdog_timer(self, 3*HZ);
|
|
break;
|
|
case IRCOMM_TTY_CONNECT_INDICATION:
|
|
del_timer(&self->watchdog_timer);
|
|
ircomm_tty_ias_unregister(self);
|
|
|
|
/* Accept connection */
|
|
ircomm_connect_response(self->ircomm, NULL);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_READY);
|
|
break;
|
|
case IRCOMM_TTY_WD_TIMER_EXPIRED:
|
|
#if 1
|
|
/* Give up */
|
|
#else
|
|
/* Try to discover any remote devices */
|
|
ircomm_tty_start_watchdog_timer(self, 3*HZ);
|
|
irlmp_discovery_request(DISCOVERY_DEFAULT_SLOTS);
|
|
#endif
|
|
break;
|
|
case IRCOMM_TTY_DETACH_CABLE:
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_IDLE);
|
|
break;
|
|
default:
|
|
IRDA_DEBUG(2, "%s(), unknown event: %s\n", __FUNCTION__ ,
|
|
ircomm_tty_event[event]);
|
|
ret = -EINVAL;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_state_query (self, event, skb, info)
|
|
*
|
|
* Querying the remote LM-IAS for IrCOMM parameters
|
|
*
|
|
*/
|
|
static int ircomm_tty_state_query_parameters(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info)
|
|
{
|
|
int ret = 0;
|
|
|
|
IRDA_DEBUG(2, "%s: state=%s, event=%s\n", __FUNCTION__ ,
|
|
ircomm_tty_state[self->state], ircomm_tty_event[event]);
|
|
|
|
switch (event) {
|
|
case IRCOMM_TTY_GOT_PARAMETERS:
|
|
if (self->iriap) {
|
|
IRDA_WARNING("%s(), busy with a previous query\n",
|
|
__FUNCTION__);
|
|
return -EBUSY;
|
|
}
|
|
|
|
self->iriap = iriap_open(LSAP_ANY, IAS_CLIENT, self,
|
|
ircomm_tty_getvalue_confirm);
|
|
|
|
iriap_getvaluebyclass_request(self->iriap, self->saddr,
|
|
self->daddr, "IrDA:IrCOMM",
|
|
"IrDA:TinyTP:LsapSel");
|
|
|
|
ircomm_tty_start_watchdog_timer(self, 3*HZ);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_QUERY_LSAP_SEL);
|
|
break;
|
|
case IRCOMM_TTY_WD_TIMER_EXPIRED:
|
|
/* Go back to search mode */
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_SEARCH);
|
|
ircomm_tty_start_watchdog_timer(self, 3*HZ);
|
|
break;
|
|
case IRCOMM_TTY_CONNECT_INDICATION:
|
|
del_timer(&self->watchdog_timer);
|
|
ircomm_tty_ias_unregister(self);
|
|
|
|
/* Accept connection */
|
|
ircomm_connect_response(self->ircomm, NULL);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_READY);
|
|
break;
|
|
case IRCOMM_TTY_DETACH_CABLE:
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_IDLE);
|
|
break;
|
|
default:
|
|
IRDA_DEBUG(2, "%s(), unknown event: %s\n", __FUNCTION__ ,
|
|
ircomm_tty_event[event]);
|
|
ret = -EINVAL;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_state_query_lsap_sel (self, event, skb, info)
|
|
*
|
|
* Query remote LM-IAS for the LSAP selector which we can connect to
|
|
*
|
|
*/
|
|
static int ircomm_tty_state_query_lsap_sel(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info)
|
|
{
|
|
int ret = 0;
|
|
|
|
IRDA_DEBUG(2, "%s: state=%s, event=%s\n", __FUNCTION__ ,
|
|
ircomm_tty_state[self->state], ircomm_tty_event[event]);
|
|
|
|
switch (event) {
|
|
case IRCOMM_TTY_GOT_LSAPSEL:
|
|
/* Connect to remote device */
|
|
ret = ircomm_connect_request(self->ircomm, self->dlsap_sel,
|
|
self->saddr, self->daddr,
|
|
NULL, self->service_type);
|
|
ircomm_tty_start_watchdog_timer(self, 3*HZ);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_SETUP);
|
|
break;
|
|
case IRCOMM_TTY_WD_TIMER_EXPIRED:
|
|
/* Go back to search mode */
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_SEARCH);
|
|
ircomm_tty_start_watchdog_timer(self, 3*HZ);
|
|
break;
|
|
case IRCOMM_TTY_CONNECT_INDICATION:
|
|
del_timer(&self->watchdog_timer);
|
|
ircomm_tty_ias_unregister(self);
|
|
|
|
/* Accept connection */
|
|
ircomm_connect_response(self->ircomm, NULL);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_READY);
|
|
break;
|
|
case IRCOMM_TTY_DETACH_CABLE:
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_IDLE);
|
|
break;
|
|
default:
|
|
IRDA_DEBUG(2, "%s(), unknown event: %s\n", __FUNCTION__ ,
|
|
ircomm_tty_event[event]);
|
|
ret = -EINVAL;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_state_setup (self, event, skb, info)
|
|
*
|
|
* Trying to connect
|
|
*
|
|
*/
|
|
static int ircomm_tty_state_setup(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info)
|
|
{
|
|
int ret = 0;
|
|
|
|
IRDA_DEBUG(2, "%s: state=%s, event=%s\n", __FUNCTION__ ,
|
|
ircomm_tty_state[self->state], ircomm_tty_event[event]);
|
|
|
|
switch (event) {
|
|
case IRCOMM_TTY_CONNECT_CONFIRM:
|
|
del_timer(&self->watchdog_timer);
|
|
ircomm_tty_ias_unregister(self);
|
|
|
|
/*
|
|
* Send initial parameters. This will also send out queued
|
|
* parameters waiting for the connection to come up
|
|
*/
|
|
ircomm_tty_send_initial_parameters(self);
|
|
ircomm_tty_link_established(self);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_READY);
|
|
break;
|
|
case IRCOMM_TTY_CONNECT_INDICATION:
|
|
del_timer(&self->watchdog_timer);
|
|
ircomm_tty_ias_unregister(self);
|
|
|
|
/* Accept connection */
|
|
ircomm_connect_response(self->ircomm, NULL);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_READY);
|
|
break;
|
|
case IRCOMM_TTY_WD_TIMER_EXPIRED:
|
|
/* Go back to search mode */
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_SEARCH);
|
|
ircomm_tty_start_watchdog_timer(self, 3*HZ);
|
|
break;
|
|
case IRCOMM_TTY_DETACH_CABLE:
|
|
/* ircomm_disconnect_request(self->ircomm, NULL); */
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_IDLE);
|
|
break;
|
|
default:
|
|
IRDA_DEBUG(2, "%s(), unknown event: %s\n", __FUNCTION__ ,
|
|
ircomm_tty_event[event]);
|
|
ret = -EINVAL;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Function ircomm_tty_state_ready (self, event, skb, info)
|
|
*
|
|
* IrCOMM is now connected
|
|
*
|
|
*/
|
|
static int ircomm_tty_state_ready(struct ircomm_tty_cb *self,
|
|
IRCOMM_TTY_EVENT event,
|
|
struct sk_buff *skb,
|
|
struct ircomm_tty_info *info)
|
|
{
|
|
int ret = 0;
|
|
|
|
switch (event) {
|
|
case IRCOMM_TTY_DATA_REQUEST:
|
|
ret = ircomm_data_request(self->ircomm, skb);
|
|
break;
|
|
case IRCOMM_TTY_DETACH_CABLE:
|
|
ircomm_disconnect_request(self->ircomm, NULL);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_IDLE);
|
|
break;
|
|
case IRCOMM_TTY_DISCONNECT_INDICATION:
|
|
ircomm_tty_ias_register(self);
|
|
ircomm_tty_next_state(self, IRCOMM_TTY_SEARCH);
|
|
ircomm_tty_start_watchdog_timer(self, 3*HZ);
|
|
|
|
if (self->flags & ASYNC_CHECK_CD) {
|
|
/* Drop carrier */
|
|
self->settings.dce = IRCOMM_DELTA_CD;
|
|
ircomm_tty_check_modem_status(self);
|
|
} else {
|
|
IRDA_DEBUG(0, "%s(), hanging up!\n", __FUNCTION__ );
|
|
if (self->tty)
|
|
tty_hangup(self->tty);
|
|
}
|
|
break;
|
|
default:
|
|
IRDA_DEBUG(2, "%s(), unknown event: %s\n", __FUNCTION__ ,
|
|
ircomm_tty_event[event]);
|
|
ret = -EINVAL;
|
|
}
|
|
return ret;
|
|
}
|
|
|