/*********************************************************************
|
/*********************************************************************
|
*
|
*
|
* Filename: irda_device.c
|
* Filename: irda_device.c
|
* Version: 0.9
|
* Version: 0.9
|
* Description: Utility functions used by the device drivers
|
* Description: Utility functions used by the device drivers
|
* Status: Experimental.
|
* Status: Experimental.
|
* Author: Dag Brattli <dagb@cs.uit.no>
|
* Author: Dag Brattli <dagb@cs.uit.no>
|
* Created at: Sat Oct 9 09:22:27 1999
|
* Created at: Sat Oct 9 09:22:27 1999
|
* Modified at: Sun Jan 23 17:41:24 2000
|
* Modified at: Sun Jan 23 17:41:24 2000
|
* Modified by: Dag Brattli <dagb@cs.uit.no>
|
* Modified by: Dag Brattli <dagb@cs.uit.no>
|
*
|
*
|
* Copyright (c) 1999-2000 Dag Brattli, All Rights Reserved.
|
* Copyright (c) 1999-2000 Dag Brattli, All Rights Reserved.
|
* Copyright (c) 2000-2001 Jean Tourrilhes <jt@hpl.hp.com>
|
* Copyright (c) 2000-2001 Jean Tourrilhes <jt@hpl.hp.com>
|
*
|
*
|
* This program is free software; you can redistribute it and/or
|
* This program is free software; you can redistribute it and/or
|
* modify it under the terms of the GNU General Public License as
|
* modify it under the terms of the GNU General Public License as
|
* published by the Free Software Foundation; either version 2 of
|
* published by the Free Software Foundation; either version 2 of
|
* the License, or (at your option) any later version.
|
* the License, or (at your option) any later version.
|
*
|
*
|
* This program is distributed in the hope that it will be useful,
|
* This program is distributed in the hope that it will be useful,
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
* GNU General Public License for more details.
|
* GNU General Public License for more details.
|
*
|
*
|
* You should have received a copy of the GNU General Public License
|
* You should have received a copy of the GNU General Public License
|
* along with this program; if not, write to the Free Software
|
* along with this program; if not, write to the Free Software
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
* MA 02111-1307 USA
|
* MA 02111-1307 USA
|
*
|
*
|
********************************************************************/
|
********************************************************************/
|
|
|
#include <linux/config.h>
|
#include <linux/config.h>
|
#include <linux/string.h>
|
#include <linux/string.h>
|
#include <linux/proc_fs.h>
|
#include <linux/proc_fs.h>
|
#include <linux/skbuff.h>
|
#include <linux/skbuff.h>
|
#include <linux/if.h>
|
#include <linux/if.h>
|
#include <linux/if_ether.h>
|
#include <linux/if_ether.h>
|
#include <linux/if_arp.h>
|
#include <linux/if_arp.h>
|
#include <linux/netdevice.h>
|
#include <linux/netdevice.h>
|
#include <linux/init.h>
|
#include <linux/init.h>
|
#include <linux/tty.h>
|
#include <linux/tty.h>
|
#include <linux/kmod.h>
|
#include <linux/kmod.h>
|
#include <linux/wireless.h>
|
#include <linux/wireless.h>
|
#include <linux/spinlock.h>
|
#include <linux/spinlock.h>
|
|
|
#include <asm/ioctls.h>
|
#include <asm/ioctls.h>
|
#include <asm/segment.h>
|
#include <asm/segment.h>
|
#include <asm/uaccess.h>
|
#include <asm/uaccess.h>
|
#include <asm/dma.h>
|
#include <asm/dma.h>
|
#include <asm/io.h>
|
#include <asm/io.h>
|
|
|
#include <net/pkt_sched.h>
|
#include <net/pkt_sched.h>
|
|
|
#include <net/irda/irda_device.h>
|
#include <net/irda/irda_device.h>
|
#include <net/irda/irlap.h>
|
#include <net/irda/irlap.h>
|
#include <net/irda/timer.h>
|
#include <net/irda/timer.h>
|
#include <net/irda/wrapper.h>
|
#include <net/irda/wrapper.h>
|
|
|
extern int irtty_init(void);
|
extern int irtty_init(void);
|
extern int nsc_ircc_init(void);
|
extern int nsc_ircc_init(void);
|
extern int ircc_init(void);
|
extern int ircc_init(void);
|
extern int toshoboe_init(void);
|
extern int toshoboe_init(void);
|
extern int litelink_init(void);
|
extern int litelink_init(void);
|
extern int w83977af_init(void);
|
extern int w83977af_init(void);
|
extern int esi_init(void);
|
extern int esi_init(void);
|
extern int tekram_init(void);
|
extern int tekram_init(void);
|
extern int actisys_init(void);
|
extern int actisys_init(void);
|
extern int girbil_init(void);
|
extern int girbil_init(void);
|
extern int sa1100_irda_init(void);
|
extern int sa1100_irda_init(void);
|
extern int ep7211_ir_init(void);
|
extern int ep7211_ir_init(void);
|
extern int mcp2120_init(void);
|
extern int mcp2120_init(void);
|
|
|
static void __irda_task_delete(struct irda_task *task);
|
static void __irda_task_delete(struct irda_task *task);
|
|
|
static hashbin_t *dongles = NULL;
|
static hashbin_t *dongles = NULL;
|
static hashbin_t *tasks = NULL;
|
static hashbin_t *tasks = NULL;
|
|
|
const char *infrared_mode[] = {
|
const char *infrared_mode[] = {
|
"IRDA_IRLAP",
|
"IRDA_IRLAP",
|
"IRDA_RAW",
|
"IRDA_RAW",
|
"SHARP_ASK",
|
"SHARP_ASK",
|
"TV_REMOTE",
|
"TV_REMOTE",
|
};
|
};
|
|
|
#ifdef CONFIG_IRDA_DEBUG
|
#ifdef CONFIG_IRDA_DEBUG
|
static const char *task_state[] = {
|
static const char *task_state[] = {
|
"IRDA_TASK_INIT",
|
"IRDA_TASK_INIT",
|
"IRDA_TASK_DONE",
|
"IRDA_TASK_DONE",
|
"IRDA_TASK_WAIT",
|
"IRDA_TASK_WAIT",
|
"IRDA_TASK_WAIT1",
|
"IRDA_TASK_WAIT1",
|
"IRDA_TASK_WAIT2",
|
"IRDA_TASK_WAIT2",
|
"IRDA_TASK_WAIT3",
|
"IRDA_TASK_WAIT3",
|
"IRDA_TASK_CHILD_INIT",
|
"IRDA_TASK_CHILD_INIT",
|
"IRDA_TASK_CHILD_WAIT",
|
"IRDA_TASK_CHILD_WAIT",
|
"IRDA_TASK_CHILD_DONE",
|
"IRDA_TASK_CHILD_DONE",
|
};
|
};
|
#endif /* CONFIG_IRDA_DEBUG */
|
#endif /* CONFIG_IRDA_DEBUG */
|
|
|
static void irda_task_timer_expired(void *data);
|
static void irda_task_timer_expired(void *data);
|
|
|
#ifdef CONFIG_PROC_FS
|
#ifdef CONFIG_PROC_FS
|
int irda_device_proc_read(char *buf, char **start, off_t offset, int len,
|
int irda_device_proc_read(char *buf, char **start, off_t offset, int len,
|
int unused);
|
int unused);
|
|
|
#endif /* CONFIG_PROC_FS */
|
#endif /* CONFIG_PROC_FS */
|
|
|
int __init irda_device_init( void)
|
int __init irda_device_init( void)
|
{
|
{
|
dongles = hashbin_new(HB_GLOBAL);
|
dongles = hashbin_new(HB_GLOBAL);
|
if (dongles == NULL) {
|
if (dongles == NULL) {
|
printk(KERN_WARNING
|
printk(KERN_WARNING
|
"IrDA: Can't allocate dongles hashbin!\n");
|
"IrDA: Can't allocate dongles hashbin!\n");
|
return -ENOMEM;
|
return -ENOMEM;
|
}
|
}
|
|
|
tasks = hashbin_new(HB_GLOBAL);
|
tasks = hashbin_new(HB_GLOBAL);
|
if (tasks == NULL) {
|
if (tasks == NULL) {
|
printk(KERN_WARNING
|
printk(KERN_WARNING
|
"IrDA: Can't allocate tasks hashbin!\n");
|
"IrDA: Can't allocate tasks hashbin!\n");
|
return -ENOMEM;
|
return -ENOMEM;
|
}
|
}
|
|
|
/*
|
/*
|
* Call the init function of the device drivers that has not been
|
* Call the init function of the device drivers that has not been
|
* compiled as a module
|
* compiled as a module
|
* Note : non-modular IrDA is not supported in 2.4.X, so don't
|
* Note : non-modular IrDA is not supported in 2.4.X, so don't
|
* waste too much time fixing this code. If you require it, please
|
* waste too much time fixing this code. If you require it, please
|
* upgrade to the IrDA stack in 2.5.X. Jean II
|
* upgrade to the IrDA stack in 2.5.X. Jean II
|
*/
|
*/
|
#ifdef CONFIG_IRTTY_SIR
|
#ifdef CONFIG_IRTTY_SIR
|
irtty_init();
|
irtty_init();
|
#endif
|
#endif
|
#ifdef CONFIG_WINBOND_FIR
|
#ifdef CONFIG_WINBOND_FIR
|
w83977af_init();
|
w83977af_init();
|
#endif
|
#endif
|
#ifdef CONFIG_SA1100_FIR
|
#ifdef CONFIG_SA1100_FIR
|
sa1100_irda_init();
|
sa1100_irda_init();
|
#endif
|
#endif
|
#ifdef CONFIG_NSC_FIR
|
#ifdef CONFIG_NSC_FIR
|
nsc_ircc_init();
|
nsc_ircc_init();
|
#endif
|
#endif
|
#ifdef CONFIG_TOSHIBA_OLD
|
#ifdef CONFIG_TOSHIBA_OLD
|
toshoboe_init();
|
toshoboe_init();
|
#endif
|
#endif
|
#ifdef CONFIG_SMC_IRCC_FIR
|
#ifdef CONFIG_SMC_IRCC_FIR
|
ircc_init();
|
ircc_init();
|
#endif
|
#endif
|
#ifdef CONFIG_ESI_DONGLE
|
#ifdef CONFIG_ESI_DONGLE
|
esi_init();
|
esi_init();
|
#endif
|
#endif
|
#ifdef CONFIG_TEKRAM_DONGLE
|
#ifdef CONFIG_TEKRAM_DONGLE
|
tekram_init();
|
tekram_init();
|
#endif
|
#endif
|
#ifdef CONFIG_ACTISYS_DONGLE
|
#ifdef CONFIG_ACTISYS_DONGLE
|
actisys_init();
|
actisys_init();
|
#endif
|
#endif
|
#ifdef CONFIG_GIRBIL_DONGLE
|
#ifdef CONFIG_GIRBIL_DONGLE
|
girbil_init();
|
girbil_init();
|
#endif
|
#endif
|
#ifdef CONFIG_LITELINK_DONGLE
|
#ifdef CONFIG_LITELINK_DONGLE
|
litelink_init();
|
litelink_init();
|
#endif
|
#endif
|
#ifdef CONFIG_OLD_BELKIN
|
#ifdef CONFIG_OLD_BELKIN
|
old_belkin_init();
|
old_belkin_init();
|
#endif
|
#endif
|
#ifdef CONFIG_EP7211_IR
|
#ifdef CONFIG_EP7211_IR
|
ep7211_ir_init();
|
ep7211_ir_init();
|
#endif
|
#endif
|
#ifdef CONFIG_MCP2120_DONGLE
|
#ifdef CONFIG_MCP2120_DONGLE
|
mcp2120_init();
|
mcp2120_init();
|
#endif
|
#endif
|
return 0;
|
return 0;
|
}
|
}
|
|
|
void irda_device_cleanup(void)
|
void irda_device_cleanup(void)
|
{
|
{
|
IRDA_DEBUG(4, "%s()\n", __FUNCTION__);
|
IRDA_DEBUG(4, "%s()\n", __FUNCTION__);
|
|
|
hashbin_delete(tasks, (FREE_FUNC) __irda_task_delete);
|
hashbin_delete(tasks, (FREE_FUNC) __irda_task_delete);
|
hashbin_delete(dongles, NULL);
|
hashbin_delete(dongles, NULL);
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_device_set_media_busy (self, status)
|
* Function irda_device_set_media_busy (self, status)
|
*
|
*
|
* Called when we have detected that another station is transmiting
|
* Called when we have detected that another station is transmiting
|
* in contention mode.
|
* in contention mode.
|
*/
|
*/
|
void irda_device_set_media_busy(struct net_device *dev, int status)
|
void irda_device_set_media_busy(struct net_device *dev, int status)
|
{
|
{
|
struct irlap_cb *self;
|
struct irlap_cb *self;
|
|
|
IRDA_DEBUG(4, "%s(%s)\n", __FUNCTION__, status ? "TRUE" : "FALSE");
|
IRDA_DEBUG(4, "%s(%s)\n", __FUNCTION__, status ? "TRUE" : "FALSE");
|
|
|
self = (struct irlap_cb *) dev->atalk_ptr;
|
self = (struct irlap_cb *) dev->atalk_ptr;
|
|
|
ASSERT(self != NULL, return;);
|
ASSERT(self != NULL, return;);
|
ASSERT(self->magic == LAP_MAGIC, return;);
|
ASSERT(self->magic == LAP_MAGIC, return;);
|
|
|
if (status) {
|
if (status) {
|
self->media_busy = TRUE;
|
self->media_busy = TRUE;
|
if (status == SMALL)
|
if (status == SMALL)
|
irlap_start_mbusy_timer(self, SMALLBUSY_TIMEOUT);
|
irlap_start_mbusy_timer(self, SMALLBUSY_TIMEOUT);
|
else
|
else
|
irlap_start_mbusy_timer(self, MEDIABUSY_TIMEOUT);
|
irlap_start_mbusy_timer(self, MEDIABUSY_TIMEOUT);
|
IRDA_DEBUG( 4, "Media busy!\n");
|
IRDA_DEBUG( 4, "Media busy!\n");
|
} else {
|
} else {
|
self->media_busy = FALSE;
|
self->media_busy = FALSE;
|
irlap_stop_mbusy_timer(self);
|
irlap_stop_mbusy_timer(self);
|
}
|
}
|
}
|
}
|
|
|
int irda_device_set_dtr_rts(struct net_device *dev, int dtr, int rts)
|
int irda_device_set_dtr_rts(struct net_device *dev, int dtr, int rts)
|
{
|
{
|
struct if_irda_req req;
|
struct if_irda_req req;
|
int ret;
|
int ret;
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
|
|
if (!dev->do_ioctl) {
|
if (!dev->do_ioctl) {
|
ERROR("%s(), do_ioctl not impl. by "
|
ERROR("%s(), do_ioctl not impl. by "
|
"device driver\n", __FUNCTION__);
|
"device driver\n", __FUNCTION__);
|
return -1;
|
return -1;
|
}
|
}
|
|
|
req.ifr_dtr = dtr;
|
req.ifr_dtr = dtr;
|
req.ifr_rts = rts;
|
req.ifr_rts = rts;
|
|
|
ret = dev->do_ioctl(dev, (struct ifreq *) &req, SIOCSDTRRTS);
|
ret = dev->do_ioctl(dev, (struct ifreq *) &req, SIOCSDTRRTS);
|
|
|
return ret;
|
return ret;
|
}
|
}
|
|
|
int irda_device_change_speed(struct net_device *dev, __u32 speed)
|
int irda_device_change_speed(struct net_device *dev, __u32 speed)
|
{
|
{
|
struct if_irda_req req;
|
struct if_irda_req req;
|
int ret;
|
int ret;
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
|
|
if (!dev->do_ioctl) {
|
if (!dev->do_ioctl) {
|
ERROR("%s(), do_ioctl not impl. by "
|
ERROR("%s(), do_ioctl not impl. by "
|
"device driver\n", __FUNCTION__);
|
"device driver\n", __FUNCTION__);
|
return -1;
|
return -1;
|
}
|
}
|
|
|
req.ifr_baudrate = speed;
|
req.ifr_baudrate = speed;
|
|
|
ret = dev->do_ioctl(dev, (struct ifreq *) &req, SIOCSBANDWIDTH);
|
ret = dev->do_ioctl(dev, (struct ifreq *) &req, SIOCSBANDWIDTH);
|
|
|
return ret;
|
return ret;
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_device_is_receiving (dev)
|
* Function irda_device_is_receiving (dev)
|
*
|
*
|
* Check if the device driver is currently receiving data
|
* Check if the device driver is currently receiving data
|
*
|
*
|
*/
|
*/
|
int irda_device_is_receiving(struct net_device *dev)
|
int irda_device_is_receiving(struct net_device *dev)
|
{
|
{
|
struct if_irda_req req;
|
struct if_irda_req req;
|
int ret;
|
int ret;
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
|
|
if (!dev->do_ioctl) {
|
if (!dev->do_ioctl) {
|
ERROR("%s(), do_ioctl not impl. by "
|
ERROR("%s(), do_ioctl not impl. by "
|
"device driver\n", __FUNCTION__);
|
"device driver\n", __FUNCTION__);
|
return -1;
|
return -1;
|
}
|
}
|
|
|
ret = dev->do_ioctl(dev, (struct ifreq *) &req, SIOCGRECEIVING);
|
ret = dev->do_ioctl(dev, (struct ifreq *) &req, SIOCGRECEIVING);
|
if (ret < 0)
|
if (ret < 0)
|
return ret;
|
return ret;
|
|
|
return req.ifr_receiving;
|
return req.ifr_receiving;
|
}
|
}
|
|
|
void irda_task_next_state(struct irda_task *task, IRDA_TASK_STATE state)
|
void irda_task_next_state(struct irda_task *task, IRDA_TASK_STATE state)
|
{
|
{
|
IRDA_DEBUG(2, "%s(), state = %s\n", __FUNCTION__, task_state[state]);
|
IRDA_DEBUG(2, "%s(), state = %s\n", __FUNCTION__, task_state[state]);
|
|
|
task->state = state;
|
task->state = state;
|
}
|
}
|
|
|
static void __irda_task_delete(struct irda_task *task)
|
static void __irda_task_delete(struct irda_task *task)
|
{
|
{
|
del_timer(&task->timer);
|
del_timer(&task->timer);
|
|
|
kfree(task);
|
kfree(task);
|
}
|
}
|
|
|
void irda_task_delete(struct irda_task *task)
|
void irda_task_delete(struct irda_task *task)
|
{
|
{
|
/* Unregister task */
|
/* Unregister task */
|
hashbin_remove(tasks, (int) task, NULL);
|
hashbin_remove(tasks, (int) task, NULL);
|
|
|
__irda_task_delete(task);
|
__irda_task_delete(task);
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_task_kick (task)
|
* Function irda_task_kick (task)
|
*
|
*
|
* Tries to execute a task possible multiple times until the task is either
|
* Tries to execute a task possible multiple times until the task is either
|
* finished, or askes for a timeout. When a task is finished, we do post
|
* finished, or askes for a timeout. When a task is finished, we do post
|
* processing, and notify the parent task, that is waiting for this task
|
* processing, and notify the parent task, that is waiting for this task
|
* to complete.
|
* to complete.
|
*/
|
*/
|
int irda_task_kick(struct irda_task *task)
|
int irda_task_kick(struct irda_task *task)
|
{
|
{
|
int finished = TRUE;
|
int finished = TRUE;
|
int count = 0;
|
int count = 0;
|
int timeout;
|
int timeout;
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
|
|
ASSERT(task != NULL, return -1;);
|
ASSERT(task != NULL, return -1;);
|
ASSERT(task->magic == IRDA_TASK_MAGIC, return -1;);
|
ASSERT(task->magic == IRDA_TASK_MAGIC, return -1;);
|
|
|
/* Execute task until it's finished, or askes for a timeout */
|
/* Execute task until it's finished, or askes for a timeout */
|
do {
|
do {
|
timeout = task->function(task);
|
timeout = task->function(task);
|
if (count++ > 100) {
|
if (count++ > 100) {
|
ERROR("%s(), error in task handler!\n", __FUNCTION__);
|
ERROR("%s(), error in task handler!\n", __FUNCTION__);
|
irda_task_delete(task);
|
irda_task_delete(task);
|
return TRUE;
|
return TRUE;
|
}
|
}
|
} while ((timeout == 0) && (task->state != IRDA_TASK_DONE));
|
} while ((timeout == 0) && (task->state != IRDA_TASK_DONE));
|
|
|
if (timeout < 0) {
|
if (timeout < 0) {
|
ERROR("%s(), Error executing task!\n", __FUNCTION__);
|
ERROR("%s(), Error executing task!\n", __FUNCTION__);
|
irda_task_delete(task);
|
irda_task_delete(task);
|
return TRUE;
|
return TRUE;
|
}
|
}
|
|
|
/* Check if we are finished */
|
/* Check if we are finished */
|
if (task->state == IRDA_TASK_DONE) {
|
if (task->state == IRDA_TASK_DONE) {
|
del_timer(&task->timer);
|
del_timer(&task->timer);
|
|
|
/* Do post processing */
|
/* Do post processing */
|
if (task->finished)
|
if (task->finished)
|
task->finished(task);
|
task->finished(task);
|
|
|
/* Notify parent */
|
/* Notify parent */
|
if (task->parent) {
|
if (task->parent) {
|
/* Check if parent is waiting for us to complete */
|
/* Check if parent is waiting for us to complete */
|
if (task->parent->state == IRDA_TASK_CHILD_WAIT) {
|
if (task->parent->state == IRDA_TASK_CHILD_WAIT) {
|
task->parent->state = IRDA_TASK_CHILD_DONE;
|
task->parent->state = IRDA_TASK_CHILD_DONE;
|
|
|
/* Stop timer now that we are here */
|
/* Stop timer now that we are here */
|
del_timer(&task->parent->timer);
|
del_timer(&task->parent->timer);
|
|
|
/* Kick parent task */
|
/* Kick parent task */
|
irda_task_kick(task->parent);
|
irda_task_kick(task->parent);
|
}
|
}
|
}
|
}
|
irda_task_delete(task);
|
irda_task_delete(task);
|
} else if (timeout > 0) {
|
} else if (timeout > 0) {
|
irda_start_timer(&task->timer, timeout, (void *) task,
|
irda_start_timer(&task->timer, timeout, (void *) task,
|
irda_task_timer_expired);
|
irda_task_timer_expired);
|
finished = FALSE;
|
finished = FALSE;
|
} else {
|
} else {
|
IRDA_DEBUG(0, "%s(), not finished, and no timeout!\n", __FUNCTION__);
|
IRDA_DEBUG(0, "%s(), not finished, and no timeout!\n", __FUNCTION__);
|
finished = FALSE;
|
finished = FALSE;
|
}
|
}
|
|
|
return finished;
|
return finished;
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_task_execute (instance, function, finished)
|
* Function irda_task_execute (instance, function, finished)
|
*
|
*
|
* This function registers and tries to execute tasks that may take some
|
* This function registers and tries to execute tasks that may take some
|
* time to complete. We do it this hairy way since we may have been
|
* time to complete. We do it this hairy way since we may have been
|
* called from interrupt context, so it's not possible to use
|
* called from interrupt context, so it's not possible to use
|
* schedule_timeout()
|
* schedule_timeout()
|
* Two important notes :
|
* Two important notes :
|
* o Make sure you irda_task_delete(task); in case you delete the
|
* o Make sure you irda_task_delete(task); in case you delete the
|
* calling instance.
|
* calling instance.
|
* o No real need to lock when calling this function, but you may
|
* o No real need to lock when calling this function, but you may
|
* want to lock within the task handler.
|
* want to lock within the task handler.
|
* Jean II
|
* Jean II
|
*/
|
*/
|
struct irda_task *irda_task_execute(void *instance,
|
struct irda_task *irda_task_execute(void *instance,
|
IRDA_TASK_CALLBACK function,
|
IRDA_TASK_CALLBACK function,
|
IRDA_TASK_CALLBACK finished,
|
IRDA_TASK_CALLBACK finished,
|
struct irda_task *parent, void *param)
|
struct irda_task *parent, void *param)
|
{
|
{
|
struct irda_task *task;
|
struct irda_task *task;
|
int ret;
|
int ret;
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
|
|
task = kmalloc(sizeof(struct irda_task), GFP_ATOMIC);
|
task = kmalloc(sizeof(struct irda_task), GFP_ATOMIC);
|
if (!task)
|
if (!task)
|
return NULL;
|
return NULL;
|
|
|
task->state = IRDA_TASK_INIT;
|
task->state = IRDA_TASK_INIT;
|
task->instance = instance;
|
task->instance = instance;
|
task->function = function;
|
task->function = function;
|
task->finished = finished;
|
task->finished = finished;
|
task->parent = parent;
|
task->parent = parent;
|
task->param = param;
|
task->param = param;
|
task->magic = IRDA_TASK_MAGIC;
|
task->magic = IRDA_TASK_MAGIC;
|
|
|
init_timer(&task->timer);
|
init_timer(&task->timer);
|
|
|
/* Register task */
|
/* Register task */
|
hashbin_insert(tasks, (irda_queue_t *) task, (int) task, NULL);
|
hashbin_insert(tasks, (irda_queue_t *) task, (int) task, NULL);
|
|
|
/* No time to waste, so lets get going! */
|
/* No time to waste, so lets get going! */
|
ret = irda_task_kick(task);
|
ret = irda_task_kick(task);
|
if (ret)
|
if (ret)
|
return NULL;
|
return NULL;
|
else
|
else
|
return task;
|
return task;
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_task_timer_expired (data)
|
* Function irda_task_timer_expired (data)
|
*
|
*
|
* Task time has expired. We now try to execute task (again), and restart
|
* Task time has expired. We now try to execute task (again), and restart
|
* the timer if the task has not finished yet
|
* the timer if the task has not finished yet
|
*/
|
*/
|
static void irda_task_timer_expired(void *data)
|
static void irda_task_timer_expired(void *data)
|
{
|
{
|
struct irda_task *task;
|
struct irda_task *task;
|
|
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
|
|
|
task = (struct irda_task *) data;
|
task = (struct irda_task *) data;
|
|
|
irda_task_kick(task);
|
irda_task_kick(task);
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_device_setup (dev)
|
* Function irda_device_setup (dev)
|
*
|
*
|
* This function should be used by low level device drivers in a similar way
|
* This function should be used by low level device drivers in a similar way
|
* as ether_setup() is used by normal network device drivers
|
* as ether_setup() is used by normal network device drivers
|
*/
|
*/
|
int irda_device_setup(struct net_device *dev)
|
int irda_device_setup(struct net_device *dev)
|
{
|
{
|
ASSERT(dev != NULL, return -1;);
|
ASSERT(dev != NULL, return -1;);
|
|
|
dev->hard_header_len = 0;
|
dev->hard_header_len = 0;
|
dev->addr_len = 0;
|
dev->addr_len = 0;
|
|
|
dev->features |= NETIF_F_DYNALLOC;
|
dev->features |= NETIF_F_DYNALLOC;
|
/* dev->destructor = irda_device_destructor; */
|
/* dev->destructor = irda_device_destructor; */
|
|
|
dev->type = ARPHRD_IRDA;
|
dev->type = ARPHRD_IRDA;
|
dev->tx_queue_len = 8; /* Window size + 1 s-frame */
|
dev->tx_queue_len = 8; /* Window size + 1 s-frame */
|
|
|
memset(dev->broadcast, 0xff, 4);
|
memset(dev->broadcast, 0xff, 4);
|
|
|
dev->mtu = 2048;
|
dev->mtu = 2048;
|
dev->flags = IFF_NOARP;
|
dev->flags = IFF_NOARP;
|
return 0;
|
return 0;
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_device_txqueue_empty (dev)
|
* Function irda_device_txqueue_empty (dev)
|
*
|
*
|
* Check if there is still some frames in the transmit queue for this
|
* Check if there is still some frames in the transmit queue for this
|
* device. Maybe we should use: q->q.qlen == 0.
|
* device. Maybe we should use: q->q.qlen == 0.
|
*
|
*
|
*/
|
*/
|
int irda_device_txqueue_empty(struct net_device *dev)
|
int irda_device_txqueue_empty(struct net_device *dev)
|
{
|
{
|
if (skb_queue_len(&dev->qdisc->q))
|
if (skb_queue_len(&dev->qdisc->q))
|
return FALSE;
|
return FALSE;
|
|
|
return TRUE;
|
return TRUE;
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_device_init_dongle (self, type, qos)
|
* Function irda_device_init_dongle (self, type, qos)
|
*
|
*
|
* Initialize attached dongle.
|
* Initialize attached dongle.
|
*
|
*
|
* Important : request_module require us to call this function with
|
* Important : request_module require us to call this function with
|
* a process context and irq enabled. - Jean II
|
* a process context and irq enabled. - Jean II
|
*/
|
*/
|
dongle_t *irda_device_dongle_init(struct net_device *dev, int type)
|
dongle_t *irda_device_dongle_init(struct net_device *dev, int type)
|
{
|
{
|
struct dongle_reg *reg;
|
struct dongle_reg *reg;
|
dongle_t *dongle;
|
dongle_t *dongle;
|
|
|
ASSERT(dev != NULL, return NULL;);
|
ASSERT(dev != NULL, return NULL;);
|
|
|
#ifdef CONFIG_KMOD
|
#ifdef CONFIG_KMOD
|
{
|
{
|
char modname[32];
|
char modname[32];
|
ASSERT(!in_interrupt(), return NULL;);
|
ASSERT(!in_interrupt(), return NULL;);
|
/* Try to load the module needed */
|
/* Try to load the module needed */
|
sprintf(modname, "irda-dongle-%d", type);
|
sprintf(modname, "irda-dongle-%d", type);
|
request_module(modname);
|
request_module(modname);
|
}
|
}
|
#endif /* CONFIG_KMOD */
|
#endif /* CONFIG_KMOD */
|
|
|
if (!(reg = hashbin_find(dongles, type, NULL))) {
|
if (!(reg = hashbin_find(dongles, type, NULL))) {
|
ERROR("IrDA: Unable to find requested dongle\n");
|
ERROR("IrDA: Unable to find requested dongle\n");
|
return NULL;
|
return NULL;
|
}
|
}
|
|
|
/* Allocate dongle info for this instance */
|
/* Allocate dongle info for this instance */
|
dongle = kmalloc(sizeof(dongle_t), GFP_KERNEL);
|
dongle = kmalloc(sizeof(dongle_t), GFP_KERNEL);
|
if (!dongle)
|
if (!dongle)
|
return NULL;
|
return NULL;
|
|
|
memset(dongle, 0, sizeof(dongle_t));
|
memset(dongle, 0, sizeof(dongle_t));
|
|
|
/* Bind the registration info to this particular instance */
|
/* Bind the registration info to this particular instance */
|
dongle->issue = reg;
|
dongle->issue = reg;
|
dongle->dev = dev;
|
dongle->dev = dev;
|
|
|
return dongle;
|
return dongle;
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_device_dongle_cleanup (dongle)
|
* Function irda_device_dongle_cleanup (dongle)
|
*
|
*
|
*
|
*
|
*
|
*
|
*/
|
*/
|
int irda_device_dongle_cleanup(dongle_t *dongle)
|
int irda_device_dongle_cleanup(dongle_t *dongle)
|
{
|
{
|
ASSERT(dongle != NULL, return -1;);
|
ASSERT(dongle != NULL, return -1;);
|
|
|
dongle->issue->close(dongle);
|
dongle->issue->close(dongle);
|
|
|
kfree(dongle);
|
kfree(dongle);
|
|
|
return 0;
|
return 0;
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_device_register_dongle (dongle)
|
* Function irda_device_register_dongle (dongle)
|
*
|
*
|
*
|
*
|
*
|
*
|
*/
|
*/
|
int irda_device_register_dongle(struct dongle_reg *new)
|
int irda_device_register_dongle(struct dongle_reg *new)
|
{
|
{
|
/* Check if this dongle has been registred before */
|
/* Check if this dongle has been registred before */
|
if (hashbin_find(dongles, new->type, NULL)) {
|
if (hashbin_find(dongles, new->type, NULL)) {
|
MESSAGE("%s(), Dongle already registered\n", __FUNCTION__);
|
MESSAGE("%s(), Dongle already registered\n", __FUNCTION__);
|
return 0;
|
return 0;
|
}
|
}
|
|
|
/* Insert IrDA dongle into hashbin */
|
/* Insert IrDA dongle into hashbin */
|
hashbin_insert(dongles, (irda_queue_t *) new, new->type, NULL);
|
hashbin_insert(dongles, (irda_queue_t *) new, new->type, NULL);
|
|
|
return 0;
|
return 0;
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_device_unregister_dongle (dongle)
|
* Function irda_device_unregister_dongle (dongle)
|
*
|
*
|
* Unregister dongle, and remove dongle from list of registred dongles
|
* Unregister dongle, and remove dongle from list of registred dongles
|
*
|
*
|
*/
|
*/
|
void irda_device_unregister_dongle(struct dongle_reg *dongle)
|
void irda_device_unregister_dongle(struct dongle_reg *dongle)
|
{
|
{
|
struct dongle *node;
|
struct dongle *node;
|
|
|
node = hashbin_remove(dongles, dongle->type, NULL);
|
node = hashbin_remove(dongles, dongle->type, NULL);
|
if (!node) {
|
if (!node) {
|
ERROR("%s(), dongle not found!\n", __FUNCTION__);
|
ERROR("%s(), dongle not found!\n", __FUNCTION__);
|
return;
|
return;
|
}
|
}
|
}
|
}
|
|
|
/*
|
/*
|
* Function irda_device_set_mode (self, mode)
|
* Function irda_device_set_mode (self, mode)
|
*
|
*
|
* Set the Infrared device driver into mode where it sends and receives
|
* Set the Infrared device driver into mode where it sends and receives
|
* data without using IrLAP framing. Check out the particular device
|
* data without using IrLAP framing. Check out the particular device
|
* driver to find out which modes it support.
|
* driver to find out which modes it support.
|
*/
|
*/
|
int irda_device_set_mode(struct net_device* dev, int mode)
|
int irda_device_set_mode(struct net_device* dev, int mode)
|
{
|
{
|
struct if_irda_req req;
|
struct if_irda_req req;
|
int ret;
|
int ret;
|
|
|
IRDA_DEBUG(0, "%s()\n", __FUNCTION__);
|
IRDA_DEBUG(0, "%s()\n", __FUNCTION__);
|
|
|
if (!dev->do_ioctl) {
|
if (!dev->do_ioctl) {
|
ERROR("%s(), set_raw_mode not impl. by "
|
ERROR("%s(), set_raw_mode not impl. by "
|
"device driver\n", __FUNCTION__);
|
"device driver\n", __FUNCTION__);
|
return -1;
|
return -1;
|
}
|
}
|
|
|
req.ifr_mode = mode;
|
req.ifr_mode = mode;
|
|
|
ret = dev->do_ioctl(dev, (struct ifreq *) &req, SIOCSMODE);
|
ret = dev->do_ioctl(dev, (struct ifreq *) &req, SIOCSMODE);
|
|
|
return ret;
|
return ret;
|
}
|
}
|
|
|
/*
|
/*
|
* Function setup_dma (idev, buffer, count, mode)
|
* Function setup_dma (idev, buffer, count, mode)
|
*
|
*
|
* Setup the DMA channel. Commonly used by ISA FIR drivers
|
* Setup the DMA channel. Commonly used by ISA FIR drivers
|
*
|
*
|
*/
|
*/
|
void setup_dma(int channel, char *buffer, int count, int mode)
|
void setup_dma(int channel, char *buffer, int count, int mode)
|
{
|
{
|
unsigned long flags;
|
unsigned long flags;
|
|
|
flags = claim_dma_lock();
|
flags = claim_dma_lock();
|
|
|
disable_dma(channel);
|
disable_dma(channel);
|
clear_dma_ff(channel);
|
clear_dma_ff(channel);
|
set_dma_mode(channel, mode);
|
set_dma_mode(channel, mode);
|
set_dma_addr(channel, virt_to_bus(buffer));
|
set_dma_addr(channel, virt_to_bus(buffer));
|
set_dma_count(channel, count);
|
set_dma_count(channel, count);
|
enable_dma(channel);
|
enable_dma(channel);
|
|
|
release_dma_lock(flags);
|
release_dma_lock(flags);
|
}
|
}
|
|
|
