Merge branch 'sched/new-API-sched_setscheduler' of git://git.kernel.org/pub/scm/linux...
[linux-2.6] / drivers / isdn / hardware / eicon / istream.c
1
2 /*
3  *
4   Copyright (c) Eicon Networks, 2002.
5  *
6   This source file is supplied for the use with
7   Eicon Networks range of DIVA Server Adapters.
8  *
9   Eicon File Revision :    2.1
10  *
11   This program is free software; you can redistribute it and/or modify
12   it under the terms of the GNU General Public License as published by
13   the Free Software Foundation; either version 2, or (at your option)
14   any later version.
15  *
16   This program is distributed in the hope that it will be useful,
17   but WITHOUT ANY WARRANTY OF ANY KIND WHATSOEVER INCLUDING ANY
18   implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
19   See the GNU General Public License for more details.
20  *
21   You should have received a copy of the GNU General Public License
22   along with this program; if not, write to the Free Software
23   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
24  *
25  */
26 #include "platform.h"
27 #if defined(DIVA_ISTREAM) /* { */
28 #include "pc.h"
29 #include "pr_pc.h"
30 #include "di_defs.h"
31 #include "divasync.h"
32 #include "di.h"
33 #if !defined USE_EXTENDED_DEBUGS
34   #include "dimaint.h"
35 #else
36   #define dprintf
37 #endif
38 #include "dfifo.h"
39 int diva_istream_write (void* context,
40              int   Id,
41               void* data,
42              int length,
43              int final,
44             byte usr1,
45             byte usr2);
46 int diva_istream_read (void* context,
47             int Id,
48             void* data,
49             int max_length,
50             int* final,
51             byte* usr1,
52             byte* usr2);
53 /* -------------------------------------------------------------------
54   Does provide iStream interface to the client
55    ------------------------------------------------------------------- */
56 void diva_xdi_provide_istream_info (ADAPTER* a,
57                   diva_xdi_stream_interface_t* pi) {
58   pi->provided_service = 0;
59 }
60 /* ------------------------------------------------------------------
61   Does write the data from caller's buffer to the card's
62   stream interface.
63   If synchronous service was requested, then function
64   does return amount of data written to stream.
65   'final' does indicate that pice of data to be written is
66   final part of frame (necessary only by structured datatransfer)
67   return  0 if zero lengh packet was written
68   return -1 if stream is full
69   ------------------------------------------------------------------ */
70 int diva_istream_write (void* context,
71                 int   Id,
72                   void* data,
73                  int length,
74                  int final,
75                 byte usr1,
76                 byte usr2) {
77  ADAPTER* a = (ADAPTER*)context;
78  int written = 0, to_write = -1;
79  char tmp[4];
80  byte* data_ptr = (byte*)data;
81  for (;;) {
82   a->ram_in_dw (a,
83 #ifdef PLATFORM_GT_32BIT
84          ULongToPtr(a->tx_stream[Id] + a->tx_pos[Id]),
85 #else
86          (void*)(a->tx_stream[Id] + a->tx_pos[Id]),
87 #endif
88                   (dword*)&tmp[0],
89          1);
90   if (tmp[0] & DIVA_DFIFO_READY) { /* No free blocks more */
91    if (to_write < 0)
92     return (-1); /* was not able to write       */
93    break;     /* only part of message was written */
94   }
95   to_write = min(length, DIVA_DFIFO_DATA_SZ);
96   if (to_write) {
97    a->ram_out_buffer (a,
98 #ifdef PLATFORM_GT_32BIT
99             ULongToPtr(a->tx_stream[Id] + a->tx_pos[Id]+4),
100 #else
101               (void*)(a->tx_stream[Id] + a->tx_pos[Id] + 4),
102 #endif
103                          data_ptr,
104              (word)to_write);
105    length  -= to_write;
106    written  += to_write;
107    data_ptr += to_write;
108   }
109   tmp[1] = (char)to_write;
110   tmp[0] = (tmp[0] & DIVA_DFIFO_WRAP) |
111        DIVA_DFIFO_READY |
112        ((!length && final) ? DIVA_DFIFO_LAST : 0);
113   if (tmp[0] & DIVA_DFIFO_LAST) {
114    tmp[2] = usr1;
115    tmp[3] = usr2;
116   }
117     a->ram_out_dw (a,
118 #ifdef PLATFORM_GT_32BIT
119          ULongToPtr(a->tx_stream[Id] + a->tx_pos[Id]),
120 #else
121            (void*)(a->tx_stream[Id] + a->tx_pos[Id]),
122 #endif
123                    (dword*)&tmp[0],
124           1);
125   if (tmp[0] & DIVA_DFIFO_WRAP) {
126    a->tx_pos[Id]  = 0;
127   } else {
128    a->tx_pos[Id] += DIVA_DFIFO_STEP;
129   }
130   if (!length) {
131    break;
132   }
133  }
134  return (written);
135 }
136 /* -------------------------------------------------------------------
137   In case of SYNCRONOUS service:
138   Does write data from stream in caller's buffer.
139   Does return amount of data written to buffer
140   Final flag is set on return if last part of structured frame
141   was received
142   return 0  if zero packet was received
143   return -1 if stream is empty
144     return -2 if read buffer does not profide sufficient space
145               to accommodate entire segment
146   max_length should be at least 68 bytes
147   ------------------------------------------------------------------- */
148 int diva_istream_read (void* context,
149                 int Id,
150                 void* data,
151                 int max_length,
152                 int* final,
153                byte* usr1,
154                byte* usr2) {
155  ADAPTER* a = (ADAPTER*)context;
156  int read = 0, to_read = -1;
157  char tmp[4];
158  byte* data_ptr = (byte*)data;
159  *final = 0;
160  for (;;) {
161   a->ram_in_dw (a,
162 #ifdef PLATFORM_GT_32BIT
163          ULongToPtr(a->rx_stream[Id] + a->rx_pos[Id]),
164 #else
165          (void*)(a->rx_stream[Id] + a->rx_pos[Id]),
166 #endif
167                   (dword*)&tmp[0],
168          1);
169   if (tmp[1] > max_length) {
170    if (to_read < 0)
171     return (-2); /* was not able to read */
172    break;
173     }
174   if (!(tmp[0] & DIVA_DFIFO_READY)) {
175    if (to_read < 0)
176     return (-1); /* was not able to read */
177    break;
178   }
179   to_read = min(max_length, (int)tmp[1]);
180   if (to_read) {
181    a->ram_in_buffer(a,
182 #ifdef PLATFORM_GT_32BIT
183            ULongToPtr(a->rx_stream[Id] + a->rx_pos[Id] + 4),
184 #else
185             (void*)(a->rx_stream[Id] + a->rx_pos[Id] + 4),
186 #endif
187                        data_ptr,
188             (word)to_read);
189    max_length -= to_read;
190    read     += to_read;
191    data_ptr  += to_read;
192   }
193   if (tmp[0] & DIVA_DFIFO_LAST) {
194    *final = 1;
195   }
196   tmp[0] &= DIVA_DFIFO_WRAP;
197     a->ram_out_dw(a,
198 #ifdef PLATFORM_GT_32BIT
199          ULongToPtr(a->rx_stream[Id] + a->rx_pos[Id]),
200 #else
201          (void*)(a->rx_stream[Id] + a->rx_pos[Id]),
202 #endif
203          (dword*)&tmp[0],
204          1);
205   if (tmp[0] & DIVA_DFIFO_WRAP) {
206    a->rx_pos[Id]  = 0;
207   } else {
208    a->rx_pos[Id] += DIVA_DFIFO_STEP;
209   }
210   if (*final) {
211    if (usr1)
212     *usr1 = tmp[2];
213    if (usr2)
214     *usr2 = tmp[3];
215    break;
216   }
217  }
218  return (read);
219 }
220 /* ---------------------------------------------------------------------
221   Does check if one of streams had caused interrupt and does
222   wake up corresponding application
223    --------------------------------------------------------------------- */
224 void pr_stream (ADAPTER * a) {
225 }
226 #endif /* } */