Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* $Id: hysdn_sched.c,v 1.5.6.4 2001/11/06 21:58:19 kai Exp $ |
| 2 | * |
| 3 | * Linux driver for HYSDN cards |
| 4 | * scheduler routines for handling exchange card <-> pc. |
| 5 | * |
| 6 | * Author Werner Cornelius (werner@titro.de) for Hypercope GmbH |
| 7 | * Copyright 1999 by Werner Cornelius (werner@titro.de) |
| 8 | * |
| 9 | * This software may be used and distributed according to the terms |
| 10 | * of the GNU General Public License, incorporated herein by reference. |
| 11 | * |
| 12 | */ |
| 13 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 14 | #include <linux/signal.h> |
| 15 | #include <linux/kernel.h> |
| 16 | #include <linux/ioport.h> |
| 17 | #include <linux/interrupt.h> |
| 18 | #include <linux/delay.h> |
| 19 | #include <asm/io.h> |
| 20 | |
| 21 | #include "hysdn_defs.h" |
| 22 | |
| 23 | /*****************************************************************************/ |
| 24 | /* hysdn_sched_rx is called from the cards handler to announce new data is */ |
| 25 | /* available from the card. The routine has to handle the data and return */ |
| 26 | /* with a nonzero code if the data could be worked (or even thrown away), if */ |
| 27 | /* no room to buffer the data is available a zero return tells the card */ |
| 28 | /* to keep the data until later. */ |
| 29 | /*****************************************************************************/ |
| 30 | int |
Andrew Morton | c721bcc | 2006-03-25 03:07:04 -0800 | [diff] [blame] | 31 | hysdn_sched_rx(hysdn_card *card, unsigned char *buf, unsigned short len, |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 32 | unsigned short chan) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 33 | { |
| 34 | |
| 35 | switch (chan) { |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 36 | case CHAN_NDIS_DATA: |
| 37 | if (hynet_enable & (1 << card->myid)) { |
| 38 | /* give packet to network handler */ |
| 39 | hysdn_rx_netpkt(card, buf, len); |
| 40 | } |
| 41 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 43 | case CHAN_ERRLOG: |
| 44 | hysdn_card_errlog(card, (tErrLogEntry *) buf, len); |
| 45 | if (card->err_log_state == ERRLOG_STATE_ON) |
| 46 | card->err_log_state = ERRLOG_STATE_START; /* start new fetch */ |
| 47 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | #ifdef CONFIG_HYSDN_CAPI |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 49 | case CHAN_CAPI: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 50 | /* give packet to CAPI handler */ |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 51 | if (hycapi_enable & (1 << card->myid)) { |
| 52 | hycapi_rx_capipkt(card, buf, len); |
| 53 | } |
| 54 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 55 | #endif /* CONFIG_HYSDN_CAPI */ |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 56 | default: |
| 57 | printk(KERN_INFO "irq message channel %d len %d unhandled \n", chan, len); |
| 58 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | |
| 60 | } /* switch rx channel */ |
| 61 | |
| 62 | return (1); /* always handled */ |
| 63 | } /* hysdn_sched_rx */ |
| 64 | |
| 65 | /*****************************************************************************/ |
| 66 | /* hysdn_sched_tx is called from the cards handler to announce that there is */ |
| 67 | /* room in the tx-buffer to the card and data may be sent if needed. */ |
| 68 | /* If the routine wants to send data it must fill buf, len and chan with the */ |
| 69 | /* appropriate data and return a nonzero value. With a zero return no new */ |
| 70 | /* data to send is assumed. maxlen specifies the buffer size available for */ |
| 71 | /* sending. */ |
| 72 | /*****************************************************************************/ |
| 73 | int |
Andrew Morton | c721bcc | 2006-03-25 03:07:04 -0800 | [diff] [blame] | 74 | hysdn_sched_tx(hysdn_card *card, unsigned char *buf, |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 75 | unsigned short volatile *len, unsigned short volatile *chan, |
| 76 | unsigned short maxlen) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | { |
| 78 | struct sk_buff *skb; |
| 79 | |
| 80 | if (card->net_tx_busy) { |
| 81 | card->net_tx_busy = 0; /* reset flag */ |
| 82 | hysdn_tx_netack(card); /* acknowledge packet send */ |
| 83 | } /* a network packet has completely been transferred */ |
| 84 | /* first of all async requests are handled */ |
| 85 | if (card->async_busy) { |
| 86 | if (card->async_len <= maxlen) { |
| 87 | memcpy(buf, card->async_data, card->async_len); |
| 88 | *len = card->async_len; |
| 89 | *chan = card->async_channel; |
| 90 | card->async_busy = 0; /* reset request */ |
| 91 | return (1); |
| 92 | } |
| 93 | card->async_busy = 0; /* in case of length error */ |
| 94 | } /* async request */ |
| 95 | if ((card->err_log_state == ERRLOG_STATE_START) && |
| 96 | (maxlen >= ERRLOG_CMD_REQ_SIZE)) { |
| 97 | strcpy(buf, ERRLOG_CMD_REQ); /* copy the command */ |
| 98 | *len = ERRLOG_CMD_REQ_SIZE; /* buffer length */ |
| 99 | *chan = CHAN_ERRLOG; /* and channel */ |
| 100 | card->err_log_state = ERRLOG_STATE_ON; /* new state is on */ |
| 101 | return (1); /* tell that data should be send */ |
| 102 | } /* error log start and able to send */ |
| 103 | if ((card->err_log_state == ERRLOG_STATE_STOP) && |
| 104 | (maxlen >= ERRLOG_CMD_STOP_SIZE)) { |
| 105 | strcpy(buf, ERRLOG_CMD_STOP); /* copy the command */ |
| 106 | *len = ERRLOG_CMD_STOP_SIZE; /* buffer length */ |
| 107 | *chan = CHAN_ERRLOG; /* and channel */ |
| 108 | card->err_log_state = ERRLOG_STATE_OFF; /* new state is off */ |
| 109 | return (1); /* tell that data should be send */ |
| 110 | } /* error log start and able to send */ |
| 111 | /* now handle network interface packets */ |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 112 | if ((hynet_enable & (1 << card->myid)) && |
| 113 | (skb = hysdn_tx_netget(card)) != NULL) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 114 | { |
| 115 | if (skb->len <= maxlen) { |
Arnaldo Carvalho de Melo | d626f62 | 2007-03-27 18:55:52 -0300 | [diff] [blame] | 116 | /* copy the packet to the buffer */ |
| 117 | skb_copy_from_linear_data(skb, buf, skb->len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 118 | *len = skb->len; |
| 119 | *chan = CHAN_NDIS_DATA; |
| 120 | card->net_tx_busy = 1; /* we are busy sending network data */ |
| 121 | return (1); /* go and send the data */ |
| 122 | } else |
| 123 | hysdn_tx_netack(card); /* aknowledge packet -> throw away */ |
| 124 | } /* send a network packet if available */ |
| 125 | #ifdef CONFIG_HYSDN_CAPI |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 126 | if (((hycapi_enable & (1 << card->myid))) && |
| 127 | ((skb = hycapi_tx_capiget(card)) != NULL)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 128 | { |
| 129 | if (skb->len <= maxlen) { |
Arnaldo Carvalho de Melo | d626f62 | 2007-03-27 18:55:52 -0300 | [diff] [blame] | 130 | skb_copy_from_linear_data(skb, buf, skb->len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | *len = skb->len; |
| 132 | *chan = CHAN_CAPI; |
| 133 | hycapi_tx_capiack(card); |
| 134 | return (1); /* go and send the data */ |
| 135 | } |
| 136 | } |
| 137 | #endif /* CONFIG_HYSDN_CAPI */ |
| 138 | return (0); /* nothing to send */ |
| 139 | } /* hysdn_sched_tx */ |
| 140 | |
| 141 | |
| 142 | /*****************************************************************************/ |
| 143 | /* send one config line to the card and return 0 if successful, otherwise a */ |
| 144 | /* negative error code. */ |
| 145 | /* The function works with timeouts perhaps not giving the greatest speed */ |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 146 | /* sending the line, but this should be meaningless because only some lines */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 147 | /* are to be sent and this happens very seldom. */ |
| 148 | /*****************************************************************************/ |
| 149 | int |
Andrew Morton | c721bcc | 2006-03-25 03:07:04 -0800 | [diff] [blame] | 150 | hysdn_tx_cfgline(hysdn_card *card, unsigned char *line, unsigned short chan) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 151 | { |
| 152 | int cnt = 50; /* timeout intervalls */ |
Andrew Morton | c721bcc | 2006-03-25 03:07:04 -0800 | [diff] [blame] | 153 | unsigned long flags; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 154 | |
| 155 | if (card->debug_flags & LOG_SCHED_ASYN) |
| 156 | hysdn_addlog(card, "async tx-cfg chan=%d len=%d", chan, strlen(line) + 1); |
| 157 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 158 | while (card->async_busy) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 159 | |
| 160 | if (card->debug_flags & LOG_SCHED_ASYN) |
| 161 | hysdn_addlog(card, "async tx-cfg delayed"); |
| 162 | |
| 163 | msleep_interruptible(20); /* Timeout 20ms */ |
Amol Lad | 1f604c4 | 2006-11-02 22:07:25 -0800 | [diff] [blame] | 164 | if (!--cnt) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 165 | return (-ERR_ASYNC_TIME); /* timed out */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 166 | } /* wait for buffer to become free */ |
| 167 | |
Amol Lad | 1f604c4 | 2006-11-02 22:07:25 -0800 | [diff] [blame] | 168 | spin_lock_irqsave(&card->hysdn_lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 169 | strcpy(card->async_data, line); |
| 170 | card->async_len = strlen(line) + 1; |
| 171 | card->async_channel = chan; |
| 172 | card->async_busy = 1; /* request transfer */ |
| 173 | |
| 174 | /* now queue the task */ |
| 175 | schedule_work(&card->irq_queue); |
Amol Lad | 1f604c4 | 2006-11-02 22:07:25 -0800 | [diff] [blame] | 176 | spin_unlock_irqrestore(&card->hysdn_lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 177 | |
| 178 | if (card->debug_flags & LOG_SCHED_ASYN) |
| 179 | hysdn_addlog(card, "async tx-cfg data queued"); |
| 180 | |
| 181 | cnt++; /* short delay */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 182 | |
| 183 | while (card->async_busy) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 184 | |
| 185 | if (card->debug_flags & LOG_SCHED_ASYN) |
| 186 | hysdn_addlog(card, "async tx-cfg waiting for tx-ready"); |
| 187 | |
| 188 | msleep_interruptible(20); /* Timeout 20ms */ |
Amol Lad | 1f604c4 | 2006-11-02 22:07:25 -0800 | [diff] [blame] | 189 | if (!--cnt) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 190 | return (-ERR_ASYNC_TIME); /* timed out */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 191 | } /* wait for buffer to become free again */ |
| 192 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 193 | if (card->debug_flags & LOG_SCHED_ASYN) |
| 194 | hysdn_addlog(card, "async tx-cfg data send"); |
| 195 | |
| 196 | return (0); /* line send correctly */ |
| 197 | } /* hysdn_tx_cfgline */ |