OpenCores
URL https://opencores.org/ocsvn/or1k/or1k/trunk

Subversion Repositories or1k

[/] [or1k/] [trunk/] [linux/] [linux-2.4/] [net/] [irda/] [irda_device.c] - Diff between revs 1275 and 1765

Only display areas with differences | Details | Blame | View Log

Rev 1275 Rev 1765
/*********************************************************************
/*********************************************************************
 *
 *
 * 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);
}
}
 
 

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.