/********************************************************************* * * Filename: af_irda.c * Version: 0.9 * Description: IrDA sockets implementation * Status: Stable * Author: Dag Brattli * Created at: Sun May 31 10:12:43 1998 * Modified at: Sat Dec 25 21:10:23 1999 * Modified by: Dag Brattli * Sources: af_netroom.c, af_ax25.c, af_rose.c, af_x25.c etc. * * Copyright (c) 1999 Dag Brattli * Copyright (c) 1999 Jean Tourrilhes * All Rights Reserved. * * 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 * * Linux-IrDA now supports four different types of IrDA sockets: * * o SOCK_STREAM: TinyTP connections with SAR disabled. The * max SDU size is 0 for conn. of this type * o SOCK_SEQPACKET: TinyTP connections with SAR enabled. TTP may * fragment the messages, but will preserve * the message boundaries * o SOCK_DGRAM: IRDAPROTO_UNITDATA: TinyTP connections with Unitdata * (unreliable) transfers * IRDAPROTO_ULTRA: Connectionless and unreliable data * ********************************************************************/ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include extern int irda_init(void); extern void irda_cleanup(void); extern int irlap_driver_rcv(struct sk_buff *, struct net_device *, struct packet_type *); static int irda_create(struct socket *sock, int protocol); static struct proto_ops irda_stream_ops; static struct proto_ops irda_seqpacket_ops; static struct proto_ops irda_dgram_ops; #ifdef CONFIG_IRDA_ULTRA static struct proto_ops irda_ultra_ops; #define ULTRA_MAX_DATA 382 #endif /* CONFIG_IRDA_ULTRA */ static hashbin_t *cachelog = NULL; static DECLARE_WAIT_QUEUE_HEAD(discovery_wait); /* Wait for discovery */ #define IRDA_MAX_HEADER (TTP_MAX_HEADER) /* * Function irda_data_indication (instance, sap, skb) * * Received some data from TinyTP. Just queue it on the receive queue * */ static int irda_data_indication(void *instance, void *sap, struct sk_buff *skb) { struct irda_sock *self; struct sock *sk; int err; self = (struct irda_sock *) instance; ASSERT(self != NULL, return -1;); sk = self->sk; ASSERT(sk != NULL, return -1;); err = sock_queue_rcv_skb(sk, skb); if (err) { IRDA_DEBUG(1, __FUNCTION__ "(), error: no more mem!\n"); self->rx_flow = FLOW_STOP; /* When we return error, TTP will need to requeue the skb */ return err; } return 0; } /* * Function irda_disconnect_indication (instance, sap, reason, skb) * * Connection has been closed. Chech reason to find out why * */ static void irda_disconnect_indication(void *instance, void *sap, LM_REASON reason, struct sk_buff *skb) { struct irda_sock *self; struct sock *sk; IRDA_DEBUG(2, __FUNCTION__ "()\n"); self = (struct irda_sock *) instance; sk = self->sk; if (sk == NULL) return; sk->state = TCP_CLOSE; sk->err = ECONNRESET; sk->shutdown |= SEND_SHUTDOWN; if (!sk->dead) { sk->state_change(sk); sk->dead = 1; } } /* * Function irda_connect_confirm (instance, sap, qos, max_sdu_size, skb) * * Connections has been confirmed by the remote device * */ static void irda_connect_confirm(void *instance, void *sap, struct qos_info *qos, __u32 max_sdu_size, __u8 max_header_size, struct sk_buff *skb) { struct irda_sock *self; struct sock *sk; IRDA_DEBUG(2, __FUNCTION__ "()\n"); self = (struct irda_sock *) instance; sk = self->sk; if (sk == NULL) return; /* How much header space do we need to reserve */ self->max_header_size = max_header_size; /* IrTTP max SDU size in transmit direction */ self->max_sdu_size_tx = max_sdu_size; /* Find out what the largest chunk of data that we can transmit is */ switch (sk->type) { case SOCK_STREAM: if (max_sdu_size != 0) { ERROR(__FUNCTION__ "(), max_sdu_size must be 0\n"); return; } self->max_data_size = irttp_get_max_seg_size(self->tsap); break; case SOCK_SEQPACKET: if (max_sdu_size == 0) { ERROR(__FUNCTION__ "(), max_sdu_size cannot be 0\n"); return; } self->max_data_size = max_sdu_size; break; default: self->max_data_size = irttp_get_max_seg_size(self->tsap); }; IRDA_DEBUG(2, __FUNCTION__ "(), max_data_size=%d\n", self->max_data_size); memcpy(&self->qos_tx, qos, sizeof(struct qos_info)); skb_queue_tail(&sk->receive_queue, skb); /* We are now connected! */ sk->state = TCP_ESTABLISHED; sk->state_change(sk); } /* * Function irda_connect_indication(instance, sap, qos, max_sdu_size, userdata) * * Incomming connection * */ static void irda_connect_indication(void *instance, void *sap, struct qos_info *qos, __u32 max_sdu_size, __u8 max_header_size, struct sk_buff *skb) { struct irda_sock *self; struct sock *sk; IRDA_DEBUG(2, __FUNCTION__ "()\n"); self = (struct irda_sock *) instance; sk = self->sk; if (sk == NULL) return; /* How much header space do we need to reserve */ self->max_header_size = max_header_size; /* IrTTP max SDU size in transmit direction */ self->max_sdu_size_tx = max_sdu_size; /* Find out what the largest chunk of data that we can transmit is */ switch (sk->type) { case SOCK_STREAM: if (max_sdu_size != 0) { ERROR(__FUNCTION__ "(), max_sdu_size must be 0\n"); return; } self->max_data_size = irttp_get_max_seg_size(self->tsap); break; case SOCK_SEQPACKET: if (max_sdu_size == 0) { ERROR(__FUNCTION__ "(), max_sdu_size cannot be 0\n"); return; } self->max_data_size = max_sdu_size; break; default: self->max_data_size = irttp_get_max_seg_size(self->tsap); }; IRDA_DEBUG(2, __FUNCTION__ "(), max_data_size=%d\n", self->max_data_size); memcpy(&self->qos_tx, qos, sizeof(struct qos_info)); skb_queue_tail(&sk->receive_queue, skb); sk->state_change(sk); } /* * Function irda_connect_response (handle) * * Accept incomming connection * */ void irda_connect_response(struct irda_sock *self) { struct sk_buff *skb; IRDA_DEBUG(2, __FUNCTION__ "()\n"); ASSERT(self != NULL, return;); skb = dev_alloc_skb(64); if (skb == NULL) { IRDA_DEBUG(0, __FUNCTION__ "() Unable to allocate sk_buff!\n"); return; } /* Reserve space for MUX_CONTROL and LAP header */ skb_reserve(skb, IRDA_MAX_HEADER); irttp_connect_response(self->tsap, self->max_sdu_size_rx, skb); } /* * Function irda_flow_indication (instance, sap, flow) * * Used by TinyTP to tell us if it can accept more data or not * */ static void irda_flow_indication(void *instance, void *sap, LOCAL_FLOW flow) { struct irda_sock *self; struct sock *sk; IRDA_DEBUG(2, __FUNCTION__ "()\n"); self = (struct irda_sock *) instance; ASSERT(self != NULL, return;); sk = self->sk; ASSERT(sk != NULL, return;); switch (flow) { case FLOW_STOP: IRDA_DEBUG(1, __FUNCTION__ "(), IrTTP wants us to slow down\n"); self->tx_flow = flow; break; case FLOW_START: self->tx_flow = flow; IRDA_DEBUG(1, __FUNCTION__ "(), IrTTP wants us to start again\n"); wake_up_interruptible(sk->sleep); break; default: IRDA_DEBUG( 0, __FUNCTION__ "(), Unknown flow command!\n"); /* Unknown flow command, better stop */ self->tx_flow = flow; break; } } /* * Function irda_getvalue_confirm (obj_id, value, priv) * * Got answer from remote LM-IAS * */ static void irda_getvalue_confirm(int result, __u16 obj_id, struct ias_value *value, void *priv) { struct irda_sock *self; IRDA_DEBUG(2, __FUNCTION__ "()\n"); ASSERT(priv != NULL, return;); self = (struct irda_sock *) priv; if (!self) { WARNING(__FUNCTION__ "(), lost myself!\n"); return; } /* We probably don't need to make any more queries */ iriap_close(self->iriap); self->iriap = NULL; self->errno = result; /* Check if request succeeded */ if (result != IAS_SUCCESS) { IRDA_DEBUG(0, __FUNCTION__ "(), IAS query failed!\n"); /* Wake up any processes waiting for result */ wake_up_interruptible(&self->ias_wait); return; } switch (value->type) { case IAS_INTEGER: IRDA_DEBUG(4, __FUNCTION__ "() int=%d\n", value->t.integer); if (value->t.integer != -1) { self->dtsap_sel = value->t.integer; } else self->dtsap_sel = 0; break; default: IRDA_DEBUG(0, __FUNCTION__ "(), bad type!\n"); break; } irias_delete_value(value); /* Wake up any processes waiting for result */ wake_up_interruptible(&self->ias_wait); } /* * Function irda_discovery_indication (log) * * Got a discovery log from IrLMP, wake ut any process waiting for answer * */ static void irda_discovery_indication(hashbin_t *log) { IRDA_DEBUG(2, __FUNCTION__ "()\n"); cachelog = log; /* Wake up process if its waiting for device to be discovered */ wake_up_interruptible(&discovery_wait); } /* * Function irda_open_tsap (self) * * Open local Transport Service Access Point (TSAP) * */ static int irda_open_tsap(struct irda_sock *self, __u8 tsap_sel, char *name) { notify_t notify; if (self->tsap) { WARNING(__FUNCTION__ "(), busy!\n"); return -EBUSY; } /* Initialize callbacks to be used by the IrDA stack */ irda_notify_init(¬ify); notify.connect_confirm = irda_connect_confirm; notify.connect_indication = irda_connect_indication; notify.disconnect_indication = irda_disconnect_indication; notify.data_indication = irda_data_indication; notify.udata_indication = irda_data_indication; notify.flow_indication = irda_flow_indication; notify.instance = self; strncpy(notify.name, name, NOTIFY_MAX_NAME); self->tsap = irttp_open_tsap(tsap_sel, DEFAULT_INITIAL_CREDIT, ¬ify); if (self->tsap == NULL) { IRDA_DEBUG( 0, __FUNCTION__ "(), Unable to allocate TSAP!\n"); return -ENOMEM; } /* Remember which TSAP selector we actually got */ self->stsap_sel = self->tsap->stsap_sel; return 0; } /* * Function irda_open_lsap (self) * * Open local Link Service Access Point (LSAP). Used for opening Ultra * sockets */ #ifdef CONFIG_IRDA_ULTRA static int irda_open_lsap(struct irda_sock *self, int pid) { notify_t notify; if (self->lsap) { WARNING(__FUNCTION__ "(), busy!\n"); return -EBUSY; } /* Initialize callbacks to be used by the IrDA stack */ irda_notify_init(¬ify); notify.udata_indication = irda_data_indication; notify.instance = self; strncpy(notify.name, "Ultra", NOTIFY_MAX_NAME); self->lsap = irlmp_open_lsap(LSAP_CONNLESS, ¬ify, pid); if (self->lsap == NULL) { IRDA_DEBUG( 0, __FUNCTION__ "(), Unable to allocate LSAP!\n"); return -ENOMEM; } return 0; } #endif /* CONFIG_IRDA_ULTRA */ /* * Function irda_find_lsap_sel (self, name) * * Try to lookup LSAP selector in remote LM-IAS * */ static int irda_find_lsap_sel(struct irda_sock *self, char *name) { IRDA_DEBUG(2, __FUNCTION__ "(), name=%s\n", name); ASSERT(self != NULL, return -1;); if (self->iriap) { WARNING(__FUNCTION__ "(), busy with a previous query\n"); return -EBUSY; } self->iriap = iriap_open(LSAP_ANY, IAS_CLIENT, self, irda_getvalue_confirm); /* Query remote LM-IAS */ iriap_getvaluebyclass_request(self->iriap, self->saddr, self->daddr, name, "IrDA:TinyTP:LsapSel"); /* Wait for answer */ interruptible_sleep_on(&self->ias_wait); if (self->dtsap_sel) return 0; return -ENETUNREACH; /* May not be true */ } /* * Function irda_discover_daddr_and_lsap_sel (self, name) * * This try to find a device with the requested service. * * It basically look into the discovery log. For each address in the list, * it queries the LM-IAS of the device to find if this device offer * the requested service. * If there is more than one node supporting the service, we complain * to the user (it should move devices around). * The, we set both the destination address and the lsap selector to point * on the service on the unique device we have found. * * Note : this function fails if there is more than one device in range, * because IrLMP doesn't disconnect the LAP when the last LSAP is closed. * Moreover, we would need to wait the LAP disconnection... */ static int irda_discover_daddr_and_lsap_sel(struct irda_sock *self, char *name) { discovery_t *discovery; int err = -ENETUNREACH; __u32 daddr = 0x0; /* Address we found the service on */ __u8 dtsap_sel = 0x0; /* TSAP associated with it */ IRDA_DEBUG(2, __FUNCTION__ "(), name=%s\n", name); ASSERT(self != NULL, return -1;); /* Tell IrLMP we want to be notified */ irlmp_update_client(self->ckey, self->mask, NULL, irda_discovery_indication); /* Do some discovery */ irlmp_discovery_request(self->nslots); /* Check if the we got some results */ if (!cachelog) /* Wait for answer */ /*interruptible_sleep_on(&self->discovery_wait);*/ return -EAGAIN; /* * Now, check all discovered devices (if any), and connect * client only about the services that the client is * interested in... */ discovery = (discovery_t *) hashbin_get_first(cachelog); while (discovery != NULL) { /* Mask out the ones we don't want */ if (discovery->hints.word & self->mask) { /* Try this address */ self->daddr = discovery->daddr; self->saddr = 0x0; IRDA_DEBUG(1, __FUNCTION__ "(), trying daddr = %08x\n", self->daddr); /* Query remote LM-IAS for this service */ err = irda_find_lsap_sel(self, name); if (err == 0) { /* We found the requested service */ if(daddr != 0x0) { IRDA_DEBUG(0, __FUNCTION__ "(), discovered service ''%s'' in two different devices !!!\n", name); return(-ENOTUNIQ); } /* First time we foun that one, save it ! */ daddr = self->daddr; dtsap_sel = self->dtsap_sel; } } /* Next node, maybe we will be more lucky... */ discovery = (discovery_t *) hashbin_get_next(cachelog); } cachelog = NULL; /* Check out what we found */ if(daddr == 0x0) { IRDA_DEBUG(0, __FUNCTION__ "(), cannot discover service ''%s'' in any device !!!\n", name); self->daddr = 0; /* Guessing */ return(-ENETUNREACH); } /* Revert back to discovered device & service */ self->daddr = daddr; self->saddr = 0x0; self->dtsap_sel = dtsap_sel; IRDA_DEBUG(0, __FUNCTION__ "(), discovered requested service ''%s'' at address %08x\n", name, self->daddr); return 0; } /* * Function irda_getname (sock, uaddr, uaddr_len, peer) * * Return the our own, or peers socket address (sockaddr_irda) * */ static int irda_getname(struct socket *sock, struct sockaddr *uaddr, int *uaddr_len, int peer) { struct sockaddr_irda saddr; struct sock *sk = sock->sk; if (peer) { if (sk->state != TCP_ESTABLISHED) return -ENOTCONN; saddr.sir_family = AF_IRDA; saddr.sir_lsap_sel = sk->protinfo.irda->dtsap_sel; saddr.sir_addr = sk->protinfo.irda->daddr; } else { saddr.sir_family = AF_IRDA; saddr.sir_lsap_sel = sk->protinfo.irda->stsap_sel; saddr.sir_addr = sk->protinfo.irda->saddr; } IRDA_DEBUG(1, __FUNCTION__ "(), tsap_sel = %#x\n", saddr.sir_lsap_sel); IRDA_DEBUG(1, __FUNCTION__ "(), addr = %08x\n", saddr.sir_addr); if (*uaddr_len > sizeof (struct sockaddr_irda)) *uaddr_len = sizeof (struct sockaddr_irda); memcpy(uaddr, &saddr, *uaddr_len); return 0; } /* * Function irda_listen (sock, backlog) * * Just move to the listen state * */ static int irda_listen(struct socket *sock, int backlog) { struct sock *sk = sock->sk; IRDA_DEBUG(2, __FUNCTION__ "()\n"); if ((sk->type != SOCK_STREAM) && (sk->type != SOCK_SEQPACKET) && (sk->type != SOCK_DGRAM)) return -EOPNOTSUPP; if (sk->state != TCP_LISTEN) { sk->max_ack_backlog = backlog; sk->state = TCP_LISTEN; return 0; } return -EOPNOTSUPP; } /* * Function irda_bind (sock, uaddr, addr_len) * * Used by servers to register their well known TSAP * */ static int irda_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len) { struct sock *sk = sock->sk; struct sockaddr_irda *addr = (struct sockaddr_irda *) uaddr; struct irda_sock *self; __u16 hints = 0; int err; IRDA_DEBUG(2, __FUNCTION__ "()\n"); self = sk->protinfo.irda; ASSERT(self != NULL, return -1;); if (addr_len != sizeof(struct sockaddr_irda)) return -EINVAL; #ifdef CONFIG_IRDA_ULTRA /* Special care for Ultra sockets */ if ((sk->type == SOCK_DGRAM) && (sk->protocol == IRDAPROTO_ULTRA)) { self->pid = addr->sir_lsap_sel; if (self->pid & 0x80) { IRDA_DEBUG(0, __FUNCTION__ "(), extension in PID not supp!\n"); return -EOPNOTSUPP; } err = irda_open_lsap(self, self->pid); if (err < 0) return err; self->max_data_size = ULTRA_MAX_DATA - LMP_PID_HEADER; self->max_header_size = IRDA_MAX_HEADER + LMP_PID_HEADER; /* Pretend we are connected */ sock->state = SS_CONNECTED; sk->state = TCP_ESTABLISHED; return 0; } #endif /* CONFIG_IRDA_ULTRA */ err = irda_open_tsap(self, addr->sir_lsap_sel, addr->sir_name); if (err < 0) return err; /* Register with LM-IAS */ self->ias_obj = irias_new_object(addr->sir_name, jiffies); irias_add_integer_attrib(self->ias_obj, "IrDA:TinyTP:LsapSel", self->stsap_sel); irias_insert_object(self->ias_obj); #if 1 /* Will be removed in near future */ /* Fill in some default hint bits values */ if (strncmp(addr->sir_name, "OBEX", 4) == 0) hints = irlmp_service_to_hint(S_OBEX); if (hints) self->skey = irlmp_register_service(hints); #endif return 0; } /* * Function irda_accept (sock, newsock, flags) * * Wait for incomming connection * */ static int irda_accept(struct socket *sock, struct socket *newsock, int flags) { struct irda_sock *self, *new; struct sock *sk = sock->sk; struct sock *newsk; struct sk_buff *skb; int err; IRDA_DEBUG(2, __FUNCTION__ "()\n"); self = sk->protinfo.irda; ASSERT(self != NULL, return -1;); err = irda_create(newsock, sk->protocol); if (err) return err; if (sock->state != SS_UNCONNECTED) return -EINVAL; if ((sk = sock->sk) == NULL) return -EINVAL; if ((sk->type != SOCK_STREAM) && (sk->type != SOCK_SEQPACKET) && (sk->type != SOCK_DGRAM)) return -EOPNOTSUPP; if (sk->state != TCP_LISTEN) return -EINVAL; /* * The read queue this time is holding sockets ready to use * hooked into the SABM we saved */ do { if ((skb = skb_dequeue(&sk->receive_queue)) == NULL) { if (flags & O_NONBLOCK) return -EWOULDBLOCK; interruptible_sleep_on(sk->sleep); if (signal_pending(current)) return -ERESTARTSYS; } } while (skb == NULL); newsk = newsock->sk; newsk->state = TCP_ESTABLISHED; new = newsk->protinfo.irda; ASSERT(new != NULL, return -1;); /* Now attach up the new socket */ new->tsap = irttp_dup(self->tsap, new); if (!new->tsap) { IRDA_DEBUG(0, __FUNCTION__ "(), dup failed!\n"); return -1; } new->stsap_sel = new->tsap->stsap_sel; new->dtsap_sel = new->tsap->dtsap_sel; new->saddr = irttp_get_saddr(new->tsap); new->daddr = irttp_get_daddr(new->tsap); new->max_sdu_size_tx = self->max_sdu_size_tx; new->max_sdu_size_rx = self->max_sdu_size_rx; new->max_data_size = self->max_data_size; new->max_header_size = self->max_header_size; memcpy(&new->qos_tx, &self->qos_tx, sizeof(struct qos_info)); /* Clean up the original one to keep it in listen state */ self->tsap->dtsap_sel = self->tsap->lsap->dlsap_sel = LSAP_ANY; self->tsap->lsap->lsap_state = LSAP_DISCONNECTED; skb->sk = NULL; skb->destructor = NULL; kfree_skb(skb); sk->ack_backlog--; newsock->state = SS_CONNECTED; irda_connect_response(new); return 0; } /* * Function irda_connect (sock, uaddr, addr_len, flags) * * Connect to a IrDA device * */ static int irda_connect(struct socket *sock, struct sockaddr *uaddr, int addr_len, int flags) { struct sock *sk = sock->sk; struct sockaddr_irda *addr = (struct sockaddr_irda *) uaddr; struct irda_sock *self; int err; IRDA_DEBUG(2, __FUNCTION__ "()\n"); self = sk->protinfo.irda; /* Don't allow connect for Ultra sockets */ if ((sk->type == SOCK_DGRAM) && (sk->protocol == IRDAPROTO_ULTRA)) return -ESOCKTNOSUPPORT; if (sk->state == TCP_ESTABLISHED && sock->state == SS_CONNECTING) { sock->state = SS_CONNECTED; return 0; /* Connect completed during a ERESTARTSYS event */ } if (sk->state == TCP_CLOSE && sock->state == SS_CONNECTING) { sock->state = SS_UNCONNECTED; return -ECONNREFUSED; } if (sk->state == TCP_ESTABLISHED) return -EISCONN; /* No reconnect on a seqpacket socket */ sk->state = TCP_CLOSE; sock->state = SS_UNCONNECTED; if (addr_len != sizeof(struct sockaddr_irda)) return -EINVAL; /* Check if user supplied any destination device address */ if (!addr->sir_addr) { /* Try to find one suitable */ err = irda_discover_daddr_and_lsap_sel(self, addr->sir_name); if (err) { IRDA_DEBUG(0, __FUNCTION__ "(), auto-connect failed!\n"); return -EINVAL; } } else { /* Use the one provided by the user */ self->daddr = addr->sir_addr; IRDA_DEBUG(1, __FUNCTION__ "(), daddr = %08x\n", self->daddr); /* Query remote LM-IAS */ err = irda_find_lsap_sel(self, addr->sir_name); if (err) { IRDA_DEBUG(0, __FUNCTION__ "(), connect failed!\n"); return err; } } /* Check if we have opened a local TSAP */ if (!self->tsap) irda_open_tsap(self, LSAP_ANY, addr->sir_name); /* Move to connecting socket, start sending Connect Requests */ sock->state = SS_CONNECTING; sk->state = TCP_SYN_SENT; /* Connect to remote device */ err = irttp_connect_request(self->tsap, self->dtsap_sel, self->saddr, self->daddr, NULL, self->max_sdu_size_rx, NULL); if (err) { IRDA_DEBUG(0, __FUNCTION__ "(), connect failed!\n"); return err; } /* Now the loop */ if (sk->state != TCP_ESTABLISHED && (flags & O_NONBLOCK)) return -EINPROGRESS; cli(); /* To avoid races on the sleep */ /* A Connect Ack with Choke or timeout or failed routing will go to * closed. */ while (sk->state == TCP_SYN_SENT) { interruptible_sleep_on(sk->sleep); if (signal_pending(current)) { sti(); return -ERESTARTSYS; } } if (sk->state != TCP_ESTABLISHED) { sti(); sock->state = SS_UNCONNECTED; return sock_error(sk); /* Always set at this point */ } sock->state = SS_CONNECTED; sti(); return 0; } /* * Function irda_create (sock, protocol) * * Create IrDA socket * */ static int irda_create(struct socket *sock, int protocol) { struct sock *sk; struct irda_sock *self; IRDA_DEBUG(2, __FUNCTION__ "()\n"); /* Check for valid socket type */ switch (sock->type) { case SOCK_STREAM: /* For TTP connections with SAR disabled */ case SOCK_SEQPACKET: /* For TTP connections with SAR enabled */ case SOCK_DGRAM: /* For TTP Unitdata or LMP Ultra transfers */ break; default: return -ESOCKTNOSUPPORT; } /* Allocate socket */ if ((sk = sk_alloc(PF_IRDA, GFP_ATOMIC, 1)) == NULL) return -ENOMEM; self = kmalloc(sizeof(struct irda_sock), GFP_ATOMIC); if (self == NULL) return -ENOMEM; memset(self, 0, sizeof(struct irda_sock)); init_waitqueue_head(&self->ias_wait); self->sk = sk; sk->protinfo.irda = self; sock_init_data(sock, sk); switch (sock->type) { case SOCK_STREAM: sock->ops = &irda_stream_ops; self->max_sdu_size_rx = TTP_SAR_DISABLE; break; case SOCK_SEQPACKET: sock->ops = &irda_seqpacket_ops; self->max_sdu_size_rx = TTP_SAR_UNBOUND; break; case SOCK_DGRAM: switch (protocol) { #ifdef CONFIG_IRDA_ULTRA case IRDAPROTO_ULTRA: sock->ops = &irda_ultra_ops; break; #endif /* CONFIG_IRDA_ULTRA */ case IRDAPROTO_UNITDATA: sock->ops = &irda_dgram_ops; /* We let Unitdata conn. be like seqpack conn. */ self->max_sdu_size_rx = TTP_SAR_UNBOUND; break; default: ERROR(__FUNCTION__ "(), protocol not supported!\n"); return -ESOCKTNOSUPPORT; } break; default: return -ESOCKTNOSUPPORT; } sk->protocol = protocol; /* Register as a client with IrLMP */ self->ckey = irlmp_register_client(0, NULL, NULL); self->mask = 0xffff; self->rx_flow = self->tx_flow = FLOW_START; self->nslots = DISCOVERY_DEFAULT_SLOTS; self->daddr = DEV_ADDR_ANY; /* Notify that we are using the irda module, so nobody removes it */ irda_mod_inc_use_count(); return 0; } /* * Function irda_destroy_socket (self) * * Destroy socket * */ void irda_destroy_socket(struct irda_sock *self) { IRDA_DEBUG(2, __FUNCTION__ "()\n"); ASSERT(self != NULL, return;); /* Unregister with IrLMP */ irlmp_unregister_client(self->ckey); irlmp_unregister_service(self->skey); /* Unregister with LM-IAS */ if (self->ias_obj) irias_delete_object(self->ias_obj); if (self->iriap) iriap_close(self->iriap); if (self->tsap) { irttp_disconnect_request(self->tsap, NULL, P_NORMAL); irttp_close_tsap(self->tsap); self->tsap = NULL; } #ifdef CONFIG_IRDA_ULTRA if (self->lsap) { irlmp_close_lsap(self->lsap); self->lsap = NULL; } #endif /* CONFIG_IRDA_ULTRA */ kfree(self); /* Notify that we are not using the irda module anymore */ irda_mod_dec_use_count(); return; } /* * Function irda_release (sock) * * * */ static int irda_release(struct socket *sock) { struct sock *sk = sock->sk; IRDA_DEBUG(2, __FUNCTION__ "()\n"); if (sk == NULL) return 0; sk->state = TCP_CLOSE; sk->shutdown |= SEND_SHUTDOWN; sk->state_change(sk); sk->dead = 1; irda_destroy_socket(sk->protinfo.irda); sock->sk = NULL; sk->socket = NULL; /* Not used, but we should do this. */ return 0; } /* * Function irda_sendmsg (sock, msg, len, scm) * * Send message down to TinyTP. This function is used for both STREAM and * SEQPACK services. This is possible since it forces the client to * fragment the message if necessary */ static int irda_sendmsg(struct socket *sock, struct msghdr *msg, int len, struct scm_cookie *scm) { struct sock *sk = sock->sk; struct irda_sock *self; struct sk_buff *skb; unsigned char *asmptr; int err; IRDA_DEBUG(4, __FUNCTION__ "(), len=%d\n", len); if (msg->msg_flags & ~MSG_DONTWAIT) return -EINVAL; if (sk->shutdown & SEND_SHUTDOWN) { send_sig(SIGPIPE, current, 0); return -EPIPE; } if (sk->state != TCP_ESTABLISHED) return -ENOTCONN; self = sk->protinfo.irda; ASSERT(self != NULL, return -1;); /* Check if IrTTP is wants us to slow down */ while (self->tx_flow == FLOW_STOP) { IRDA_DEBUG(2, __FUNCTION__ "(), IrTTP is busy, going to sleep!\n"); interruptible_sleep_on(sk->sleep); /* Check if we are still connected */ if (sk->state != TCP_ESTABLISHED) return -ENOTCONN; } /* Check that we don't send out to big frames */ if (len > self->max_data_size) { IRDA_DEBUG(2, __FUNCTION__ "(), Chopping frame from %d to %d bytes!\n", len, self->max_data_size); len = self->max_data_size; } skb = sock_alloc_send_skb(sk, len + self->max_header_size, 0, msg->msg_flags & MSG_DONTWAIT, &err); if (!skb) return -ENOBUFS; skb_reserve(skb, self->max_header_size); asmptr = skb->h.raw = skb_put(skb, len); memcpy_fromiovec(asmptr, msg->msg_iov, len); /* * Just send the message to TinyTP, and let it deal with possible * errors. No need to duplicate all that here */ err = irttp_data_request(self->tsap, skb); if (err) { IRDA_DEBUG(0, __FUNCTION__ "(), err=%d\n", err); return err; } /* Tell client how much data we actually sent */ return len; } /* * Function irda_recvmsg_dgram (sock, msg, size, flags, scm) * * Try to receive message and copy it to user. The frame is discarded * after being read, regardless of how much the user actually read */ static int irda_recvmsg_dgram(struct socket *sock, struct msghdr *msg, int size, int flags, struct scm_cookie *scm) { struct irda_sock *self; struct sock *sk = sock->sk; struct sk_buff *skb; int copied, err; IRDA_DEBUG(4, __FUNCTION__ "()\n"); self = sk->protinfo.irda; ASSERT(self != NULL, return -1;); skb = skb_recv_datagram(sk, flags & ~MSG_DONTWAIT, flags & MSG_DONTWAIT, &err); if (!skb) return err; skb->h.raw = skb->data; copied = skb->len; if (copied > size) { IRDA_DEBUG(2, __FUNCTION__ "(), Received truncated frame (%d < %d)!\n", copied, size); copied = size; msg->msg_flags |= MSG_TRUNC; } skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied); skb_free_datagram(sk, skb); /* * Check if we have previously stopped IrTTP and we know * have more free space in our rx_queue. If so tell IrTTP * to start delivering frames again before our rx_queue gets * empty */ if (self->rx_flow == FLOW_STOP) { if ((atomic_read(&sk->rmem_alloc) << 2) <= sk->rcvbuf) { IRDA_DEBUG(2, __FUNCTION__ "(), Starting IrTTP\n"); self->rx_flow = FLOW_START; irttp_flow_request(self->tsap, FLOW_START); } } return copied; } /* * Function irda_data_wait (sk) * * Sleep until data has arrive. But check for races.. * */ static void irda_data_wait(struct sock *sk) { if (!skb_peek(&sk->receive_queue)) { sk->socket->flags |= SO_WAITDATA; interruptible_sleep_on(sk->sleep); sk->socket->flags &= ~SO_WAITDATA; } } /* * Function irda_recvmsg_stream (sock, msg, size, flags, scm) * * * */ static int irda_recvmsg_stream(struct socket *sock, struct msghdr *msg, int size, int flags, struct scm_cookie *scm) { struct irda_sock *self; struct sock *sk = sock->sk; int noblock = flags & MSG_DONTWAIT; int copied = 0; int target = 1; IRDA_DEBUG(3, __FUNCTION__ "()\n"); self = sk->protinfo.irda; ASSERT(self != NULL, return -1;); if (sock->flags & SO_ACCEPTCON) return(-EINVAL); if (flags & MSG_OOB) return -EOPNOTSUPP; if (flags & MSG_WAITALL) target = size; msg->msg_namelen = 0; do { int chunk; struct sk_buff *skb; skb=skb_dequeue(&sk->receive_queue); if (skb==NULL) { if (copied >= target) break; /* * POSIX 1003.1g mandates this order. */ if (sk->err) { return sock_error(sk); } if (sk->shutdown & RCV_SHUTDOWN) break; if (noblock) return -EAGAIN; irda_data_wait(sk); if (signal_pending(current)) return -ERESTARTSYS; continue; } chunk = min(skb->len, size); if (memcpy_toiovec(msg->msg_iov, skb->data, chunk)) { skb_queue_head(&sk->receive_queue, skb); if (copied == 0) copied = -EFAULT; break; } copied += chunk; size -= chunk; /* Mark read part of skb as used */ if (!(flags & MSG_PEEK)) { skb_pull(skb, chunk); /* put the skb back if we didn't use it up.. */ if (skb->len) { IRDA_DEBUG(1, __FUNCTION__ "(), back on q!\n"); skb_queue_head(&sk->receive_queue, skb); break; } kfree_skb(skb); } else { IRDA_DEBUG(0, __FUNCTION__ "() questionable!?\n"); /* put message back and return */ skb_queue_head(&sk->receive_queue, skb); break; } } while (size); /* * Check if we have previously stopped IrTTP and we know * have more free space in our rx_queue. If so tell IrTTP * to start delivering frames again before our rx_queue gets * empty */ if (self->rx_flow == FLOW_STOP) { if ((atomic_read(&sk->rmem_alloc) << 2) <= sk->rcvbuf) { IRDA_DEBUG(2, __FUNCTION__ "(), Starting IrTTP\n"); self->rx_flow = FLOW_START; irttp_flow_request(self->tsap, FLOW_START); } } return copied; } /* * Function irda_sendmsg_dgram (sock, msg, len, scm) * * Send message down to TinyTP for the unreliable sequenced * packet service... * */ static int irda_sendmsg_dgram(struct socket *sock, struct msghdr *msg, int len, struct scm_cookie *scm) { struct sock *sk = sock->sk; struct irda_sock *self; struct sk_buff *skb; unsigned char *asmptr; int err; IRDA_DEBUG(4, __FUNCTION__ "(), len=%d\n", len); if (msg->msg_flags & ~MSG_DONTWAIT) return -EINVAL; if (sk->shutdown & SEND_SHUTDOWN) { send_sig(SIGPIPE, current, 0); return -EPIPE; } if (sk->state != TCP_ESTABLISHED) return -ENOTCONN; self = sk->protinfo.irda; ASSERT(self != NULL, return -1;); /* * Check that we don't send out to big frames. This is an unreliable * service, so we have no fragmentation and no coalescence */ if (len > self->max_data_size) { IRDA_DEBUG(0, __FUNCTION__ "(), Warning to much data! " "Chopping frame from %d to %d bytes!\n", len, self->max_data_size); len = self->max_data_size; } skb = sock_alloc_send_skb(sk, len + self->max_header_size, 0, msg->msg_flags & MSG_DONTWAIT, &err); if (!skb) return -ENOBUFS; skb_reserve(skb, self->max_header_size); IRDA_DEBUG(4, __FUNCTION__ "(), appending user data\n"); asmptr = skb->h.raw = skb_put(skb, len); memcpy_fromiovec(asmptr, msg->msg_iov, len); /* * Just send the message to TinyTP, and let it deal with possible * errors. No need to duplicate all that here */ err = irttp_udata_request(self->tsap, skb); if (err) { IRDA_DEBUG(0, __FUNCTION__ "(), err=%d\n", err); return err; } return len; } /* * Function irda_sendmsg_ultra (sock, msg, len, scm) * * Send message down to IrLMP for the unreliable Ultra * packet service... */ #ifdef CONFIG_IRDA_ULTRA static int irda_sendmsg_ultra(struct socket *sock, struct msghdr *msg, int len, struct scm_cookie *scm) { struct sock *sk = sock->sk; struct irda_sock *self; struct sk_buff *skb; unsigned char *asmptr; int err; IRDA_DEBUG(4, __FUNCTION__ "(), len=%d\n", len); if (msg->msg_flags & ~MSG_DONTWAIT) return -EINVAL; if (sk->shutdown & SEND_SHUTDOWN) { send_sig(SIGPIPE, current, 0); return -EPIPE; } self = sk->protinfo.irda; ASSERT(self != NULL, return -1;); /* * Check that we don't send out to big frames. This is an unreliable * service, so we have no fragmentation and no coalescence */ if (len > self->max_data_size) { IRDA_DEBUG(0, __FUNCTION__ "(), Warning to much data! " "Chopping frame from %d to %d bytes!\n", len, self->max_data_size); len = self->max_data_size; } skb = sock_alloc_send_skb(sk, len + self->max_header_size, 0, msg->msg_flags & MSG_DONTWAIT, &err); if (!skb) return -ENOBUFS; skb_reserve(skb, self->max_header_size); IRDA_DEBUG(4, __FUNCTION__ "(), appending user data\n"); asmptr = skb->h.raw = skb_put(skb, len); memcpy_fromiovec(asmptr, msg->msg_iov, len); err = irlmp_connless_data_request(self->lsap, skb); if (err) { IRDA_DEBUG(0, __FUNCTION__ "(), err=%d\n", err); return err; } return len; } #endif /* CONFIG_IRDA_ULTRA */ /* * Function irda_shutdown (sk, how) * * * */ static int irda_shutdown(struct socket *sock, int how) { struct irda_sock *self; struct sock *sk = sock->sk; IRDA_DEBUG(0, __FUNCTION__ "()\n"); self = sk->protinfo.irda; ASSERT(self != NULL, return -1;); sk->state = TCP_CLOSE; sk->shutdown |= SEND_SHUTDOWN; sk->state_change(sk); if (self->iriap) iriap_close(self->iriap); if (self->tsap) { irttp_disconnect_request(self->tsap, NULL, P_NORMAL); irttp_close_tsap(self->tsap); self->tsap = NULL; } return 0; } /* * Function irda_poll (file, sock, wait) * * * */ static unsigned int irda_poll(struct file * file, struct socket *sock, poll_table *wait) { struct sock *sk = sock->sk; unsigned int mask; IRDA_DEBUG(4, __FUNCTION__ "()\n"); poll_wait(file, sk->sleep, wait); mask = 0; /* exceptional events? */ if (sk->err) mask |= POLLERR; if (sk->shutdown & RCV_SHUTDOWN) mask |= POLLHUP; /* readable? */ if (!skb_queue_empty(&sk->receive_queue)) { IRDA_DEBUG(4, "Socket is readable\n"); mask |= POLLIN | POLLRDNORM; } /* Connection-based need to check for termination and startup */ if (sk->type == SOCK_STREAM && sk->state==TCP_CLOSE) mask |= POLLHUP; /* * we set writable also when the other side has shut down the * connection. This prevents stuck sockets. */ if (sk->sndbuf - (int)atomic_read(&sk->wmem_alloc) >= MIN_WRITE_SPACE) mask |= POLLOUT | POLLWRNORM | POLLWRBAND; return mask; } /* * Function irda_ioctl (sock, cmd, arg) * * * */ static int irda_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) { struct sock *sk = sock->sk; IRDA_DEBUG(4, __FUNCTION__ "(), cmd=%#x\n", cmd); switch (cmd) { case TIOCOUTQ: { long amount; amount = sk->sndbuf - atomic_read(&sk->wmem_alloc); if (amount < 0) amount = 0; if (put_user(amount, (unsigned int *)arg)) return -EFAULT; return 0; } case TIOCINQ: { struct sk_buff *skb; long amount = 0L; /* These two are safe on a single CPU system as only user tasks fiddle here */ if ((skb = skb_peek(&sk->receive_queue)) != NULL) amount = skb->len; if (put_user(amount, (unsigned int *)arg)) return -EFAULT; return 0; } case SIOCGSTAMP: if (sk != NULL) { if (sk->stamp.tv_sec == 0) return -ENOENT; if (copy_to_user((void *)arg, &sk->stamp, sizeof(struct timeval))) return -EFAULT; return 0; } return -EINVAL; case SIOCGIFADDR: case SIOCSIFADDR: case SIOCGIFDSTADDR: case SIOCSIFDSTADDR: case SIOCGIFBRDADDR: case SIOCSIFBRDADDR: case SIOCGIFNETMASK: case SIOCSIFNETMASK: case SIOCGIFMETRIC: case SIOCSIFMETRIC: return -EINVAL; default: IRDA_DEBUG(1, __FUNCTION__ "(), doing device ioctl!\n"); return dev_ioctl(cmd, (void *) arg); } /*NOTREACHED*/ return 0; } /* * Function irda_setsockopt (sock, level, optname, optval, optlen) * * Set some options for the socket * */ static int irda_setsockopt(struct socket *sock, int level, int optname, char *optval, int optlen) { struct sock *sk = sock->sk; struct irda_sock *self; struct irda_ias_set ias_opt; struct ias_object *ias_obj; int opt; self = sk->protinfo.irda; ASSERT(self != NULL, return -1;); if (level != SOL_IRLMP) return -ENOPROTOOPT; switch (optname) { case IRLMP_IAS_SET: if (optlen != sizeof(struct irda_ias_set)) return -EINVAL; /* Copy query to the driver. */ if (copy_from_user(&ias_opt, (char *)optval, optlen)) return -EFAULT; /* Find the object we target */ ias_obj = irias_find_object(ias_opt.irda_class_name); if(ias_obj == (struct ias_object *) NULL) { /* Create a new object */ ias_obj = irias_new_object(ias_opt.irda_class_name, jiffies); } /* Do we have it already ? */ if(irias_find_attrib(ias_obj, ias_opt.irda_attrib_name)) return -EINVAL; /* Look at the type */ switch(ias_opt.irda_attrib_type) { case IAS_INTEGER: /* Add an integer attribute */ irias_add_integer_attrib(ias_obj, ias_opt.irda_attrib_name, ias_opt.attribute.irda_attrib_int); break; case IAS_OCT_SEQ: /* Check length */ if(ias_opt.attribute.irda_attrib_octet_seq.len > IAS_MAX_OCTET_STRING) return -EINVAL; /* Add an octet sequence attribute */ irias_add_octseq_attrib( ias_obj, ias_opt.irda_attrib_name, ias_opt.attribute.irda_attrib_octet_seq.octet_seq, ias_opt.attribute.irda_attrib_octet_seq.len); break; case IAS_STRING: /* Should check charset & co */ /* Check length */ if(ias_opt.attribute.irda_attrib_string.len > IAS_MAX_STRING) return -EINVAL; /* NULL terminate the string (avoid troubles) */ ias_opt.attribute.irda_attrib_string.string[ias_opt.attribute.irda_attrib_string.len] = '\0'; /* Add a string attribute */ irias_add_string_attrib( ias_obj, ias_opt.irda_attrib_name, ias_opt.attribute.irda_attrib_string.string); break; default : return -EINVAL; } irias_insert_object(ias_obj); break; IRDA_DEBUG(0, __FUNCTION__ "(), sorry not impl. yet!\n"); return -ENOPROTOOPT; case IRLMP_MAX_SDU_SIZE: if (optlen < sizeof(int)) return -EINVAL; if (get_user(opt, (int *)optval)) return -EFAULT; /* Only possible for a seqpacket service (TTP with SAR) */ if (sk->type != SOCK_SEQPACKET) { IRDA_DEBUG(2, __FUNCTION__ "(), setting max_sdu_size = %d\n", opt); self->max_sdu_size_rx = opt; } else { WARNING(__FUNCTION__ "(), not allowed to set MAXSDUSIZE for this " "socket type!\n"); return -ENOPROTOOPT; } break; case IRLMP_HINTS_SET: if (optlen < sizeof(int)) return -EINVAL; if (get_user(opt, (int *)optval)) return -EFAULT; /* Unregister any old registration */ if (self->skey) irlmp_unregister_service(self->skey); self->skey = irlmp_register_service((__u16) opt); break; default: return -ENOPROTOOPT; } return 0; } /* * Function irda_simple_getvalue_confirm (obj_id, value, priv) * * Got answer from remote LM-IAS, just copy object to requester... * * Note : duplicate from above, but we need our own version that * doesn't touch the dtsap_sel and save the full value structure... */ static void irda_simple_getvalue_confirm(int result, __u16 obj_id, struct ias_value *value, void *priv) { struct irda_sock *self; IRDA_DEBUG(2, __FUNCTION__ "()\n"); ASSERT(priv != NULL, return;); self = (struct irda_sock *) priv; if (!self) { WARNING(__FUNCTION__ "(), lost myself!\n"); 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(0, __FUNCTION__ "(), IAS query failed!\n"); self->errno = -EHOSTUNREACH; /* Wake up any processes waiting for result */ wake_up_interruptible(&self->ias_wait); return; } /* Clone the object (so the requester can free it) */ self->ias_result = kmalloc(sizeof(struct ias_value), GFP_ATOMIC); memcpy(self->ias_result, value, sizeof(struct ias_value)); irias_delete_value(value); self->errno = 0; /* Wake up any processes waiting for result */ wake_up_interruptible(&self->ias_wait); } /* * Function irda_extract_ias_value(ias_opt, ias_value) * * Translate internal IAS value structure to the user space representation * * The external representation of IAS values, as we exchange them with * user space program is quite different from the internal representation, * as stored in the IAS database (because we need a flat structure for * crossing kernel boundary). * This function transform the former in the latter. We also check * that the value type is valid. */ static int irda_extract_ias_value(struct irda_ias_set *ias_opt, struct ias_value *ias_value) { /* Look at the type */ switch (ias_value->type) { case IAS_INTEGER: /* Copy the integer */ ias_opt->attribute.irda_attrib_int = ias_value->t.integer; break; case IAS_OCT_SEQ: /* Set length */ ias_opt->attribute.irda_attrib_octet_seq.len = ias_value->len; /* Copy over */ memcpy(ias_opt->attribute.irda_attrib_octet_seq.octet_seq, ias_value->t.oct_seq, ias_value->len); break; case IAS_STRING: /* Set length */ ias_opt->attribute.irda_attrib_string.len = ias_value->len; ias_opt->attribute.irda_attrib_string.charset = ias_value->charset; /* Copy over */ memcpy(ias_opt->attribute.irda_attrib_string.string, ias_value->t.string, ias_value->len); /* NULL terminate the string (avoid troubles) */ ias_opt->attribute.irda_attrib_string.string[ias_value->len] = '\0'; break; default : return -EINVAL; } /* Copy type over */ ias_opt->irda_attrib_type = ias_value->type; return 0; } /* * Function irda_getsockopt (sock, level, optname, optval, optlen) * * * */ static int irda_getsockopt(struct socket *sock, int level, int optname, char *optval, int *optlen) { struct sock *sk = sock->sk; struct irda_sock *self; struct irda_device_list list; struct irda_device_info *info; discovery_t *discovery; struct irda_ias_set ias_opt; /* IAS get/query params */ struct ias_object * ias_obj; /* Object in IAS */ struct ias_attrib * ias_attr; /* Attribute in IAS object */ int val = 0; int len = 0; int err; int offset, total; self = sk->protinfo.irda; if (level != SOL_IRLMP) return -ENOPROTOOPT; if (get_user(len, optlen)) return -EFAULT; switch (optname) { case IRLMP_ENUMDEVICES: /* Tell IrLMP we want to be notified */ irlmp_update_client(self->ckey, self->mask, NULL, irda_discovery_indication); /* Do some discovery */ irlmp_discovery_request(self->nslots); /* Check if the we got some results */ if (!cachelog) return -EAGAIN; info = &list.dev[0]; /* Offset to first device entry */ offset = sizeof(struct irda_device_list) - sizeof(struct irda_device_info); total = offset; /* Initialized to size of the device list */ list.len = 0; /* Initialize lenght of list */ /* * Now, check all discovered devices (if any), and notify * client only about the services that the client is * interested in */ discovery = (discovery_t *) hashbin_get_first(cachelog); while (discovery != NULL) { /* Mask out the ones we don't want */ if (discovery->hints.word & self->mask) { /* Check if room for this device entry */ if (len-totalsaddr = discovery->saddr; info->daddr = discovery->daddr; info->charset = discovery->charset; info->hints[0] = discovery->hints.byte[0]; info->hints[1] = discovery->hints.byte[1]; strncpy(info->info, discovery->nickname, NICKNAME_MAX_LEN); if (copy_to_user(optval+total, info, sizeof(struct irda_device_info))) return -EFAULT; list.len++; total += sizeof(struct irda_device_info); } discovery = (discovery_t *) hashbin_get_next(cachelog); } cachelog = NULL; /* Write total number of bytes used back to client */ if (put_user(total, optlen)) return -EFAULT; /* Write total list length back to client */ if (copy_to_user(optval, &list, sizeof(struct irda_device_list) - sizeof(struct irda_device_info))) return -EFAULT; break; case IRLMP_MAX_SDU_SIZE: val = self->max_data_size; len = sizeof(int); if (put_user(len, optlen)) return -EFAULT; if (copy_to_user(optval, &val, len)) return -EFAULT; break; case IRLMP_IAS_GET: /* The user want an object from our local IAS database. * We just need to query the IAS and return the value * that we found */ /* Check that the user has allocated the right space for us */ if (len != sizeof(ias_opt)) return -EINVAL; /* Copy query to the driver. */ if (copy_from_user((char *) &ias_opt, (char *)optval, len)) return -EFAULT; /* Find the object we target */ ias_obj = irias_find_object(ias_opt.irda_class_name); if(ias_obj == (struct ias_object *) NULL) return -EINVAL; /* Find the attribute (in the object) we target */ ias_attr = irias_find_attrib(ias_obj, ias_opt.irda_attrib_name); if(ias_attr == (struct ias_attrib *) NULL) return -EINVAL; /* Translate from internal to user structure */ err = irda_extract_ias_value(&ias_opt, ias_attr->value); if(err) return err; /* Copy reply to the user */ if (copy_to_user((char *)optval, (char *) &ias_opt, sizeof(ias_opt))) return -EFAULT; /* Note : don't need to put optlen, we checked it */ break; case IRLMP_IAS_QUERY: /* The user want an object from a remote IAS database. * We need to use IAP to query the remote database and * then wait for the answer to come back. */ /* Check that the user has allocated the right space for us */ if (len != sizeof(ias_opt)) return -EINVAL; /* Copy query to the driver. */ if (copy_from_user((char *) &ias_opt, (char *)optval, len)) return -EFAULT; /* Check that we can proceed with IAP */ if (self->iriap) { WARNING(__FUNCTION__ "(), busy with a previous query\n"); return -EBUSY; } self->iriap = iriap_open(LSAP_ANY, IAS_CLIENT, self, irda_simple_getvalue_confirm); /* Treat unexpected signals as disconnect */ self->errno = -EHOSTUNREACH; /* Query remote LM-IAS */ iriap_getvaluebyclass_request(self->iriap, self->saddr, self->daddr, ias_opt.irda_class_name, ias_opt.irda_attrib_name); /* Wait for answer */ interruptible_sleep_on(&self->ias_wait); /* Check what happened */ if (self->errno) return (self->errno); /* Translate from internal to user structure */ err = irda_extract_ias_value(&ias_opt, self->ias_result); if (self->ias_result) kfree(self->ias_result); if (err) return err; /* Copy reply to the user */ if (copy_to_user((char *)optval, (char *) &ias_opt, sizeof(ias_opt))) return -EFAULT; /* Note : don't need to put optlen, we checked it */ break; default: return -ENOPROTOOPT; } return 0; } static struct net_proto_family irda_family_ops = { PF_IRDA, irda_create }; static struct proto_ops SOCKOPS_WRAPPED(irda_stream_ops) = { PF_IRDA, irda_release, irda_bind, irda_connect, sock_no_socketpair, irda_accept, irda_getname, irda_poll, irda_ioctl, irda_listen, irda_shutdown, irda_setsockopt, irda_getsockopt, sock_no_fcntl, irda_sendmsg, irda_recvmsg_stream, sock_no_mmap }; static struct proto_ops SOCKOPS_WRAPPED(irda_seqpacket_ops) = { PF_IRDA, irda_release, irda_bind, irda_connect, sock_no_socketpair, irda_accept, irda_getname, datagram_poll, irda_ioctl, irda_listen, irda_shutdown, irda_setsockopt, irda_getsockopt, sock_no_fcntl, irda_sendmsg, irda_recvmsg_dgram, sock_no_mmap, }; static struct proto_ops SOCKOPS_WRAPPED(irda_dgram_ops) = { PF_IRDA, irda_release, irda_bind, irda_connect, sock_no_socketpair, irda_accept, irda_getname, datagram_poll, irda_ioctl, irda_listen, irda_shutdown, irda_setsockopt, irda_getsockopt, sock_no_fcntl, irda_sendmsg_dgram, irda_recvmsg_dgram, sock_no_mmap, }; #ifdef CONFIG_IRDA_ULTRA static struct proto_ops SOCKOPS_WRAPPED(irda_ultra_ops) = { PF_IRDA, irda_release, irda_bind, sock_no_connect, sock_no_socketpair, sock_no_accept, irda_getname, datagram_poll, irda_ioctl, sock_no_listen, irda_shutdown, irda_setsockopt, irda_getsockopt, sock_no_fcntl, irda_sendmsg_ultra, irda_recvmsg_dgram, sock_no_mmap, }; #endif /* CONFIG_IRDA_ULTRA */ #include SOCKOPS_WRAP(irda_stream, PF_IRDA); SOCKOPS_WRAP(irda_seqpacket, PF_IRDA); SOCKOPS_WRAP(irda_dgram, PF_IRDA); /* * Function irda_device_event (this, event, ptr) * * Called when a device is taken up or down * */ static int irda_device_event(struct notifier_block *this, unsigned long event, void *ptr) { struct net_device *dev = (struct net_device *) ptr; /* Reject non IrDA devices */ if (dev->type != ARPHRD_IRDA) return NOTIFY_DONE; switch (event) { case NETDEV_UP: IRDA_DEBUG(3, __FUNCTION__ "(), NETDEV_UP\n"); /* irda_dev_device_up(dev); */ break; case NETDEV_DOWN: IRDA_DEBUG(3, __FUNCTION__ "(), NETDEV_DOWN\n"); /* irda_kill_by_device(dev); */ /* irda_rt_device_down(dev); */ /* irda_dev_device_down(dev); */ break; default: break; } return NOTIFY_DONE; } static struct packet_type irda_packet_type = { 0, /* MUTTER ntohs(ETH_P_IRDA),*/ NULL, irlap_driver_rcv, NULL, NULL, }; static struct notifier_block irda_dev_notifier = { irda_device_event, NULL, 0 }; /* * Function irda_proto_init (pro) * * Initialize IrDA protocol layer * */ void __init irda_proto_init(struct net_proto *pro) { sock_register(&irda_family_ops); irda_packet_type.type = htons(ETH_P_IRDA); dev_add_pack(&irda_packet_type); register_netdevice_notifier(&irda_dev_notifier); irda_init(); } /* * Function irda_proto_cleanup (void) * * Remove IrDA protocol layer * */ #ifdef MODULE void irda_proto_cleanup(void) { irda_packet_type.type = htons(ETH_P_IRDA); dev_remove_pack(&irda_packet_type); unregister_netdevice_notifier(&irda_dev_notifier); sock_unregister(PF_IRDA); irda_cleanup(); return; } #endif /* MODULE */