Ansify some remaining function definitions in the kernel.
[dragonfly.git] / sys / dev / atm / hea / eni_if.c
1 /*
2  *
3  * ===================================
4  * HARP  |  Host ATM Research Platform
5  * ===================================
6  *
7  *
8  * This Host ATM Research Platform ("HARP") file (the "Software") is
9  * made available by Network Computing Services, Inc. ("NetworkCS")
10  * "AS IS".  NetworkCS does not provide maintenance, improvements or
11  * support of any kind.
12  *
13  * NETWORKCS MAKES NO WARRANTIES OR REPRESENTATIONS, EXPRESS OR IMPLIED,
14  * INCLUDING, BUT NOT LIMITED TO, IMPLIED WARRANTIES OF MERCHANTABILITY
15  * AND FITNESS FOR A PARTICULAR PURPOSE, AS TO ANY ELEMENT OF THE
16  * SOFTWARE OR ANY SUPPORT PROVIDED IN CONNECTION WITH THIS SOFTWARE.
17  * In no event shall NetworkCS be responsible for any damages, including
18  * but not limited to consequential damages, arising from or relating to
19  * any use of the Software or related support.
20  *
21  * Copyright 1994-1998 Network Computing Services, Inc.
22  *
23  * Copies of this Software may be made, however, the above copyright
24  * notice must be reproduced on all copies.
25  *
26  *      @(#) $FreeBSD: src/sys/dev/hea/eni_if.c,v 1.5 1999/08/28 00:41:44 peter Exp $
27  *      @(#) $DragonFly: src/sys/dev/atm/hea/eni_if.c,v 1.7 2008/03/01 22:03:13 swildner Exp $
28  */
29
30 /*
31  * Efficient ENI Adapter Support
32  * -----------------------------
33  *
34  * Network interface layer support
35  *
36  */
37
38 #include <netproto/atm/kern_include.h>
39
40 #include "eni_stats.h"
41 #include "eni.h"
42 #include "eni_suni.h"
43 #include "eni_var.h"
44
45 static void     eni_get_stats (Eni_unit *);
46
47 /*
48  * SUNI statistics counters take one of three forms:
49  *      single byte value       (0x0 - 0xff)
50  *      two byte value          (0x0 - 0xffff)
51  *      two + 1/2 (three) byte value
52  *                              (0x0 - 0x0fffff)
53  */
54 #define READ_ONE(x)     ( (eup->eu_suni[(x)] & 0xff) )
55
56 #define READ_TWO(x)     ( (eup->eu_suni[(x)+1] & 0xff) << 8 | \
57                           (eup->eu_suni[(x)] & 0xff) )
58
59 #define READ_THREE(x)   ( (eup->eu_suni[(x)+2] & 0xf) << 16 | \
60                           (eup->eu_suni[(x)+1] & 0xff) << 8 | \
61                           (eup->eu_suni[(x)] & 0xff) )
62
63 /*
64  * Do an initial read of the error counters without saving them.
65  * In effect, this will "zero" our idea of the number of errors
66  * which have occurred since the driver was loaded.
67  *
68  * Arguments:
69  *      eup             pointer to per unit structure
70  *
71  * Returns:
72  *      none
73  *
74  */
75 void
76 eni_zero_stats(Eni_unit *eup)
77 {
78         int     val;
79
80         /*
81          * Write the SUNI master control register which
82          * will cause all the statistics counters to be
83          * loaded.
84          */
85         eup->eu_suni[SUNI_MASTER_REG] = eup->eu_suni[SUNI_MASTER_REG];
86
87         /*
88          * Delay to allow for counter load time...
89          */
90         DELAY ( SUNI_DELAY );
91
92         /*
93          * Statistics counters contain the number of events
94          * since the last time the counter was read.
95          */
96         val = READ_TWO ( SUNI_SECT_BIP_REG );           /* oc3_sect_bip8 */
97         val = READ_TWO ( SUNI_PATH_BIP_REG );           /* oc3_path_bip8 */
98         val = READ_THREE ( SUNI_LINE_BIP_REG );         /* oc3_line_bip24 */
99         val = READ_THREE ( SUNI_LINE_FEBE_REG );        /* oc3_line_febe */
100         val = READ_TWO ( SUNI_PATH_FEBE_REG );          /* oc3_path_febe */
101         val = READ_ONE ( SUNI_HECS_REG );               /* oc3_hec_corr */
102         val = READ_ONE ( SUNI_UHECS_REG );              /* oc3_hec_uncorr */
103 }
104
105 /*
106  * Retrieve SUNI stats
107  *
108  * Arguments:
109  *      eup             pointer to per unit structure
110  *
111  * Returns:
112  *      none
113  *
114  */
115 static void
116 eni_get_stats (Eni_unit *eup)
117 {
118         /*
119          * Write the SUNI master control register which
120          * will cause all the statistics counters to be
121          * loaded.
122          */
123         eup->eu_suni[SUNI_MASTER_REG] = eup->eu_suni[SUNI_MASTER_REG];
124
125         /*
126          * Delay to allow for counter load time...
127          */
128         DELAY ( 10 );
129
130         /*
131          * Statistics counters contain the number of events
132          * since the last time the counter was read.
133          */
134         eup->eu_stats.eni_st_oc3.oc3_sect_bip8 +=
135                         READ_TWO ( SUNI_SECT_BIP_REG );
136         eup->eu_stats.eni_st_oc3.oc3_path_bip8 +=
137                         READ_TWO ( SUNI_PATH_BIP_REG );
138         eup->eu_stats.eni_st_oc3.oc3_line_bip24 +=
139                         READ_THREE ( SUNI_LINE_BIP_REG );
140         eup->eu_stats.eni_st_oc3.oc3_line_febe +=
141                         READ_THREE ( SUNI_LINE_FEBE_REG );
142         eup->eu_stats.eni_st_oc3.oc3_path_febe +=
143                         READ_TWO ( SUNI_PATH_FEBE_REG );
144         eup->eu_stats.eni_st_oc3.oc3_hec_corr +=
145                         READ_ONE ( SUNI_HECS_REG );
146         eup->eu_stats.eni_st_oc3.oc3_hec_uncorr +=
147                         READ_ONE ( SUNI_UHECS_REG );
148 }
149
150 /*
151  * Handle netatm core service interface ioctl requests
152  *
153  * Called at splnet.
154  *
155  * Arguments:
156  *      code            ioctl function (sub)code
157  *      data            data to/from ioctl
158  *      arg             optional code-specific argument
159  *
160  * Returns:
161  *      0               request processed successfully
162  *      error           request failed - reason code
163  *
164  */
165 int
166 eni_atm_ioctl(int code, caddr_t data, caddr_t arg)
167 {
168         struct atminfreq        *aip = (struct atminfreq *)data;
169         struct atm_pif          *pip = (struct atm_pif *)arg;
170         Eni_unit                *eup = (Eni_unit *)pip;
171         caddr_t                 buf = aip->air_buf_addr;
172         struct air_vinfo_rsp    *avr;
173         int                     count, len, buf_len = aip->air_buf_len;
174         int                     err = 0;
175         char                    ifname[2*IFNAMSIZ];
176
177         ATM_DEBUG2("eni_atm_ioctl: code=%d, opcode=%d\n",
178                 code, aip->air_opcode );
179
180         switch ( aip->air_opcode ) {
181
182         case AIOCS_INF_VST:
183                 /*
184                  * Get vendor statistics
185                  */
186                 if ( eup == NULL )
187                         return ( ENXIO );
188                 ksnprintf ( ifname, sizeof(ifname),
189                     "%s%d", pip->pif_name, pip->pif_unit );
190
191                 /*
192                  * Cast response structure onto user's buffer
193                  */
194                 avr = (struct air_vinfo_rsp *)buf;
195
196                 /*
197                  * How large is the response structure
198                  */
199                 len = sizeof(struct air_vinfo_rsp);
200
201                 /*
202                  * Sanity check - enough room for response structure?
203                  */
204                 if ( buf_len < len )
205                         return ( ENOSPC );
206
207                 /*
208                  * Copy interface name into response structure
209                  */
210                 if ((err = copyout(ifname, avr->avsp_intf, IFNAMSIZ)) != 0)
211                         break;
212
213                 /*
214                  * Advance the buffer address and decrement the size
215                  */
216                 buf += len;
217                 buf_len -= len;
218
219                 /*
220                  * Get the vendor stats (SUNI) from the hardware
221                  */
222                 eni_get_stats ( eup );
223                 /*
224                  * Stick as much of it as we have room for
225                  * into the response
226                  */
227                 count = MIN ( sizeof(Eni_stats), buf_len );
228
229                 /*
230                  * Copy stats into user's buffer. Return value is
231                  * amount of data copied.
232                  */
233                 if ((err = copyout((void *)&eup->eu_stats, buf, count)) != 0)
234                                 break;
235                 buf += count;
236                 buf_len -= count;
237                 if ( count < sizeof(Eni_stats) )
238                         err = ENOSPC;
239
240                 /*
241                  * Record amount we're returning as vendor info...
242                  */
243                 if ((err = copyout(&count, &avr->avsp_len, sizeof(int))) != 0)
244                         break;
245
246                 /*
247                  * Update the reply pointers and length
248                  */
249                 aip->air_buf_addr = buf;
250                 aip->air_buf_len = buf_len;
251                 break;
252
253         default:
254                 err = ENOSYS;           /* Operation not supported */
255                 break;
256         }
257
258         return ( err );
259
260 }
261