[ipoib] Return the link speed even if the link is down. (mlnx: 3304)
[mirror/winof/.git] / ulp / ipoib / kernel / ipoib_driver.c
1 /*\r
2  * Copyright (c) 2005 SilverStorm Technologies.  All rights reserved.\r
3  * Copyright (c) 2006 Mellanox Technologies.  All rights reserved.\r
4  * Portions Copyright (c) 2008 Microsoft Corporation.  All rights reserved.\r
5  *\r
6  * This software is available to you under the OpenIB.org BSD license\r
7  * below:\r
8  *\r
9  *     Redistribution and use in source and binary forms, with or\r
10  *     without modification, are permitted provided that the following\r
11  *     conditions are met:\r
12  *\r
13  *      - Redistributions of source code must retain the above\r
14  *        copyright notice, this list of conditions and the following\r
15  *        disclaimer.\r
16  *\r
17  *      - Redistributions in binary form must reproduce the above\r
18  *        copyright notice, this list of conditions and the following\r
19  *        disclaimer in the documentation and/or other materials\r
20  *        provided with the distribution.\r
21  *\r
22  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,\r
23  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF\r
24  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND\r
25  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS\r
26  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN\r
27  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN\r
28  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE\r
29  * SOFTWARE.\r
30  *\r
31  * $Id$\r
32  */\r
33 \r
34 #include "limits.h"\r
35 #include "ipoib_driver.h"\r
36 #include "ipoib_debug.h"\r
37 \r
38 #if defined(EVENT_TRACING)\r
39 #ifdef offsetof\r
40 #undef offsetof\r
41 #endif\r
42 #include "ipoib_driver.tmh"\r
43 #endif\r
44 \r
45 #include "ipoib_port.h"\r
46 #include "ipoib_ibat.h"\r
47 #include <complib/cl_bus_ifc.h>\r
48 #include <complib/cl_init.h>\r
49 #include <initguid.h>\r
50 #include <iba/ipoib_ifc.h>\r
51 #include "ntstrsafe.h"\r
52 #include "strsafe.h"\r
53 #include <offload.h>\r
54 \r
55 \r
56 \r
57 \r
58 \r
59 #if defined(NDIS50_MINIPORT)\r
60 #define MAJOR_NDIS_VERSION 5\r
61 #define MINOR_NDIS_VERSION 0\r
62 #elif defined (NDIS51_MINIPORT)\r
63 #define MAJOR_NDIS_VERSION 5\r
64 #define MINOR_NDIS_VERSION 1\r
65 #else\r
66 #error NDIS Version not defined, try defining NDIS50_MINIPORT or NDIS51_MINIPORT\r
67 #endif\r
68 \r
69 PDRIVER_OBJECT                          g_p_drv_obj;\r
70 \r
71 static const NDIS_OID SUPPORTED_OIDS[] =\r
72 {\r
73         OID_GEN_SUPPORTED_LIST,\r
74         OID_GEN_HARDWARE_STATUS,\r
75         OID_GEN_MEDIA_SUPPORTED,\r
76         OID_GEN_MEDIA_IN_USE,\r
77         OID_GEN_MAXIMUM_LOOKAHEAD,\r
78         OID_GEN_MAXIMUM_FRAME_SIZE,\r
79         OID_GEN_LINK_SPEED,\r
80         OID_GEN_TRANSMIT_BUFFER_SPACE,\r
81         OID_GEN_RECEIVE_BUFFER_SPACE,\r
82         OID_GEN_TRANSMIT_BLOCK_SIZE,\r
83         OID_GEN_RECEIVE_BLOCK_SIZE,\r
84         OID_GEN_VENDOR_ID,\r
85         OID_GEN_VENDOR_DESCRIPTION,\r
86         OID_GEN_CURRENT_PACKET_FILTER,\r
87         OID_GEN_CURRENT_LOOKAHEAD,\r
88         OID_GEN_DRIVER_VERSION,\r
89         OID_GEN_MAXIMUM_TOTAL_SIZE,\r
90         OID_GEN_PROTOCOL_OPTIONS,\r
91         OID_GEN_MAC_OPTIONS,\r
92         OID_GEN_MEDIA_CONNECT_STATUS,\r
93         OID_GEN_MAXIMUM_SEND_PACKETS,\r
94         OID_GEN_NETWORK_LAYER_ADDRESSES,\r
95         OID_GEN_VENDOR_DRIVER_VERSION,\r
96         OID_GEN_PHYSICAL_MEDIUM,\r
97         OID_GEN_XMIT_OK,\r
98         OID_GEN_RCV_OK,\r
99         OID_GEN_XMIT_ERROR,\r
100         OID_GEN_RCV_ERROR,\r
101         OID_GEN_RCV_NO_BUFFER,\r
102         OID_GEN_DIRECTED_BYTES_XMIT,\r
103         OID_GEN_DIRECTED_FRAMES_XMIT,\r
104         OID_GEN_MULTICAST_BYTES_XMIT,\r
105         OID_GEN_MULTICAST_FRAMES_XMIT,\r
106         OID_GEN_BROADCAST_BYTES_XMIT,\r
107         OID_GEN_BROADCAST_FRAMES_XMIT,\r
108         OID_GEN_DIRECTED_BYTES_RCV,\r
109         OID_GEN_DIRECTED_FRAMES_RCV,\r
110         OID_GEN_MULTICAST_BYTES_RCV,\r
111         OID_GEN_MULTICAST_FRAMES_RCV,\r
112         OID_GEN_BROADCAST_BYTES_RCV,\r
113         OID_GEN_BROADCAST_FRAMES_RCV,\r
114         OID_802_3_PERMANENT_ADDRESS,\r
115         OID_802_3_CURRENT_ADDRESS,\r
116         OID_802_3_MULTICAST_LIST,\r
117         OID_802_3_MAXIMUM_LIST_SIZE,\r
118         OID_802_3_MAC_OPTIONS,\r
119         OID_802_3_RCV_ERROR_ALIGNMENT,\r
120         OID_802_3_XMIT_ONE_COLLISION,\r
121         OID_802_3_XMIT_MORE_COLLISIONS,\r
122         OID_TCP_TASK_OFFLOAD\r
123 };\r
124 \r
125 static const unsigned char VENDOR_ID[] = {0x00, 0x06, 0x6A, 0x00};\r
126 \r
127 #define VENDOR_DESCRIPTION "Internet Protocol over InfiniBand"\r
128 \r
129 #define IB_INFINITE_SERVICE_LEASE       0xFFFFFFFF\r
130 \r
131 //The mask is 8 bit and can't contain more than 6 non-zero bits\r
132 #define MAX_GUID_MAX 0xFC\r
133 \r
134 \r
135 /* Global driver debug level */\r
136 uint32_t                g_ipoib_dbg_level = TRACE_LEVEL_ERROR;\r
137 uint32_t                g_ipoib_dbg_flags = 0x00000fff;\r
138 ipoib_globals_t g_ipoib = {0};\r
139 \r
140 typedef struct _IPOIB_REG_ENTRY\r
141 {\r
142         NDIS_STRING RegName;                // variable name text\r
143         BOOLEAN     bRequired;              // 1 -> required, 0 -> optional\r
144         UINT        FieldOffset;            // offset in parent struct\r
145         UINT        FieldSize;              // size (in bytes) of the field\r
146         UINT        Default;                // default value to use\r
147         UINT        Min;                    // minimum value allowed\r
148         UINT        Max;                    // maximum value allowed\r
149 } IPOIB_REG_ENTRY, *PIPOIB_REG_ENTRY;\r
150 \r
151 IPOIB_REG_ENTRY HCARegTable[] = {\r
152         // reg value name             If Required  Offset in parentr struct             Field size                  Default         Min     Max\r
153         {NDIS_STRING_CONST("GUIDMask"),         1, IPOIB_OFFSET(guid_mask),             IPOIB_SIZE(guid_mask),          0,          0,    MAX_GUID_MAX},\r
154         /* GUIDMask should be the first element */\r
155         {NDIS_STRING_CONST("RqDepth"),          1, IPOIB_OFFSET(rq_depth),              IPOIB_SIZE(rq_depth),           512,        128,    1024},\r
156         {NDIS_STRING_CONST("RqLowWatermark"),   0, IPOIB_OFFSET(rq_low_watermark),      IPOIB_SIZE(rq_low_watermark),   4,          2,      8},\r
157         {NDIS_STRING_CONST("SqDepth"),          1, IPOIB_OFFSET(sq_depth),              IPOIB_SIZE(sq_depth),           512,        128,    1024},\r
158         {NDIS_STRING_CONST("SendChksum"),       1, IPOIB_OFFSET(send_chksum_offload),   IPOIB_SIZE(send_chksum_offload),CSUM_ENABLED,CSUM_DISABLED,CSUM_BYPASS},\r
159         {NDIS_STRING_CONST("RecvChksum"),       1, IPOIB_OFFSET(recv_chksum_offload),   IPOIB_SIZE(recv_chksum_offload),CSUM_ENABLED,CSUM_DISABLED,CSUM_BYPASS},\r
160         {NDIS_STRING_CONST("SaTimeout"),        1, IPOIB_OFFSET(sa_timeout),            IPOIB_SIZE(sa_timeout),         1000,       250,    UINT_MAX},\r
161         {NDIS_STRING_CONST("SaRetries"),        1, IPOIB_OFFSET(sa_retry_cnt),          IPOIB_SIZE(sa_retry_cnt),       10,         1,      UINT_MAX},\r
162         {NDIS_STRING_CONST("RecvRatio"),        1, IPOIB_OFFSET(recv_pool_ratio),       IPOIB_SIZE(recv_pool_ratio),    1,          1,      10},\r
163         {NDIS_STRING_CONST("PayloadMtu"),       1, IPOIB_OFFSET(payload_mtu),           IPOIB_SIZE(payload_mtu),        2044,       60,   4092},\r
164         {NDIS_STRING_CONST("lso"),              0, IPOIB_OFFSET(lso),                   IPOIB_SIZE(lso),                0,          0,      1},\r
165         {NDIS_STRING_CONST("MCLeaveRescan"),    1, IPOIB_OFFSET(mc_leave_rescan),       IPOIB_SIZE(mc_leave_rescan),    260,        1,    3600},\r
166         {NDIS_STRING_CONST("BCJoinRetry"),          1, IPOIB_OFFSET(bc_join_retry),                 IPOIB_SIZE(bc_join_retry),      50,         0,    1000}\r
167         \r
168 };  \r
169 \r
170 #define IPOIB_NUM_REG_PARAMS (sizeof (HCARegTable) / sizeof(IPOIB_REG_ENTRY))\r
171 \r
172 \r
173 void\r
174 ipoib_create_log(\r
175         NDIS_HANDLE h_adapter,\r
176         UINT ind,\r
177         ULONG eventLogMsgId)\r
178 \r
179 {\r
180 #define cMaxStrLen  40\r
181 #define cArrLen  3\r
182 \r
183         PWCHAR logMsgArray[cArrLen]; \r
184         WCHAR strVal[cMaxStrLen];\r
185         NDIS_STRING AdapterInstanceName;\r
186 \r
187         IPOIB_INIT_NDIS_STRING(&AdapterInstanceName);\r
188         if (NdisMQueryAdapterInstanceName(&AdapterInstanceName, h_adapter)!= NDIS_STATUS_SUCCESS ){\r
189                 ASSERT(FALSE);\r
190                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR,IPOIB_DBG_ERROR, ("[IPoIB] Init:Failed to retreive adapter name.\n"));\r
191                 return;\r
192         }\r
193         logMsgArray[0] = AdapterInstanceName.Buffer;\r
194         \r
195         if (RtlStringCbPrintfW(strVal, sizeof(strVal), L"0x%x", HCARegTable[ind].Default) != STATUS_SUCCESS) {\r
196                 ASSERT(FALSE);\r
197                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR,IPOIB_DBG_ERROR,\r
198                 ("[IPoIB] Init: Problem copying string value: exiting\n"));   \r
199                 return;\r
200         }\r
201         \r
202         logMsgArray[0] = AdapterInstanceName.Buffer;\r
203         logMsgArray[1] = HCARegTable[ind].RegName.Buffer;\r
204         logMsgArray[2] = strVal;\r
205         \r
206         NdisWriteEventLogEntry(g_p_drv_obj, eventLogMsgId, 0, cArrLen, &logMsgArray, 0, NULL);\r
207 \r
208 }\r
209 \r
210 \r
211 \r
212 NTSTATUS\r
213 DriverEntry(\r
214         IN                              PDRIVER_OBJECT                          p_drv_obj,\r
215         IN                              PUNICODE_STRING                         p_reg_path );\r
216 \r
217 VOID\r
218 ipoib_unload(\r
219         IN                              PDRIVER_OBJECT                          p_drv_obj );\r
220 \r
221 NDIS_STATUS\r
222 ipoib_initialize(\r
223                 OUT                     PNDIS_STATUS                            p_open_err_status,\r
224                 OUT                     PUINT                                           p_selected_medium_index,\r
225         IN                              PNDIS_MEDIUM                            medium_array,\r
226         IN                              UINT                                            medium_array_size,\r
227         IN                              NDIS_HANDLE                                     h_adapter,\r
228         IN                              NDIS_HANDLE                                     wrapper_configuration_context );\r
229 \r
230 BOOLEAN\r
231 ipoib_check_for_hang(\r
232         IN                              NDIS_HANDLE                                     adapter_context );\r
233 \r
234 void\r
235 ipoib_halt(\r
236         IN                              NDIS_HANDLE                                     adapter_context );\r
237 \r
238 NDIS_STATUS\r
239 ipoib_query_info(\r
240         IN                              NDIS_HANDLE                                     adapter_context,\r
241         IN                              NDIS_OID                                        oid,\r
242         IN                              PVOID                                           info_buf,\r
243         IN                              ULONG                                           info_buf_len,\r
244                 OUT                     PULONG                                          p_bytes_written,\r
245                 OUT                     PULONG                                          p_bytes_needed );\r
246 \r
247 NDIS_STATUS\r
248 ipoib_reset(\r
249                 OUT                     PBOOLEAN                                        p_addressing_reset,\r
250         IN                              NDIS_HANDLE                                     adapter_context );\r
251 \r
252 NDIS_STATUS\r
253 ipoib_set_info(\r
254         IN                              NDIS_HANDLE                                     adapter_context,\r
255         IN                              NDIS_OID                                        oid,\r
256         IN                              PVOID                                           info_buf,\r
257         IN                              ULONG                                           info_buf_length,\r
258                 OUT                     PULONG                                          p_bytes_read,\r
259                 OUT                     PULONG                                          p_bytes_needed );\r
260 \r
261 void\r
262 ipoib_send_packets(\r
263         IN                              NDIS_HANDLE                                     adapter_context,\r
264         IN                              PPNDIS_PACKET                           packet_array,\r
265         IN                              UINT                                            num_packets );\r
266 \r
267 void\r
268 ipoib_pnp_notify(\r
269         IN                              NDIS_HANDLE                                     adapter_context,\r
270         IN                              NDIS_DEVICE_PNP_EVENT           pnp_event,\r
271         IN                              PVOID                                           info_buf,\r
272         IN                              ULONG                                           info_buf_len );\r
273 \r
274 void\r
275 ipoib_shutdown(\r
276         IN                              PVOID                                           adapter_context );\r
277 \r
278 static void\r
279 ipoib_complete_query(\r
280         IN                              ipoib_adapter_t* const          p_adapter,\r
281         IN                              pending_oid_t* const            p_oid_info,\r
282         IN              const   NDIS_STATUS                                     status,\r
283         IN              const   void* const                                     p_buf,\r
284         IN              const   ULONG                                           buf_len );\r
285 \r
286 static NDIS_STATUS\r
287 __ipoib_set_net_addr(\r
288         IN              ipoib_adapter_t *       p_adapter,\r
289         IN              PVOID                           info_buf,\r
290         IN              ULONG                           info_buf_len,\r
291                 OUT     PULONG                          p_bytes_read,\r
292                 OUT     PULONG                          p_bytes_needed );\r
293 \r
294 static NDIS_STATUS\r
295 __ipoib_get_tcp_task_offload(\r
296         IN                              ipoib_adapter_t*                        p_adapter,\r
297         IN                              pending_oid_t* const            p_oid_info );\r
298 \r
299 static void\r
300 __ipoib_ats_reg_cb(\r
301         IN                              ib_reg_svc_rec_t                        *p_reg_svc_rec );\r
302 \r
303 static void\r
304 __ipoib_ats_dereg_cb(\r
305         IN                              void                                            *context );\r
306 \r
307 static NTSTATUS\r
308 __ipoib_read_registry(\r
309         IN                              UNICODE_STRING* const           p_registry_path );\r
310 \r
311 \r
312 //! Standard Windows Device Driver Entry Point\r
313 /*! DriverEntry is the first routine called after a driver is loaded, and\r
314 is responsible for initializing the driver.  On W2k this occurs when the PnP\r
315 Manager matched a PnP ID to one in an INF file that references this driver.\r
316 Any not success return value will cause the driver to fail to load.\r
317 IRQL = PASSIVE_LEVEL\r
318 \r
319 @param p_drv_obj Pointer to Driver Object for this device driver\r
320 @param p_registry_path Pointer to unicode string containing path to this driver's registry area\r
321 @return STATUS_SUCCESS, NDIS_STATUS_BAD_CHARACTERISTICS, NDIS_STATUS_BAD_VERSION,\r
322 NDIS_STATUS_RESOURCES, or NDIS_STATUS_FAILURE\r
323 */\r
324 NTSTATUS\r
325 DriverEntry(\r
326         IN                              PDRIVER_OBJECT                          p_drv_obj,\r
327         IN                              PUNICODE_STRING                         p_registry_path )\r
328 {\r
329         NDIS_STATUS                                             status;\r
330         NDIS_HANDLE                                             ndis_handle;\r
331         NDIS_MINIPORT_CHARACTERISTICS   characteristics;\r
332 \r
333         IPOIB_ENTER( IPOIB_DBG_INIT );\r
334         g_p_drv_obj = p_drv_obj;\r
335 \r
336 #ifdef _DEBUG_\r
337         PAGED_CODE();\r
338 #endif\r
339 #if defined(EVENT_TRACING)\r
340         WPP_INIT_TRACING(p_drv_obj, p_registry_path);\r
341 #endif\r
342         status = CL_INIT;\r
343         if( !NT_SUCCESS( status ) )\r
344         {\r
345                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
346                         ("cl_init failed.\n") );\r
347                 return status;\r
348         }\r
349 \r
350         status          = NDIS_STATUS_SUCCESS;\r
351         ndis_handle     = NULL;\r
352 \r
353         __ipoib_read_registry(p_registry_path);\r
354         \r
355         KeInitializeSpinLock( &g_ipoib.lock );\r
356         cl_qlist_init( &g_ipoib.adapter_list );\r
357 \r
358         NdisMInitializeWrapper(\r
359                 &g_ipoib.h_ndis_wrapper, p_drv_obj, p_registry_path, NULL );\r
360 \r
361         memset(&characteristics, 0, sizeof(characteristics));\r
362         characteristics.MajorNdisVersion                = MAJOR_NDIS_VERSION;\r
363         characteristics.MinorNdisVersion                = MINOR_NDIS_VERSION;\r
364         characteristics.CheckForHangHandler             = ipoib_check_for_hang;\r
365         characteristics.HaltHandler                             = ipoib_halt;\r
366         characteristics.InitializeHandler               = ipoib_initialize;\r
367         characteristics.QueryInformationHandler = ipoib_query_info;\r
368         characteristics.ResetHandler                    = ipoib_reset;\r
369         characteristics.SetInformationHandler   = ipoib_set_info;\r
370 \r
371         characteristics.ReturnPacketHandler             = ipoib_return_packet;\r
372         characteristics.SendPacketsHandler              = ipoib_send_packets;\r
373 \r
374 #ifdef NDIS51_MINIPORT\r
375         characteristics.PnPEventNotifyHandler   = ipoib_pnp_notify;\r
376         characteristics.AdapterShutdownHandler  = ipoib_shutdown;\r
377 #endif\r
378 \r
379         status = NdisMRegisterMiniport(\r
380                 g_ipoib.h_ndis_wrapper, &characteristics, sizeof(characteristics) );\r
381         if( status != NDIS_STATUS_SUCCESS )\r
382         {\r
383                 IPOIB_PRINT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR, \r
384                         ("NdisMRegisterMiniport failed with status of %d\n", status) );\r
385                 NdisTerminateWrapper( g_ipoib.h_ndis_wrapper, NULL );\r
386                 CL_DEINIT;\r
387                 return status;\r
388         }\r
389 \r
390         NdisMRegisterUnloadHandler( g_ipoib.h_ndis_wrapper, ipoib_unload );\r
391 \r
392         IPOIB_EXIT( IPOIB_DBG_INIT );\r
393         return status;\r
394 }\r
395 \r
396 \r
397 static NTSTATUS\r
398 __ipoib_read_registry(\r
399         IN                              UNICODE_STRING* const           p_registry_path )\r
400 {\r
401         NTSTATUS                                                status;\r
402         /* Remember the terminating entry in the table below. */\r
403         RTL_QUERY_REGISTRY_TABLE                table[4];\r
404         UNICODE_STRING                                  param_path;\r
405 \r
406         IPOIB_ENTER( IPOIB_DBG_INIT );\r
407         RtlInitUnicodeString( &param_path, NULL );\r
408         param_path.MaximumLength = p_registry_path->Length + \r
409                 sizeof(L"\\Parameters");\r
410         param_path.Buffer = cl_zalloc( param_path.MaximumLength );\r
411         if( !param_path.Buffer )\r
412         {\r
413                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR, \r
414                         ("Failed to allocate parameters path buffer.\n") );\r
415                 return STATUS_INSUFFICIENT_RESOURCES;\r
416         }\r
417 \r
418         RtlAppendUnicodeStringToString( &param_path, p_registry_path );\r
419         RtlAppendUnicodeToString( &param_path, L"\\Parameters" );\r
420 \r
421         /*\r
422          * Clear the table.  This clears all the query callback pointers,\r
423          * and sets up the terminating table entry.\r
424          */\r
425         cl_memclr( table, sizeof(table) );\r
426 \r
427         /* Setup the table entries. */\r
428         table[0].Flags = RTL_QUERY_REGISTRY_DIRECT;\r
429         table[0].Name = L"DebugLevel";\r
430         table[0].EntryContext = &g_ipoib_dbg_level;\r
431         table[0].DefaultType = REG_DWORD;\r
432         table[0].DefaultData = &g_ipoib_dbg_level;\r
433         table[0].DefaultLength = sizeof(ULONG);\r
434 \r
435         table[1].Flags = RTL_QUERY_REGISTRY_DIRECT;\r
436         table[1].Name = L"DebugFlags";\r
437         table[1].EntryContext = &g_ipoib_dbg_flags;\r
438         table[1].DefaultType = REG_DWORD;\r
439         table[1].DefaultData = &g_ipoib_dbg_flags;\r
440         table[1].DefaultLength = sizeof(ULONG);\r
441 \r
442         table[2].Flags = RTL_QUERY_REGISTRY_DIRECT;\r
443         table[2].Name = L"bypass_check_bcast_rate";\r
444         table[2].EntryContext = &g_ipoib.bypass_check_bcast_rate;\r
445         table[2].DefaultType = REG_DWORD;\r
446         table[2].DefaultData = &g_ipoib.bypass_check_bcast_rate;\r
447         table[2].DefaultLength = sizeof(ULONG);\r
448 \r
449         /* Have at it! */\r
450         status = RtlQueryRegistryValues( RTL_REGISTRY_ABSOLUTE, \r
451                 param_path.Buffer, table, NULL, NULL );\r
452 \r
453         IPOIB_PRINT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
454                         ("debug level %d debug flags 0x%.8x\n",\r
455                         g_ipoib_dbg_level,\r
456                         g_ipoib_dbg_flags));\r
457 \r
458 #if DBG\r
459         if( g_ipoib_dbg_flags & IPOIB_DBG_ERR )\r
460                 g_ipoib_dbg_flags |= CL_DBG_ERROR;\r
461 #endif\r
462 \r
463         cl_free( param_path.Buffer );\r
464         IPOIB_EXIT( IPOIB_DBG_INIT );\r
465         return status;\r
466 }\r
467 \r
468 \r
469 VOID\r
470 ipoib_unload(\r
471         IN                              PDRIVER_OBJECT                          p_drv_obj )\r
472 {\r
473         IPOIB_ENTER( IPOIB_DBG_INIT );\r
474         #if defined(EVENT_TRACING)\r
475         WPP_CLEANUP(p_drv_obj);\r
476         #endif\r
477 \r
478         UNREFERENCED_PARAMETER( p_drv_obj );\r
479         CL_DEINIT;\r
480         IPOIB_EXIT( IPOIB_DBG_INIT );\r
481 }\r
482 \r
483 \r
484 \r
485 NDIS_STATUS\r
486 ipoib_get_adapter_params(\r
487         IN                              NDIS_HANDLE* const                      wrapper_config_context,\r
488         IN      OUT                     ipoib_adapter_t                         *p_adapter,\r
489         OUT                             PUCHAR                                          *p_mac,\r
490         OUT                             UINT                                            *p_len)\r
491 {\r
492         NDIS_STATUS                                             status;\r
493         NDIS_HANDLE                                             h_config;\r
494         NDIS_CONFIGURATION_PARAMETER    *p_param;\r
495         UINT                            value;\r
496         PIPOIB_REG_ENTRY                pRegEntry;\r
497         UINT                            i;\r
498         PUCHAR                          structPointer;\r
499         int sq_depth_step = 128;\r
500 \r
501         IPOIB_ENTER( IPOIB_DBG_INIT );\r
502 \r
503         NdisOpenConfiguration( &status, &h_config, wrapper_config_context );\r
504         if( status != NDIS_STATUS_SUCCESS )\r
505         {\r
506                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
507                         ("NdisOpenConfiguration returned 0x%.8x\n", status) );\r
508                 return status;\r
509         }\r
510 \r
511         // read all the registry values \r
512         for (i = 0, pRegEntry = HCARegTable; i < IPOIB_NUM_REG_PARAMS; ++i)\r
513         {\r
514                 // initialize pointer to appropriate place inside 'params'\r
515                 structPointer = (PUCHAR) &p_adapter->params + pRegEntry[i].FieldOffset;\r
516 \r
517                 // Get the configuration value for a specific parameter.  Under NT the\r
518                 // parameters are all read in as DWORDs.\r
519                 NdisReadConfiguration(\r
520                         &status,\r
521                         &p_param,\r
522                         h_config,\r
523                         &pRegEntry[i].RegName,\r
524                         NdisParameterInteger);\r
525 \r
526                 // If the parameter was present, then check its value for validity.\r
527                 if (status == NDIS_STATUS_SUCCESS)\r
528                 {\r
529                         // Check that param value is not too small or too large\r
530                         if (p_param->ParameterData.IntegerData < pRegEntry[i].Min ||\r
531                                 p_param->ParameterData.IntegerData > pRegEntry[i].Max)\r
532                         {\r
533                                 value = pRegEntry[i].Default;\r
534                                 ipoib_create_log(p_adapter->h_adapter, i, EVENT_IPOIB_WRONG_PARAMETER_WRN);\r
535                                 IPOIB_PRINT(TRACE_LEVEL_VERBOSE, IPOIB_DBG_INIT, ("Read configuration.Registry %S value is out of range, setting default value= 0x%x\n", pRegEntry[i].RegName.Buffer, value));                                \r
536 \r
537                         }\r
538                         else\r
539                         {\r
540                                 value = p_param->ParameterData.IntegerData;\r
541                                 IPOIB_PRINT(TRACE_LEVEL_VERBOSE, IPOIB_DBG_INIT, ("Read configuration. Registry %S, Value= 0x%x\n", pRegEntry[i].RegName.Buffer, value));\r
542                         }\r
543                 }\r
544 \r
545                 else\r
546                 {\r
547                         value = pRegEntry[i].Default;\r
548                         status = NDIS_STATUS_SUCCESS;\r
549                         if (pRegEntry[i].bRequired)\r
550                         {\r
551                                 ipoib_create_log(p_adapter->h_adapter, i, EVENT_IPOIB_WRONG_PARAMETER_ERR);\r
552                                 IPOIB_PRINT(TRACE_LEVEL_ERROR, IPOIB_DBG_INIT, ("Read configuration.Registry %S value not found, setting default value= 0x%x\n", pRegEntry[i].RegName.Buffer, value));\r
553                         }\r
554                         else\r
555                         {\r
556                                 ipoib_create_log(p_adapter->h_adapter, i, EVENT_IPOIB_WRONG_PARAMETER_INFO);\r
557                                 IPOIB_PRINT(TRACE_LEVEL_VERBOSE, IPOIB_DBG_INIT, ("Read configuration. Registry %S value not found, Value= 0x%x\n", pRegEntry[i].RegName.Buffer, value));\r
558                         }\r
559 \r
560                 }\r
561                 //\r
562                 // Store the value in the adapter structure.\r
563                 //\r
564                 switch(pRegEntry[i].FieldSize)\r
565                 {\r
566                         case 1:\r
567                                 *((PUCHAR) structPointer) = (UCHAR) value;\r
568                                 break;\r
569 \r
570                         case 2:\r
571                                 *((PUSHORT) structPointer) = (USHORT) value;\r
572                                 break;\r
573 \r
574                         case 4:\r
575                                 *((PULONG) structPointer) = (ULONG) value;\r
576                                 break;\r
577 \r
578                         default:\r
579                                 IPOIB_PRINT(TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR, ("Bogus field size %d\n", pRegEntry[i].FieldSize));\r
580                                 break;\r
581                 }\r
582         }\r
583 \r
584         // Send queue depth needs to be a power of two\r
585         //static const INT sq_depth_step = 128;\r
586 \r
587         if (p_adapter->params.sq_depth % sq_depth_step) {\r
588                 static const c_sq_ind = 2;\r
589                 p_adapter->params.sq_depth = sq_depth_step *(\r
590                         p_adapter->params.sq_depth / sq_depth_step + !!( (p_adapter->params.sq_depth % sq_depth_step) > (sq_depth_step/2) ));\r
591                 ipoib_create_log(p_adapter->h_adapter, c_sq_ind, EVENT_IPOIB_WRONG_PARAMETER_WRN);\r
592                 IPOIB_PRINT(TRACE_LEVEL_VERBOSE, IPOIB_DBG_INIT, ("SQ DEPTH value was rounded to the closest acceptable value of  0x%x\n", p_adapter->params.sq_depth ));\r
593 \r
594         }\r
595 \r
596 \r
597         // Adjusting the low watermark parameter\r
598         p_adapter->params.rq_low_watermark =\r
599                         p_adapter->params.rq_depth / p_adapter->params.rq_low_watermark;\r
600 \r
601         p_adapter->params.xfer_block_size = (sizeof(eth_hdr_t) + p_adapter->params.payload_mtu);\r
602         NdisReadNetworkAddress( &status, p_mac, p_len, h_config );\r
603 \r
604 \r
605         NdisCloseConfiguration( h_config );\r
606 \r
607         IPOIB_EXIT( IPOIB_DBG_INIT );\r
608         return NDIS_STATUS_SUCCESS;\r
609 }\r
610 \r
611 \r
612 NDIS_STATUS\r
613 ipoib_get_adapter_guids(\r
614         IN                              NDIS_HANDLE* const                      h_adapter,\r
615         IN      OUT                     ipoib_adapter_t                         *p_adapter )\r
616 {\r
617         NTSTATUS                        status;\r
618         ib_al_ifc_data_t        data;\r
619         IO_STACK_LOCATION       io_stack, *p_fwd_io_stack;\r
620         DEVICE_OBJECT           *p_pdo;\r
621         IRP                                     *p_irp;\r
622         KEVENT                          event;\r
623         IO_STATUS_BLOCK         io_status;\r
624 \r
625         IPOIB_ENTER( IPOIB_DBG_INIT );\r
626 \r
627         NdisMGetDeviceProperty( h_adapter, &p_pdo, NULL, NULL, NULL, NULL );\r
628 \r
629         /* Query for our interface */\r
630         data.size = sizeof(ipoib_ifc_data_t);\r
631         data.version = IPOIB_INTERFACE_DATA_VERSION;\r
632         data.type = &GUID_IPOIB_INTERFACE_DATA;\r
633         data.p_data = &p_adapter->guids;\r
634 \r
635         io_stack.MinorFunction = IRP_MN_QUERY_INTERFACE;\r
636         io_stack.Parameters.QueryInterface.Version = AL_INTERFACE_VERSION;\r
637         io_stack.Parameters.QueryInterface.Size = sizeof(ib_al_ifc_t);\r
638         io_stack.Parameters.QueryInterface.Interface =\r
639                 (INTERFACE*)p_adapter->p_ifc;\r
640         io_stack.Parameters.QueryInterface.InterfaceSpecificData = &data;\r
641         io_stack.Parameters.QueryInterface.InterfaceType = \r
642                 &GUID_IB_AL_INTERFACE;\r
643 \r
644         KeInitializeEvent( &event, NotificationEvent, FALSE );\r
645 \r
646         /* Build the IRP for the HCA. */\r
647         p_irp = IoBuildSynchronousFsdRequest( IRP_MJ_PNP, p_pdo,\r
648                 NULL, 0, NULL, &event, &io_status );\r
649         if( !p_irp )\r
650         {\r
651                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
652                         ("Failed to allocate query interface IRP.\n") );\r
653                 return STATUS_INSUFFICIENT_RESOURCES;\r
654         }\r
655 \r
656         /* Copy the request query parameters. */\r
657         p_fwd_io_stack = IoGetNextIrpStackLocation( p_irp );\r
658         p_fwd_io_stack->MinorFunction = IRP_MN_QUERY_INTERFACE;\r
659         p_fwd_io_stack->Parameters.QueryInterface =\r
660                 io_stack.Parameters.QueryInterface;\r
661         p_irp->IoStatus.Status = STATUS_NOT_SUPPORTED;\r
662 \r
663         /* Send the IRP. */\r
664         status = IoCallDriver( p_pdo, p_irp );\r
665         if( status == STATUS_PENDING )\r
666         {\r
667                 KeWaitForSingleObject( &event, Executive, KernelMode,\r
668                         FALSE, NULL );\r
669                 status = io_status.Status;\r
670         }\r
671 \r
672         if( !NT_SUCCESS( status ) )\r
673         {\r
674                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
675                         ("Query interface for IPOIB interface returned %08x.\n", status) );\r
676                 return status;\r
677         }\r
678 \r
679         /*\r
680          * Dereference the interface now so that the bus driver doesn't fail a\r
681          * query remove IRP.  We will always get unloaded before the bus driver\r
682          * since we're a child device.\r
683          */\r
684         p_adapter->p_ifc->wdm.InterfaceDereference(\r
685                 p_adapter->p_ifc->wdm.Context );\r
686         IPOIB_EXIT( IPOIB_DBG_INIT );\r
687         return NDIS_STATUS_SUCCESS;\r
688 }\r
689 \r
690 \r
691 //! Initialization function called for each IOC discovered\r
692 /*  The MiniportInitialize function is a required function that sets up a\r
693 NIC (or virtual NIC) for network I/O operations, claims all hardware\r
694 resources necessary to the NIC in the registry, and allocates resources\r
695 the driver needs to carry out network I/O operations.\r
696 IRQL = PASSIVE_LEVEL\r
697 \r
698 @param p_open_status Pointer to a status field set if this function returns NDIS_STATUS_OPEN_ERROR\r
699 @param p_selected_medium_index Pointer to unsigned integer noting index into medium_array for this NIC\r
700 @param medium_array Array of mediums for this NIC\r
701 @param medium_array_size Number of elements in medium_array\r
702 @param h_adapter Handle assigned by NDIS for this NIC\r
703 @param wrapper_config_context Handle used for Ndis initialization functions\r
704 @return NDIS_STATUS_SUCCESS, NDIS_STATUS_UNSUPPORTED_MEDIA, NDIS_STATUS_RESOURCES,\r
705 NDIS_STATUS_NOT_SUPPORTED \r
706 */\r
707 NDIS_STATUS\r
708 ipoib_initialize(\r
709                 OUT                     PNDIS_STATUS                            p_open_status,\r
710                 OUT                     PUINT                                           p_selected_medium_index,\r
711         IN                              PNDIS_MEDIUM                            medium_array,\r
712         IN                              UINT                                            medium_array_size,\r
713         IN                              NDIS_HANDLE                                     h_adapter,\r
714         IN                              NDIS_HANDLE                                     wrapper_config_context )\r
715 {\r
716         NDIS_STATUS                     status;\r
717         ib_api_status_t         ib_status;\r
718         UINT                            medium_index;\r
719         ipoib_adapter_t         *p_adapter;\r
720 \r
721         IPOIB_ENTER( IPOIB_DBG_INIT );\r
722 \r
723 #ifdef _DEBUG_\r
724         PAGED_CODE();\r
725 #endif\r
726 \r
727         UNUSED_PARAM( p_open_status );\r
728         UNUSED_PARAM( wrapper_config_context );\r
729 \r
730         /* Search for our medium */\r
731         for( medium_index = 0; medium_index < medium_array_size; ++medium_index )\r
732         {\r
733                 /* Check to see if we found our medium */\r
734                 if( medium_array[medium_index] == NdisMedium802_3 )\r
735                         break;\r
736         }\r
737 \r
738         if( medium_index == medium_array_size ) /* Never found it */\r
739         {\r
740                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
741                         ("No supported media.\n") );\r
742                 return NDIS_STATUS_UNSUPPORTED_MEDIA;\r
743         }\r
744 \r
745         *p_selected_medium_index = medium_index;\r
746 \r
747         /* Create the adapter adapter */\r
748         ib_status = ipoib_create_adapter( wrapper_config_context, h_adapter, &p_adapter );\r
749         if( ib_status != IB_SUCCESS )\r
750         {\r
751                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
752                         ("ipoib_create_adapter returned status %d.\n", ib_status ) );\r
753                 return NDIS_STATUS_FAILURE;\r
754         }\r
755 \r
756         /* Allow ten seconds for all SA queries to finish up. */\r
757         NdisMSetAttributesEx( h_adapter, p_adapter, 5,\r
758                 NDIS_ATTRIBUTE_BUS_MASTER | NDIS_ATTRIBUTE_DESERIALIZE |\r
759                 NDIS_ATTRIBUTE_USES_SAFE_BUFFER_APIS,\r
760                 NdisInterfacePNPBus );\r
761 \r
762 #if IPOIB_USE_DMA\r
763         status =\r
764                 NdisMInitializeScatterGatherDma( h_adapter, TRUE, p_adapter->params.xfer_block_size );\r
765         if( status != NDIS_STATUS_SUCCESS )\r
766         {\r
767                 ipoib_destroy_adapter( p_adapter );\r
768                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
769                         ("NdisMInitializeScatterGatherDma returned 0x%.8x.\n", status) );\r
770                 return status;\r
771         }\r
772 #endif\r
773 \r
774         /* Create the adapter adapter */\r
775         ib_status = ipoib_start_adapter( p_adapter );\r
776         if( ib_status != IB_SUCCESS )\r
777         {\r
778                 NdisWriteErrorLogEntry( h_adapter,\r
779                         NDIS_ERROR_CODE_HARDWARE_FAILURE, 0 );\r
780                 ipoib_destroy_adapter( p_adapter );\r
781                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
782                         ("ipoib_start_adapter returned status %d.\n", ib_status ) );\r
783                 return NDIS_STATUS_FAILURE;\r
784         }\r
785 \r
786         ipoib_ref_ibat();\r
787 \r
788         IPOIB_EXIT( IPOIB_DBG_INIT );\r
789         return status;\r
790 }\r
791 \r
792 \r
793 //! Deallocates resources when the NIC is removed and halts the NIC..\r
794 /*  IRQL = DISPATCH_LEVEL\r
795 \r
796 @param adapter_context The adapter context allocated at start\r
797 */\r
798 void\r
799 ipoib_halt(\r
800         IN                              NDIS_HANDLE                                     adapter_context )\r
801 {\r
802         ipoib_adapter_t *p_adapter;\r
803 \r
804         IPOIB_ENTER( IPOIB_DBG_INIT );\r
805 \r
806         ipoib_deref_ibat();\r
807 \r
808         CL_ASSERT( adapter_context );\r
809         p_adapter = (ipoib_adapter_t*)adapter_context;\r
810 \r
811         IPOIB_PRINT( TRACE_LEVEL_INFORMATION, IPOIB_DBG_INIT,\r
812                         ("Port %016I64x (CA %016I64x port %d) halting\n",\r
813                         p_adapter->guids.port_guid.guid, p_adapter->guids.ca_guid,\r
814                         p_adapter->guids.port_num) );\r
815 \r
816         ipoib_destroy_adapter( p_adapter );\r
817 \r
818         IPOIB_EXIT( IPOIB_DBG_INIT );\r
819 }\r
820 \r
821 \r
822 //! Reports the state of the NIC, or monitors the responsiveness of an underlying device driver.\r
823 /*  IRQL = DISPATCH_LEVEL\r
824 \r
825 @param adapter_context The adapter context allocated at start\r
826 @return TRUE if the driver determines that its NIC is not operating\r
827 */\r
828 BOOLEAN\r
829 ipoib_check_for_hang(\r
830         IN                              NDIS_HANDLE                                     adapter_context )\r
831 {\r
832         ipoib_adapter_t *p_adapter;\r
833 \r
834         IPOIB_ENTER( IPOIB_DBG_INIT );\r
835         CL_ASSERT( adapter_context );\r
836         p_adapter = (ipoib_adapter_t*)adapter_context;\r
837 \r
838         if( p_adapter->reset )\r
839         {\r
840                 IPOIB_EXIT( IPOIB_DBG_INIT );\r
841                 return FALSE;\r
842         }\r
843         if (p_adapter->hung) {\r
844                 ipoib_resume_oids(p_adapter);\r
845         }\r
846 \r
847         IPOIB_EXIT( IPOIB_DBG_INIT );\r
848         return (p_adapter->hung? TRUE:FALSE);\r
849 }\r
850 \r
851 \r
852 //! Returns information about the capabilities and status of the driver and/or its NIC.\r
853 /*  IRQL = DISPATCH_LEVEL\r
854 \r
855 @param adapter_context The adapter context allocated at start\r
856 @param oid Object ID representing the query operation to be carried out\r
857 @param info_buf Buffer containing any input for this query and location for output\r
858 @param info_buf_len Number of bytes available in info_buf\r
859 @param p_bytes_written Pointer to number of bytes written into info_buf\r
860 @param p_bytes_needed Pointer to number of bytes needed to satisfy this oid\r
861 @return NDIS_STATUS_SUCCESS, NDIS_STATUS_PENDING, NDIS_STATUS_INVALID_OID,\r
862 NDIS_STATUS_INVALID_LENGTH, NDIS_STATUS_NOT_ACCEPTED, NDIS_STATUS_NOT_SUPPORTED,\r
863 NDIS_STATUS_RESOURCES\r
864 */\r
865 NDIS_STATUS\r
866 ipoib_query_info(\r
867         IN                              NDIS_HANDLE                                     adapter_context,\r
868         IN                              NDIS_OID                                        oid,\r
869         IN                              PVOID                                           info_buf,\r
870         IN                              ULONG                                           info_buf_len,\r
871                 OUT                     PULONG                                          p_bytes_written,\r
872                 OUT                     PULONG                                          p_bytes_needed )\r
873 {\r
874         ipoib_adapter_t         *p_adapter;\r
875         NDIS_STATUS                     status;\r
876         USHORT                          version;\r
877         ULONG                           info;\r
878         PVOID                           src_buf;\r
879         ULONG                           buf_len;\r
880         pending_oid_t           oid_info;\r
881         uint8_t                         port_num;\r
882 \r
883         IPOIB_ENTER( IPOIB_DBG_OID );\r
884 \r
885         oid_info.oid = oid;\r
886         oid_info.p_buf = info_buf;\r
887         oid_info.buf_len = info_buf_len;\r
888         oid_info.p_bytes_used = p_bytes_written;\r
889         oid_info.p_bytes_needed = p_bytes_needed;\r
890 \r
891         CL_ASSERT( adapter_context );\r
892         p_adapter = (ipoib_adapter_t*)adapter_context;\r
893 \r
894         CL_ASSERT( p_bytes_written );\r
895         CL_ASSERT( p_bytes_needed );\r
896         CL_ASSERT( !p_adapter->pending_query );\r
897 \r
898         status = NDIS_STATUS_SUCCESS;\r
899         src_buf = &info;\r
900         buf_len = sizeof(info);\r
901 \r
902         port_num = p_adapter->guids.port_num;\r
903 \r
904         switch( oid )\r
905         {\r
906         /* Required General */\r
907         case OID_GEN_SUPPORTED_LIST:\r
908                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
909                         ("Port %d received query for OID_GEN_SUPPORTED_LIST\n", port_num) );\r
910                 src_buf = (PVOID)SUPPORTED_OIDS;\r
911                 buf_len = sizeof(SUPPORTED_OIDS);\r
912                 break;\r
913 \r
914         case OID_GEN_HARDWARE_STATUS:\r
915                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
916                         ("Port %d received query for OID_GEN_HARDWARE_STATUS\n", port_num) );\r
917                 cl_obj_lock( &p_adapter->obj );\r
918                 switch( p_adapter->state )\r
919                 {\r
920                 case IB_PNP_PORT_ADD:\r
921                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
922                                 ("Port %d returning NdisHardwareStatusInitializing\n", port_num) );\r
923                         info = NdisHardwareStatusInitializing;\r
924                         break;\r
925                         \r
926                 case IB_PNP_PORT_ACTIVE:\r
927                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
928                                 ("Port %d returning NdisHardwareStatusReady\n", port_num) );\r
929                         info = NdisHardwareStatusReady;\r
930                         break;\r
931 \r
932                 default:\r
933                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
934                                 ("Port %d returning NdisHardwareStatusNotReady\n", port_num) );\r
935                         info = NdisHardwareStatusNotReady;\r
936                 }\r
937                 cl_obj_unlock( &p_adapter->obj );\r
938                 break;\r
939 \r
940         case OID_GEN_MEDIA_SUPPORTED:\r
941         case OID_GEN_MEDIA_IN_USE:\r
942                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
943                         ("Port %d received query for OID_GEN_MEDIA_SUPPORTED "\r
944                         "or OID_GEN_MEDIA_IN_USE\n", port_num) );\r
945                 info = NdisMedium802_3;\r
946                 break;\r
947 \r
948         case OID_GEN_MAXIMUM_FRAME_SIZE:\r
949                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
950                         ("Port %d received query for OID_GEN_MAXIMUM_FRAME_SIZE\n", port_num) );\r
951                 info = p_adapter->params.payload_mtu;\r
952                 break;\r
953 \r
954         case OID_GEN_LINK_SPEED:\r
955                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
956                         ("Port %d received query for OID_GEN_LINK_SPEED\n", port_num) );\r
957                 cl_obj_lock( &p_adapter->obj );\r
958                 info = p_adapter->port_rate;\r
959                 cl_obj_unlock( &p_adapter->obj );\r
960                 break;\r
961 \r
962         case OID_GEN_TRANSMIT_BUFFER_SPACE:\r
963                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
964                         ("Port %d received query for OID_GEN_TRANSMIT_BUFFER_SPACE\n", port_num) );\r
965                 info = p_adapter->params.sq_depth * p_adapter->params.xfer_block_size;\r
966                 break;\r
967 \r
968         case OID_GEN_RECEIVE_BUFFER_SPACE:\r
969                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
970                         ("Port %d received query for OID_GEN_TRANSMIT_BUFFER_SPACE "\r
971                         "or OID_GEN_RECEIVE_BUFFER_SPACE\n", port_num) );\r
972                 info = p_adapter->params.rq_depth * p_adapter->params.xfer_block_size;\r
973                 break;\r
974 \r
975         case OID_GEN_MAXIMUM_LOOKAHEAD:\r
976         case OID_GEN_CURRENT_LOOKAHEAD:\r
977         case OID_GEN_TRANSMIT_BLOCK_SIZE:\r
978         case OID_GEN_RECEIVE_BLOCK_SIZE:\r
979         case OID_GEN_MAXIMUM_TOTAL_SIZE:\r
980                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
981                         ("Port %d received query for OID_GEN_MAXIMUM_LOOKAHEAD "\r
982                         "or OID_GEN_CURRENT_LOOKAHEAD or "\r
983                         "OID_GEN_TRANSMIT_BLOCK_SIZE or "\r
984                         "OID_GEN_RECEIVE_BLOCK_SIZE or "\r
985                         "OID_GEN_MAXIMUM_TOTAL_SIZE\n", port_num) );\r
986                 info = p_adapter->params.xfer_block_size;\r
987                 break;\r
988 \r
989         case OID_GEN_VENDOR_ID:\r
990                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
991                         ("Port %d received query for OID_GEN_VENDOR_ID\n", port_num) );\r
992                 src_buf = (void*)VENDOR_ID;\r
993                 buf_len = sizeof(VENDOR_ID);\r
994                 break;\r
995 \r
996         case OID_GEN_VENDOR_DESCRIPTION:\r
997                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID, \r
998                         ("Port %d received query for OID_GEN_VENDOR_DESCRIPTION\n", port_num) );\r
999                 src_buf = VENDOR_DESCRIPTION;\r
1000                 buf_len = sizeof(VENDOR_DESCRIPTION);\r
1001                 break;\r
1002 \r
1003         case OID_GEN_VENDOR_DRIVER_VERSION:\r
1004                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1005                         ("Port %d received query for OID_GEN_VENDOR_DRIVER_VERSION\n", port_num) );\r
1006                 src_buf = &version;\r
1007                 buf_len = sizeof(version);\r
1008                 //TODO: Figure out what the right version is.\r
1009                 version = 1 << 8 | 1;\r
1010                 break;\r
1011 \r
1012         case OID_GEN_PHYSICAL_MEDIUM:\r
1013                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1014                         ("Port %d received query for OID_GEN_PHYSICAL_MEDIUM\n", port_num) );\r
1015                 info = NdisPhysicalMediumUnspecified;\r
1016                 break;\r
1017 \r
1018         case OID_GEN_CURRENT_PACKET_FILTER:\r
1019                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1020                         ("Port %d received query for OID_GEN_CURRENT_PACKET_FILTER\n", port_num) );\r
1021                 info = p_adapter->packet_filter;\r
1022                 break;\r
1023 \r
1024         case OID_GEN_DRIVER_VERSION:\r
1025                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1026                         ("Port %d received query for OID_GEN_DRIVER_VERSION\n", port_num) );\r
1027                 src_buf = &version;\r
1028                 buf_len = sizeof(version);\r
1029                 version = MAJOR_NDIS_VERSION << 8 | MINOR_NDIS_VERSION;\r
1030                 break;\r
1031 \r
1032         case OID_GEN_MAC_OPTIONS:\r
1033                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1034                         ("Port %d received query for OID_GEN_MAC_OPTIONS\n", port_num) );\r
1035                 info = NDIS_MAC_OPTION_COPY_LOOKAHEAD_DATA |\r
1036                         NDIS_MAC_OPTION_TRANSFERS_NOT_PEND |\r
1037                         NDIS_MAC_OPTION_NO_LOOPBACK |\r
1038                         NDIS_MAC_OPTION_FULL_DUPLEX;\r
1039 //TODO: Figure out if we will support priority and VLANs.\r
1040 //                              NDIS_MAC_OPTION_8021P_PRIORITY;\r
1041 //#ifdef NDIS51_MINIPORT\r
1042 //                      info |= NDIS_MAC_OPTION_8021Q_VLAN;\r
1043 //#endif\r
1044                 break;\r
1045 \r
1046         case OID_GEN_MEDIA_CONNECT_STATUS:\r
1047                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1048                         ("Port %d received query for OID_GEN_MEDIA_CONNECT_STATUS\n", port_num) );\r
1049                 cl_obj_lock( &p_adapter->obj );\r
1050                 switch( p_adapter->state )\r
1051                 {\r
1052                 case IB_PNP_PORT_ADD:\r
1053                 case IB_PNP_PORT_INIT:\r
1054                         /*\r
1055                          * Delay reporting media state until we know whether the port is\r
1056                          * either up or down.\r
1057                          */\r
1058                         p_adapter->pending_query = TRUE;\r
1059                         p_adapter->query_oid = oid_info;\r
1060 \r
1061                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1062                                 ("Port %d returning NDIS_STATUS_PENDING\n", port_num) );\r
1063                         status = NDIS_STATUS_PENDING;\r
1064                         break;\r
1065 \r
1066                 case IB_PNP_PORT_ACTIVE:\r
1067                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1068                                 ("Port %d returning NdisMediaStateConnected\n", port_num) );\r
1069                         info = NdisMediaStateConnected;\r
1070                         break;\r
1071 \r
1072                 case IB_PNP_PORT_REMOVE:\r
1073                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1074                                 ("Port %d returning NDIS_STATUS_NOT_ACCEPTED\n", port_num) );\r
1075                         status = NDIS_STATUS_NOT_ACCEPTED;\r
1076                         break;\r
1077 \r
1078                 default:\r
1079                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1080                                 ("Port %d returning NdisMediaStateDisconnected\n", port_num) );\r
1081                         info = NdisMediaStateDisconnected;\r
1082                 }\r
1083                 cl_obj_unlock( &p_adapter->obj );\r
1084                 break;\r
1085 \r
1086         case OID_GEN_MAXIMUM_SEND_PACKETS:\r
1087                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1088                         ("Port %d received query for OID_GEN_MAXIMUM_SEND_PACKETS\n", port_num) );\r
1089                 info = MAXULONG;\r
1090                 break;\r
1091 \r
1092         /* Required General Statistics */\r
1093         case OID_GEN_XMIT_OK:\r
1094                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1095                         ("Port %d received query for OID_GEN_XMIT_OK\n", port_num) );\r
1096                 src_buf = NULL;\r
1097                 status = ipoib_get_send_stat( p_adapter, IP_STAT_SUCCESS, &oid_info );\r
1098                 break;\r
1099 \r
1100         case OID_GEN_RCV_OK:\r
1101                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1102                         ("Port %d received query for OID_GEN_RCV_OK\n", port_num) );\r
1103                 src_buf = NULL;\r
1104                 status = ipoib_get_recv_stat( p_adapter, IP_STAT_SUCCESS, &oid_info );\r
1105                 break;\r
1106 \r
1107         case OID_GEN_XMIT_ERROR:\r
1108                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1109                         ("Port %d received query for OID_GEN_XMIT_ERROR\n", port_num) );\r
1110                 src_buf = NULL;\r
1111                 status = ipoib_get_send_stat( p_adapter, IP_STAT_ERROR, &oid_info );\r
1112                 break;\r
1113 \r
1114         case OID_GEN_RCV_ERROR:\r
1115                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1116                         ("Port %d received query for OID_GEN_RCV_ERROR\n", port_num) );\r
1117                 src_buf = NULL;\r
1118                 status = ipoib_get_recv_stat( p_adapter, IP_STAT_ERROR, &oid_info );\r
1119                 break;\r
1120 \r
1121         case OID_GEN_RCV_NO_BUFFER:\r
1122                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1123                         ("Port %d received query for OID_GEN_RCV_NO_BUFFER\n", port_num) );\r
1124                 src_buf = NULL;\r
1125                 status = ipoib_get_recv_stat( p_adapter, IP_STAT_DROPPED, &oid_info );\r
1126                 break;\r
1127 \r
1128         case OID_GEN_DIRECTED_BYTES_XMIT:\r
1129                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1130                         ("Port %d received query for OID_GEN_DIRECTED_BYTES_XMIT\n", port_num) );\r
1131                 src_buf = NULL;\r
1132                 status = ipoib_get_send_stat( p_adapter, IP_STAT_UCAST_BYTES, &oid_info );\r
1133                 break;\r
1134 \r
1135         case OID_GEN_DIRECTED_FRAMES_XMIT:\r
1136                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1137                         ("Port %d received query for OID_GEN_DIRECTED_FRAMES_XMIT\n", port_num) );\r
1138                 src_buf = NULL;\r
1139                 status = ipoib_get_send_stat( p_adapter, IP_STAT_UCAST_FRAMES, &oid_info );\r
1140                 break;\r
1141 \r
1142         case OID_GEN_MULTICAST_BYTES_XMIT:\r
1143                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1144                         ("Port %d received query for OID_GEN_MULTICAST_BYTES_XMIT\n", port_num) );\r
1145                 src_buf = NULL;\r
1146                 status = ipoib_get_send_stat( p_adapter, IP_STAT_MCAST_BYTES, &oid_info );\r
1147                 break;\r
1148 \r
1149         case OID_GEN_MULTICAST_FRAMES_XMIT:\r
1150                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1151                         ("Port %d received query for OID_GEN_MULTICAST_FRAMES_XMIT\n", port_num) );\r
1152                 src_buf = NULL;\r
1153                 status = ipoib_get_send_stat( p_adapter, IP_STAT_MCAST_FRAMES, &oid_info );\r
1154                 break;\r
1155 \r
1156         case OID_GEN_BROADCAST_BYTES_XMIT:\r
1157                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1158                         ("Port %d received query for OID_GEN_BROADCAST_BYTES_XMIT\n", port_num) );\r
1159                 src_buf = NULL;\r
1160                 status = ipoib_get_send_stat( p_adapter, IP_STAT_BCAST_BYTES, &oid_info );\r
1161                 break;\r
1162 \r
1163         case OID_GEN_BROADCAST_FRAMES_XMIT:\r
1164                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1165                         ("Port %d received query for OID_GEN_BROADCAST_FRAMES_XMIT\n", port_num) );\r
1166                 src_buf = NULL;\r
1167                 status = ipoib_get_send_stat( p_adapter, IP_STAT_BCAST_FRAMES, &oid_info );\r
1168                 break;\r
1169 \r
1170         case OID_GEN_DIRECTED_BYTES_RCV:\r
1171                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1172                         ("Port %d received query for OID_GEN_DIRECTED_BYTES_RCV\n", port_num) );\r
1173                 src_buf = NULL;\r
1174                 status = ipoib_get_recv_stat( p_adapter, IP_STAT_UCAST_BYTES, &oid_info );\r
1175                 break;\r
1176 \r
1177         case OID_GEN_DIRECTED_FRAMES_RCV:\r
1178                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1179                         ("Port %d received query for OID_GEN_DIRECTED_FRAMES_RCV\n", port_num) );\r
1180                 src_buf = NULL;\r
1181                 status = ipoib_get_recv_stat( p_adapter, IP_STAT_UCAST_FRAMES, &oid_info );\r
1182                 break;\r
1183 \r
1184         case OID_GEN_MULTICAST_BYTES_RCV:\r
1185                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1186                         ("Port %d received query for OID_GEN_MULTICAST_BYTES_RCV\n", port_num) );\r
1187                 src_buf = NULL;\r
1188                 status = ipoib_get_recv_stat( p_adapter, IP_STAT_MCAST_BYTES, &oid_info );\r
1189                 break;\r
1190 \r
1191         case OID_GEN_MULTICAST_FRAMES_RCV:\r
1192                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1193                         ("Port %d received query for OID_GEN_MULTICAST_FRAMES_RCV\n", port_num) );\r
1194                 src_buf = NULL;\r
1195                 status = ipoib_get_recv_stat( p_adapter, IP_STAT_MCAST_FRAMES, &oid_info );\r
1196                 break;\r
1197 \r
1198         case OID_GEN_BROADCAST_BYTES_RCV:\r
1199                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1200                         ("Port %d received query for OID_GEN_BROADCAST_BYTES_RCV\n", port_num) );\r
1201                 src_buf = NULL;\r
1202                 status = ipoib_get_recv_stat( p_adapter, IP_STAT_BCAST_BYTES, &oid_info );\r
1203                 break;\r
1204 \r
1205         case OID_GEN_BROADCAST_FRAMES_RCV:\r
1206                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1207                         ("Port %d received query for OID_GEN_BROADCAST_FRAMES_RCV\n", port_num) );\r
1208                 src_buf = NULL;\r
1209                 status = ipoib_get_recv_stat( p_adapter, IP_STAT_BCAST_FRAMES, &oid_info );\r
1210                 break;\r
1211 \r
1212         /* Required Ethernet operational characteristics */\r
1213         case OID_802_3_PERMANENT_ADDRESS:\r
1214                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1215                         ("Port %d received query for OID_802_3_PERMANENT_ADDRESS\n", port_num) );\r
1216                 src_buf = &p_adapter->mac;\r
1217                 buf_len = sizeof(p_adapter->mac);\r
1218                 break;\r
1219 \r
1220         case OID_802_3_CURRENT_ADDRESS:\r
1221                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1222                         ("Port %d received query for OID_802_3_CURRENT_ADDRESS\n", port_num) );\r
1223                 src_buf = &p_adapter->params.conf_mac;\r
1224                 buf_len = sizeof(p_adapter->params.conf_mac);\r
1225                 break;\r
1226 \r
1227         case OID_802_3_MULTICAST_LIST:\r
1228                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1229                         ("Port %d received query for OID_802_3_MULTICAST_LIST\n", port_num) );\r
1230                 src_buf = p_adapter->mcast_array;\r
1231                 buf_len = p_adapter->mcast_array_size * sizeof(mac_addr_t);\r
1232                 break;\r
1233 \r
1234         case OID_802_3_MAXIMUM_LIST_SIZE:\r
1235                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1236                         ("Port %d received query for OID_802_3_MAXIMUM_LIST_SIZE\n", port_num) );\r
1237                 info = MAX_MCAST;\r
1238                 break;\r
1239 \r
1240         case OID_802_3_MAC_OPTIONS:\r
1241                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1242                         ("Port %d received query for OID_802_3_MAC_OPTIONS\n", port_num) );\r
1243                 info = 0;\r
1244                 break;\r
1245 \r
1246         /* Required Ethernet stats */\r
1247         case OID_802_3_RCV_ERROR_ALIGNMENT:\r
1248         case OID_802_3_XMIT_ONE_COLLISION:\r
1249         case OID_802_3_XMIT_MORE_COLLISIONS:\r
1250                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1251                         ("Port %d received query for OID_802_3_RCV_ERROR_ALIGNMENT or "\r
1252                         "OID_802_3_XMIT_ONE_COLLISION or "\r
1253                         "OID_802_3_XMIT_MORE_COLLISIONS\n", port_num) );\r
1254                 info = 0;\r
1255                 break;\r
1256 \r
1257         case OID_TCP_TASK_OFFLOAD:\r
1258                 src_buf = NULL;\r
1259                 status = __ipoib_get_tcp_task_offload( p_adapter, &oid_info );\r
1260                 break;\r
1261 \r
1262         /* Optional General */\r
1263         case OID_GEN_SUPPORTED_GUIDS:\r
1264 #ifdef NDIS51_MINIPORT\r
1265         case OID_GEN_VLAN_ID:\r
1266 #endif\r
1267 \r
1268         /* Optional General Stats */\r
1269         case OID_GEN_RCV_CRC_ERROR:\r
1270         case OID_GEN_TRANSMIT_QUEUE_LENGTH:\r
1271 \r
1272         /* Optional Ethernet Stats */\r
1273         case OID_802_3_XMIT_DEFERRED:\r
1274         case OID_802_3_XMIT_MAX_COLLISIONS:\r
1275         case OID_802_3_RCV_OVERRUN:\r
1276         case OID_802_3_XMIT_UNDERRUN:\r
1277         case OID_802_3_XMIT_HEARTBEAT_FAILURE:\r
1278         case OID_802_3_XMIT_TIMES_CRS_LOST:\r
1279         case OID_802_3_XMIT_LATE_COLLISIONS:\r
1280         case OID_PNP_CAPABILITIES:\r
1281                 status = NDIS_STATUS_NOT_SUPPORTED;\r
1282                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1283                         ("Port %d received an unsupported oid of 0x%.8X!\n", port_num, oid) );\r
1284                 break;\r
1285 \r
1286         case OID_GEN_PROTOCOL_OPTIONS:\r
1287         case OID_GEN_NETWORK_LAYER_ADDRESSES:\r
1288         case OID_GEN_TRANSPORT_HEADER_OFFSET:\r
1289 #ifdef NDIS51_MINIPORT\r
1290         case OID_GEN_MACHINE_NAME:\r
1291         case OID_GEN_RNDIS_CONFIG_PARAMETER:\r
1292 #endif\r
1293         default:\r
1294                 status = NDIS_STATUS_INVALID_OID;\r
1295                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1296                         ("Port %d received an invalid oid of 0x%.8X!\n", port_num, oid) );\r
1297                 break;\r
1298         }\r
1299 \r
1300         /*\r
1301          * Complete the request as if it was handled asynchronously to maximize\r
1302          * code reuse for when we really handle the requests asynchronously.\r
1303          * Note that this requires the QueryInformation entry point to always\r
1304          * return NDIS_STATUS_PENDING\r
1305          */\r
1306         if( status != NDIS_STATUS_PENDING )\r
1307         {\r
1308                 ipoib_complete_query(\r
1309                         p_adapter, &oid_info, status, src_buf, buf_len );\r
1310         }\r
1311 \r
1312         IPOIB_EXIT( IPOIB_DBG_OID );\r
1313         return NDIS_STATUS_PENDING;\r
1314 }\r
1315 \r
1316 \r
1317 static void\r
1318 ipoib_complete_query(\r
1319         IN                              ipoib_adapter_t* const          p_adapter,\r
1320         IN                              pending_oid_t* const            p_oid_info,\r
1321         IN              const   NDIS_STATUS                                     status,\r
1322         IN              const   void* const                                     p_buf,\r
1323         IN              const   ULONG                                           buf_len )\r
1324 {\r
1325         NDIS_STATUS             oid_status = status;\r
1326 \r
1327         IPOIB_ENTER( IPOIB_DBG_OID );\r
1328 \r
1329         CL_ASSERT( status != NDIS_STATUS_PENDING );\r
1330 \r
1331         if( status == NDIS_STATUS_SUCCESS )\r
1332         {\r
1333                 if( p_oid_info->buf_len < buf_len )\r
1334                 {\r
1335                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1336                                 ("Insufficient buffer space.  "\r
1337                                 "Returning NDIS_STATUS_INVALID_LENGTH.\n") );\r
1338                         oid_status = NDIS_STATUS_INVALID_LENGTH;\r
1339                         *p_oid_info->p_bytes_needed = buf_len;\r
1340                         *p_oid_info->p_bytes_used = 0;\r
1341                 }\r
1342                 else if( p_oid_info->p_buf )\r
1343                 {\r
1344                         /* Only copy if we have a distinct source buffer. */\r
1345                         if( p_buf )\r
1346                         {\r
1347                                 NdisMoveMemory( p_oid_info->p_buf, p_buf, buf_len );\r
1348                                 *p_oid_info->p_bytes_used = buf_len;\r
1349                         }\r
1350                 }\r
1351                 else\r
1352                 {\r
1353                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1354                                 ("Returning NDIS_NOT_ACCEPTED") );\r
1355                         oid_status = NDIS_STATUS_NOT_ACCEPTED;\r
1356                 }\r
1357         }\r
1358         else\r
1359         {\r
1360                 *p_oid_info->p_bytes_used = 0;\r
1361         }\r
1362 \r
1363         p_adapter->pending_query = FALSE;\r
1364 \r
1365         NdisMQueryInformationComplete( p_adapter->h_adapter, oid_status );\r
1366 \r
1367         IPOIB_EXIT( IPOIB_DBG_OID );\r
1368 }\r
1369 \r
1370 \r
1371 static NDIS_STATUS\r
1372 __ipoib_get_tcp_task_offload(\r
1373         IN                              ipoib_adapter_t*                        p_adapter,\r
1374         IN                              pending_oid_t* const            p_oid_info )\r
1375 {\r
1376         NDIS_TASK_OFFLOAD_HEADER        *p_offload_hdr;\r
1377         NDIS_TASK_OFFLOAD                       *p_offload_task;\r
1378         NDIS_TASK_TCP_IP_CHECKSUM       *p_offload_chksum;\r
1379 \r
1380         NDIS_TASK_TCP_LARGE_SEND        *p_offload_lso;\r
1381         ULONG                                           buf_len;\r
1382 \r
1383         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1384                 ("Port %d received query for OID_TCP_TASK_OFFLOAD\n",\r
1385                 p_adapter->guids.port_num) );\r
1386 \r
1387         buf_len = sizeof(NDIS_TASK_OFFLOAD_HEADER) +\r
1388                 offsetof( NDIS_TASK_OFFLOAD, TaskBuffer ) +\r
1389                 sizeof(NDIS_TASK_TCP_IP_CHECKSUM) +\r
1390                 (p_adapter->params.lso  ? \r
1391                         sizeof(NDIS_TASK_OFFLOAD) + sizeof(NDIS_TASK_TCP_LARGE_SEND)\r
1392                         : 0);\r
1393 \r
1394         *(p_oid_info->p_bytes_needed) = buf_len;\r
1395 \r
1396         if( p_oid_info->buf_len < buf_len )\r
1397                 return NDIS_STATUS_INVALID_LENGTH;\r
1398 \r
1399         p_offload_hdr = (NDIS_TASK_OFFLOAD_HEADER*)p_oid_info->p_buf;\r
1400         if( p_offload_hdr->Version != NDIS_TASK_OFFLOAD_VERSION )\r
1401                 return NDIS_STATUS_INVALID_DATA;\r
1402 \r
1403         if( p_offload_hdr->EncapsulationFormat.Encapsulation !=\r
1404                 IEEE_802_3_Encapsulation )\r
1405         {\r
1406                 return NDIS_STATUS_INVALID_DATA;\r
1407         }\r
1408 \r
1409         p_offload_hdr->OffsetFirstTask = sizeof(NDIS_TASK_OFFLOAD_HEADER);\r
1410         p_offload_task = (NDIS_TASK_OFFLOAD*)(p_offload_hdr + 1);\r
1411         p_offload_task->Version = NDIS_TASK_OFFLOAD_VERSION;\r
1412         p_offload_task->Size = sizeof(NDIS_TASK_OFFLOAD);\r
1413         p_offload_task->Task = TcpIpChecksumNdisTask;\r
1414         p_offload_task->OffsetNextTask = 0;\r
1415         p_offload_task->TaskBufferLength = sizeof(NDIS_TASK_TCP_IP_CHECKSUM);\r
1416         p_offload_chksum =\r
1417                 (NDIS_TASK_TCP_IP_CHECKSUM*)p_offload_task->TaskBuffer;\r
1418         \r
1419         p_offload_chksum->V4Transmit.IpOptionsSupported =\r
1420         p_offload_chksum->V4Transmit.TcpOptionsSupported =\r
1421         p_offload_chksum->V4Transmit.TcpChecksum =\r
1422         p_offload_chksum->V4Transmit.UdpChecksum =\r
1423         p_offload_chksum->V4Transmit.IpChecksum =\r
1424                 !!(p_adapter->params.send_chksum_offload);\r
1425 \r
1426         p_offload_chksum->V4Receive.IpOptionsSupported =\r
1427         p_offload_chksum->V4Receive.TcpOptionsSupported =\r
1428         p_offload_chksum->V4Receive.TcpChecksum =\r
1429         p_offload_chksum->V4Receive.UdpChecksum =\r
1430         p_offload_chksum->V4Receive.IpChecksum =\r
1431                 !!(p_adapter->params.recv_chksum_offload);\r
1432 \r
1433         p_offload_chksum->V6Transmit.IpOptionsSupported = FALSE;\r
1434         p_offload_chksum->V6Transmit.TcpOptionsSupported = FALSE;\r
1435         p_offload_chksum->V6Transmit.TcpChecksum = FALSE;\r
1436         p_offload_chksum->V6Transmit.UdpChecksum = FALSE;\r
1437 \r
1438         p_offload_chksum->V6Receive.IpOptionsSupported = FALSE;\r
1439         p_offload_chksum->V6Receive.TcpOptionsSupported = FALSE;\r
1440         p_offload_chksum->V6Receive.TcpChecksum = FALSE;\r
1441         p_offload_chksum->V6Receive.UdpChecksum = FALSE;\r
1442 \r
1443 \r
1444         if (p_adapter->params.lso) {\r
1445                 // set the previous pointer to the correct place\r
1446                 p_offload_task->OffsetNextTask = FIELD_OFFSET(NDIS_TASK_OFFLOAD, TaskBuffer) +\r
1447                                                 p_offload_task->TaskBufferLength;\r
1448                 // set the LSO packet\r
1449                 p_offload_task = (PNDIS_TASK_OFFLOAD)\r
1450                                                 ((PUCHAR)p_offload_task + p_offload_task->OffsetNextTask);\r
1451 \r
1452                 p_offload_task->Version = NDIS_TASK_OFFLOAD_VERSION;\r
1453                 p_offload_task->Size = sizeof(NDIS_TASK_OFFLOAD);\r
1454                 p_offload_task->Task = TcpLargeSendNdisTask;\r
1455                 p_offload_task->OffsetNextTask = 0;\r
1456                 p_offload_task->TaskBufferLength = sizeof(NDIS_TASK_TCP_LARGE_SEND);\r
1457 \r
1458                 p_offload_lso = (PNDIS_TASK_TCP_LARGE_SEND) p_offload_task->TaskBuffer;\r
1459 \r
1460                 p_offload_lso->Version = 0;\r
1461                 //TODO optimal size: 60000, 64000 or 65536\r
1462                 //TODO LSO_MIN_SEG_COUNT to be 1\r
1463                 p_offload_lso->MaxOffLoadSize = LARGE_SEND_OFFLOAD_SIZE; \r
1464 #define LSO_MIN_SEG_COUNT 2\r
1465                 p_offload_lso->MinSegmentCount = LSO_MIN_SEG_COUNT;\r
1466                 p_offload_lso->TcpOptions = TRUE;\r
1467                 p_offload_lso->IpOptions = TRUE;\r
1468         }\r
1469 \r
1470         *(p_oid_info->p_bytes_used) = buf_len;\r
1471 \r
1472         return NDIS_STATUS_SUCCESS;\r
1473 }\r
1474 \r
1475 \r
1476 static NDIS_STATUS\r
1477 __ipoib_set_tcp_task_offload(\r
1478         IN                              ipoib_adapter_t*                        p_adapter,\r
1479         IN                              void* const                                     p_info_buf,\r
1480         IN                              ULONG* const                            p_info_len )\r
1481 {\r
1482         NDIS_TASK_OFFLOAD_HEADER        *p_offload_hdr;\r
1483         NDIS_TASK_OFFLOAD                       *p_offload_task;\r
1484         NDIS_TASK_TCP_IP_CHECKSUM       *p_offload_chksum;\r
1485 \r
1486         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1487                 ("Port %d received set for OID_TCP_TASK_OFFLOAD\n",\r
1488                 p_adapter->guids.port_num) );\r
1489 \r
1490         p_offload_hdr = (NDIS_TASK_OFFLOAD_HEADER*)p_info_buf;\r
1491 \r
1492         if( *p_info_len < sizeof(NDIS_TASK_OFFLOAD_HEADER) )\r
1493                 return NDIS_STATUS_INVALID_LENGTH;\r
1494 \r
1495         if( p_offload_hdr->Version != NDIS_TASK_OFFLOAD_VERSION )\r
1496                 return NDIS_STATUS_INVALID_DATA;\r
1497 \r
1498         if( p_offload_hdr->Size != sizeof(NDIS_TASK_OFFLOAD_HEADER) )\r
1499                 return NDIS_STATUS_INVALID_LENGTH;\r
1500 \r
1501         if( !p_offload_hdr->OffsetFirstTask )\r
1502                 return NDIS_STATUS_SUCCESS;\r
1503 \r
1504         if( p_offload_hdr->EncapsulationFormat.Encapsulation !=\r
1505                 IEEE_802_3_Encapsulation )\r
1506         {\r
1507                 return NDIS_STATUS_INVALID_DATA;\r
1508         }\r
1509 \r
1510         p_offload_task = (NDIS_TASK_OFFLOAD*)\r
1511                 (((UCHAR*)p_offload_hdr) + p_offload_hdr->OffsetFirstTask);\r
1512 \r
1513         if( *p_info_len < sizeof(NDIS_TASK_OFFLOAD_HEADER) +\r
1514                 offsetof( NDIS_TASK_OFFLOAD, TaskBuffer ) +\r
1515                 sizeof(NDIS_TASK_TCP_IP_CHECKSUM) )\r
1516         {\r
1517                 return NDIS_STATUS_INVALID_LENGTH;\r
1518         }\r
1519 \r
1520         if( p_offload_task->Version != NDIS_TASK_OFFLOAD_VERSION )\r
1521                 return NDIS_STATUS_INVALID_DATA;\r
1522         p_offload_chksum =\r
1523                 (NDIS_TASK_TCP_IP_CHECKSUM*)p_offload_task->TaskBuffer;\r
1524 \r
1525         if( !p_adapter->params.send_chksum_offload &&\r
1526                 (p_offload_chksum->V4Transmit.IpOptionsSupported ||\r
1527                 p_offload_chksum->V4Transmit.TcpOptionsSupported ||\r
1528                 p_offload_chksum->V4Transmit.TcpChecksum ||\r
1529                 p_offload_chksum->V4Transmit.UdpChecksum ||\r
1530                 p_offload_chksum->V4Transmit.IpChecksum) )\r
1531         {\r
1532                 return NDIS_STATUS_NOT_SUPPORTED;\r
1533         }\r
1534 \r
1535         if( !p_adapter->params.recv_chksum_offload &&\r
1536                 (p_offload_chksum->V4Receive.IpOptionsSupported ||\r
1537                 p_offload_chksum->V4Receive.TcpOptionsSupported ||\r
1538                 p_offload_chksum->V4Receive.TcpChecksum ||\r
1539                 p_offload_chksum->V4Receive.UdpChecksum ||\r
1540                 p_offload_chksum->V4Receive.IpChecksum) )\r
1541         {\r
1542                 return NDIS_STATUS_NOT_SUPPORTED;\r
1543         }\r
1544 \r
1545         return NDIS_STATUS_SUCCESS;\r
1546 }\r
1547 \r
1548 \r
1549 //! Issues a hardware reset to the NIC and/or resets the driver's software state.\r
1550 /*  Tear down the connection and start over again.  This is only called when there is a problem.\r
1551 For example, if a send, query info, or set info had a time out.  MiniportCheckForHang will\r
1552 be called first.\r
1553 IRQL = DISPATCH_LEVEL\r
1554 \r
1555 @param p_addr_resetPointer to BOOLLEAN that is set to TRUE if the NDIS\r
1556 library should call MiniportSetInformation to restore addressing information to the current values.\r
1557 @param adapter_context The adapter context allocated at start\r
1558 @return NDIS_STATUS_SUCCESS, NDIS_STATUS_PENDING, NDIS_STATUS_NOT_RESETTABLE,\r
1559 NDIS_STATUS_RESET_IN_PROGRESS, NDIS_STATUS_SOFT_ERRORS, NDIS_STATUS_HARD_ERRORS\r
1560 */\r
1561 NDIS_STATUS\r
1562 ipoib_reset(\r
1563                 OUT                     PBOOLEAN                                        p_addr_reset,\r
1564         IN                              NDIS_HANDLE                                     adapter_context)\r
1565 {\r
1566         ipoib_adapter_t* p_adapter;\r
1567 \r
1568         IPOIB_ENTER( IPOIB_DBG_INIT );\r
1569 \r
1570         CL_ASSERT( p_addr_reset );\r
1571         CL_ASSERT( adapter_context );\r
1572         p_adapter = (ipoib_adapter_t*)adapter_context;\r
1573 \r
1574         switch( ipoib_reset_adapter( p_adapter ) )\r
1575         {\r
1576         case IB_NOT_DONE:\r
1577                 IPOIB_EXIT( IPOIB_DBG_INIT );\r
1578                 return NDIS_STATUS_PENDING;\r
1579 \r
1580         case IB_SUCCESS:\r
1581                 IPOIB_EXIT( IPOIB_DBG_INIT );\r
1582                 *p_addr_reset = TRUE;\r
1583                 return NDIS_STATUS_SUCCESS;\r
1584 \r
1585         case IB_INVALID_STATE:\r
1586                 IPOIB_EXIT( IPOIB_DBG_INIT );\r
1587                 return NDIS_STATUS_RESET_IN_PROGRESS;\r
1588 \r
1589         default:\r
1590                 IPOIB_EXIT( IPOIB_DBG_INIT );\r
1591                 return NDIS_STATUS_HARD_ERRORS;\r
1592         }\r
1593 }\r
1594 \r
1595 \r
1596 //! Request changes in the state information that the miniport driver maintains\r
1597 /*  For example, this is used to set multicast addresses and the packet filter.\r
1598 IRQL = DISPATCH_LEVEL\r
1599 \r
1600 @param adapter_context The adapter context allocated at start\r
1601 @param oid Object ID representing the set operation to be carried out\r
1602 @param info_buf Buffer containing input for this set and location for any output\r
1603 @param info_buf_len Number of bytes available in info_buf\r
1604 @param p_bytes_read Pointer to number of bytes read from info_buf\r
1605 @param p_bytes_needed Pointer to number of bytes needed to satisfy this oid\r
1606 @return NDIS_STATUS_SUCCESS, NDIS_STATUS_PENDING, NDIS_STATUS_INVALID_OID,\r
1607 NDIS_STATUS_INVALID_LENGTH, NDIS_STATUS_INVALID_DATA, NDIS_STATUS_NOT_ACCEPTED,\r
1608 NDIS_STATUS_NOT_SUPPORTED, NDIS_STATUS_RESOURCES\r
1609 */\r
1610 NDIS_STATUS\r
1611 ipoib_set_info(\r
1612         IN                              NDIS_HANDLE                                     adapter_context,\r
1613         IN                              NDIS_OID                                        oid,\r
1614         IN                              PVOID                                           info_buf,\r
1615         IN                              ULONG                                           info_buf_len,\r
1616                 OUT                     PULONG                                          p_bytes_read,\r
1617                 OUT                     PULONG                                          p_bytes_needed )\r
1618 {\r
1619         ipoib_adapter_t*        p_adapter;\r
1620         NDIS_STATUS                     status;\r
1621 \r
1622         ULONG                           buf_len;\r
1623         uint8_t                         port_num;\r
1624 \r
1625         KLOCK_QUEUE_HANDLE      hdl;\r
1626         \r
1627         IPOIB_ENTER( IPOIB_DBG_OID );\r
1628 \r
1629         CL_ASSERT( adapter_context );\r
1630         p_adapter = (ipoib_adapter_t*)adapter_context;\r
1631 \r
1632         CL_ASSERT( p_bytes_read );\r
1633         CL_ASSERT( p_bytes_needed );\r
1634         CL_ASSERT( !p_adapter->pending_set );\r
1635 \r
1636         status = NDIS_STATUS_SUCCESS;\r
1637         *p_bytes_needed = 0;\r
1638         buf_len = sizeof(ULONG);\r
1639 \r
1640         port_num = p_adapter->guids.port_num;\r
1641 \r
1642         switch( oid )\r
1643         {\r
1644         /* Required General */\r
1645         case OID_GEN_CURRENT_PACKET_FILTER:\r
1646                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1647                         ("Port %d received set for OID_GEN_CURRENT_PACKET_FILTER\n", port_num));\r
1648                 if( info_buf_len < sizeof(p_adapter->packet_filter) )\r
1649                 {\r
1650                         status = NDIS_STATUS_INVALID_LENGTH;\r
1651                 }\r
1652                 else if( !info_buf )\r
1653                 {\r
1654                         status = NDIS_STATUS_INVALID_DATA;\r
1655                 }\r
1656                 else\r
1657                 {\r
1658                         KeAcquireInStackQueuedSpinLock( &g_ipoib.lock, &hdl );\r
1659                         cl_obj_lock( &p_adapter->obj );\r
1660                         switch( p_adapter->state )\r
1661                         {\r
1662                         case IB_PNP_PORT_ADD:\r
1663                                 p_adapter->set_oid.oid = oid;\r
1664                                 p_adapter->set_oid.p_buf = info_buf;\r
1665                                 p_adapter->set_oid.buf_len = info_buf_len;\r
1666                                 p_adapter->set_oid.p_bytes_used = p_bytes_read;\r
1667                                 p_adapter->set_oid.p_bytes_needed = p_bytes_needed;\r
1668                                 p_adapter->pending_set = TRUE;\r
1669                                 status = NDIS_STATUS_PENDING;\r
1670                                 break;\r
1671 \r
1672                         case IB_PNP_PORT_REMOVE:\r
1673                                 status = NDIS_STATUS_NOT_ACCEPTED;\r
1674                                 break;\r
1675 \r
1676                         default:\r
1677                                 if( !p_adapter->packet_filter && (*(uint32_t*)info_buf) )\r
1678                                 {\r
1679                                         cl_qlist_insert_tail(\r
1680                                                 &g_ipoib.adapter_list, &p_adapter->entry );\r
1681 \r
1682                                         /*\r
1683                                          * Filter was zero, now non-zero.  Register IP addresses\r
1684                                          * with SA.\r
1685                                          */\r
1686                                         ipoib_reg_addrs( p_adapter );\r
1687                                 }\r
1688                                 else if( p_adapter->packet_filter && !(*(uint32_t*)info_buf) )\r
1689                                 {\r
1690                                         /*\r
1691                                          * Filter was non-zero, now zero.  Deregister IP addresses.\r
1692                                          */\r
1693                                         ipoib_dereg_addrs( p_adapter );\r
1694 \r
1695                                         ASSERT( cl_qlist_count( &g_ipoib.adapter_list ) );\r
1696                                         cl_qlist_remove_item(\r
1697                                                 &g_ipoib.adapter_list, &p_adapter->entry );\r
1698                                 }\r
1699 \r
1700                                 p_adapter->packet_filter = *(uint32_t*)info_buf;\r
1701                         }\r
1702                         cl_obj_unlock( &p_adapter->obj );\r
1703                         KeReleaseInStackQueuedSpinLock( &hdl );\r
1704                 }\r
1705                 break;\r
1706 \r
1707         case OID_GEN_CURRENT_LOOKAHEAD:\r
1708                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1709                         ("Port %d received set for OID_GEN_CURRENT_LOOKAHEAD\n", port_num));\r
1710                 if( info_buf_len < buf_len )\r
1711                         status = NDIS_STATUS_INVALID_LENGTH;\r
1712                 break;\r
1713 \r
1714         case OID_GEN_PROTOCOL_OPTIONS:\r
1715                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1716                         ("Port %d received set for OID_GEN_PROTOCOL_OPTIONS\n", port_num));\r
1717                 if( info_buf_len < buf_len )\r
1718                         status = NDIS_STATUS_INVALID_LENGTH;\r
1719                 break;\r
1720 \r
1721         case OID_GEN_NETWORK_LAYER_ADDRESSES:\r
1722                 status = __ipoib_set_net_addr( p_adapter, info_buf, info_buf_len, p_bytes_read, p_bytes_needed);\r
1723                 break;\r
1724 \r
1725 #ifdef NDIS51_MINIPORT\r
1726         case OID_GEN_MACHINE_NAME:\r
1727                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION, IPOIB_DBG_OID,\r
1728                         ("Port %d received set for OID_GEN_MACHINE_NAME\n", port_num) );\r
1729                 break;\r
1730 #endif\r
1731 \r
1732         /* Required Ethernet operational characteristics */\r
1733         case OID_802_3_MULTICAST_LIST:\r
1734                 IPOIB_PRINT(TRACE_LEVEL_INFORMATION, IPOIB_DBG_OID,\r
1735                         ("Port %d received set for OID_802_3_MULTICAST_LIST\n", port_num) );\r
1736                 if( info_buf_len > MAX_MCAST * sizeof(mac_addr_t) )\r
1737                 {\r
1738                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1739                                 ("Port %d OID_802_3_MULTICAST_LIST - Multicast list full.\n", port_num) );\r
1740                         status = NDIS_STATUS_MULTICAST_FULL;\r
1741                         *p_bytes_needed = MAX_MCAST * sizeof(mac_addr_t);\r
1742                 }\r
1743                 else if( info_buf_len % sizeof(mac_addr_t) )\r
1744                 {\r
1745                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1746                                 ("Port %d OID_802_3_MULTICAST_LIST - Invalid input buffer.\n", port_num) );\r
1747                         status = NDIS_STATUS_INVALID_DATA;\r
1748                 }\r
1749                 else if( !info_buf && info_buf_len )\r
1750                 {\r
1751                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1752                                 ("Port %d OID_802_3_MULTICAST_LIST - Invalid input buffer.\n", port_num) );\r
1753                         status = NDIS_STATUS_INVALID_DATA;\r
1754                 }\r
1755                 else\r
1756                 {\r
1757                         ipoib_refresh_mcast( p_adapter, (mac_addr_t*)info_buf,\r
1758                                 (uint8_t)(info_buf_len / sizeof(mac_addr_t)) );\r
1759 \r
1760                         buf_len = info_buf_len;\r
1761                         /*\r
1762                          * Note that we don't return pending.  It will likely take longer\r
1763                          * for our SA transactions to complete than NDIS will give us\r
1764                          * before reseting the adapter.  If an SA failure is encountered,\r
1765                          * the adapter will be marked as hung and we will get reset.\r
1766                          */\r
1767                         status = NDIS_STATUS_SUCCESS;\r
1768                 }\r
1769                 break;\r
1770 \r
1771         case OID_TCP_TASK_OFFLOAD:\r
1772                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1773                         ("Port %d received set for OID_TCP_TASK_OFFLOAD\n", port_num) );\r
1774 \r
1775                 buf_len = info_buf_len;\r
1776                 status =\r
1777                         __ipoib_set_tcp_task_offload( p_adapter, info_buf, &buf_len );\r
1778                 break;\r
1779 \r
1780         /* Optional General */\r
1781         case OID_GEN_TRANSPORT_HEADER_OFFSET:\r
1782 #ifdef NDIS51_MINIPORT\r
1783         case OID_GEN_RNDIS_CONFIG_PARAMETER:\r
1784         case OID_GEN_VLAN_ID:\r
1785 #endif\r
1786                 status = NDIS_STATUS_NOT_SUPPORTED;\r
1787                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1788                         ("Port %d received an unsupported oid of 0x%.8X!\n", port_num, oid));\r
1789                 break;\r
1790 \r
1791         case OID_GEN_SUPPORTED_LIST:\r
1792         case OID_GEN_HARDWARE_STATUS:\r
1793         case OID_GEN_MEDIA_SUPPORTED:\r
1794         case OID_GEN_MEDIA_IN_USE:\r
1795         case OID_GEN_MAXIMUM_FRAME_SIZE:\r
1796         case OID_GEN_LINK_SPEED:\r
1797         case OID_GEN_TRANSMIT_BUFFER_SPACE:\r
1798         case OID_GEN_RECEIVE_BUFFER_SPACE:\r
1799         case OID_GEN_MAXIMUM_LOOKAHEAD:\r
1800         case OID_GEN_TRANSMIT_BLOCK_SIZE:\r
1801         case OID_GEN_RECEIVE_BLOCK_SIZE:\r
1802         case OID_GEN_MAXIMUM_TOTAL_SIZE:\r
1803         case OID_GEN_VENDOR_ID:\r
1804         case OID_GEN_VENDOR_DESCRIPTION:\r
1805         case OID_GEN_VENDOR_DRIVER_VERSION:\r
1806         case OID_GEN_DRIVER_VERSION:\r
1807         case OID_GEN_MAC_OPTIONS:\r
1808         case OID_GEN_MEDIA_CONNECT_STATUS:\r
1809         case OID_GEN_MAXIMUM_SEND_PACKETS:\r
1810         case OID_GEN_SUPPORTED_GUIDS:\r
1811         case OID_GEN_PHYSICAL_MEDIUM:\r
1812         default:\r
1813                 status = NDIS_STATUS_INVALID_OID;\r
1814                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
1815                         ("Port %d received an invalid oid of 0x%.8X!\n", port_num, oid));\r
1816                 break;\r
1817         }\r
1818 \r
1819         if( status == NDIS_STATUS_SUCCESS )\r
1820         {\r
1821                 *p_bytes_read = buf_len;\r
1822         }\r
1823         else\r
1824         {\r
1825                 if( status == NDIS_STATUS_INVALID_LENGTH )\r
1826                 {\r
1827                         if ( !*p_bytes_needed )\r
1828                         {\r
1829                                 *p_bytes_needed = buf_len;\r
1830                         }\r
1831                 }\r
1832 \r
1833                 *p_bytes_read = 0;\r
1834         }\r
1835 \r
1836         IPOIB_EXIT( IPOIB_DBG_OID );\r
1837         return status;\r
1838 }\r
1839 \r
1840 \r
1841 //! Transfers some number of packets, specified as an array of packet pointers, over the network. \r
1842 /*  For a deserialized driver, these packets are completed asynchronously\r
1843 using NdisMSendComplete.\r
1844 IRQL <= DISPATCH_LEVEL\r
1845 \r
1846 @param adapter_context Pointer to ipoib_adapter_t structure with per NIC state\r
1847 @param packet_array Array of packets to send\r
1848 @param numPackets Number of packets in the array\r
1849 */\r
1850 void\r
1851 ipoib_send_packets(\r
1852         IN                              NDIS_HANDLE                                     adapter_context,\r
1853         IN                              PPNDIS_PACKET                           packet_array,\r
1854         IN                              UINT                                            num_packets )\r
1855 {\r
1856         ipoib_adapter_t         *p_adapter;\r
1857         ipoib_port_t            *p_port;\r
1858         UINT                            packet_num;\r
1859         PERF_DECLARE( SendPackets );\r
1860         PERF_DECLARE( PortSend );\r
1861 \r
1862         IPOIB_ENTER( IPOIB_DBG_SEND );\r
1863 \r
1864         cl_perf_start( SendPackets );\r
1865 \r
1866         CL_ASSERT( adapter_context );\r
1867         p_adapter = (ipoib_adapter_t*)adapter_context;\r
1868 \r
1869         cl_obj_lock( &p_adapter->obj );\r
1870         if( p_adapter->state != IB_PNP_PORT_ACTIVE || !p_adapter->p_port )\r
1871         {\r
1872                 cl_obj_unlock( &p_adapter->obj );\r
1873                 for( packet_num = 0; packet_num < num_packets; ++packet_num )\r
1874                 {\r
1875                         ipoib_inc_send_stat( p_adapter, IP_STAT_DROPPED, 0 );\r
1876                         NdisMSendCompleteX( p_adapter->h_adapter,\r
1877                                 packet_array[packet_num], NDIS_STATUS_ADAPTER_NOT_READY );\r
1878                 }\r
1879                 IPOIB_EXIT( IPOIB_DBG_SEND );\r
1880                 return;\r
1881         }\r
1882 \r
1883         p_port = p_adapter->p_port;\r
1884         ipoib_port_ref( p_port, ref_send_packets );\r
1885         cl_obj_unlock( &p_adapter->obj );\r
1886 \r
1887         cl_perf_start( PortSend );\r
1888         ipoib_port_send( p_port, packet_array, num_packets );\r
1889         cl_perf_stop( &p_port->p_adapter->perf, PortSend );\r
1890         ipoib_port_deref( p_port, ref_send_packets );\r
1891 \r
1892         cl_perf_stop( &p_adapter->perf, SendPackets );\r
1893 \r
1894         cl_perf_log( &p_adapter->perf, SendBundle, num_packets );\r
1895 \r
1896         IPOIB_EXIT( IPOIB_DBG_SEND );\r
1897 }\r
1898 \r
1899 \r
1900 void\r
1901 ipoib_pnp_notify(\r
1902         IN                              NDIS_HANDLE                                     adapter_context,\r
1903         IN                              NDIS_DEVICE_PNP_EVENT           pnp_event,\r
1904         IN                              PVOID                                           info_buf,\r
1905         IN                              ULONG                                           info_buf_len )\r
1906 {\r
1907         ipoib_adapter_t *p_adapter;\r
1908 \r
1909         IPOIB_ENTER( IPOIB_DBG_PNP );\r
1910 \r
1911         UNUSED_PARAM( info_buf );\r
1912         UNUSED_PARAM( info_buf_len );\r
1913 \r
1914         p_adapter = (ipoib_adapter_t*)adapter_context;\r
1915 \r
1916         IPOIB_PRINT(TRACE_LEVEL_INFORMATION, IPOIB_DBG_PNP, ("Event %d\n", pnp_event) );\r
1917         if( pnp_event != NdisDevicePnPEventPowerProfileChanged )\r
1918         {\r
1919                 cl_obj_lock( &p_adapter->obj );\r
1920                 p_adapter->state = IB_PNP_PORT_REMOVE;\r
1921                 cl_obj_unlock( &p_adapter->obj );\r
1922 \r
1923                 ipoib_resume_oids( p_adapter );\r
1924         }\r
1925 \r
1926         IPOIB_EXIT( IPOIB_DBG_PNP );\r
1927 }\r
1928 \r
1929 \r
1930 void\r
1931 ipoib_shutdown(\r
1932         IN                              PVOID                                           adapter_context )\r
1933 {\r
1934         IPOIB_ENTER( IPOIB_DBG_INIT );\r
1935         UNUSED_PARAM( adapter_context );\r
1936         IPOIB_EXIT( IPOIB_DBG_INIT );\r
1937 }\r
1938 \r
1939 \r
1940 void\r
1941 ipoib_resume_oids(\r
1942         IN                              ipoib_adapter_t* const          p_adapter )\r
1943 {\r
1944         ULONG                           info;\r
1945         NDIS_STATUS                     status;\r
1946         boolean_t                       pending_query, pending_set;\r
1947         pending_oid_t           query_oid = {0};\r
1948         pending_oid_t           set_oid = {0};\r
1949         KLOCK_QUEUE_HANDLE      hdl;\r
1950 \r
1951         IPOIB_ENTER( IPOIB_DBG_INIT );\r
1952 \r
1953         cl_obj_lock( &p_adapter->obj );\r
1954         /*\r
1955          * Set the status depending on our state.  Fail OID requests that\r
1956          * are pending while we reset the adapter.\r
1957          */\r
1958         switch( p_adapter->state )\r
1959         {\r
1960         case IB_PNP_PORT_ADD:\r
1961                 status = NDIS_STATUS_FAILURE;\r
1962                 break;\r
1963 \r
1964         case IB_PNP_PORT_REMOVE:\r
1965                 status = NDIS_STATUS_NOT_ACCEPTED;\r
1966                 break;\r
1967                 \r
1968         default:\r
1969                 status = NDIS_STATUS_SUCCESS;\r
1970         }\r
1971 \r
1972         pending_query = p_adapter->pending_query;\r
1973         if( pending_query )\r
1974         {\r
1975                 query_oid = p_adapter->query_oid;\r
1976                 p_adapter->pending_query = FALSE;\r
1977         }\r
1978         pending_set = p_adapter->pending_set;\r
1979         if( pending_set )\r
1980         {\r
1981                 set_oid = p_adapter->set_oid;\r
1982                 p_adapter->pending_set = FALSE;\r
1983         }\r
1984         cl_obj_unlock( &p_adapter->obj );\r
1985 \r
1986         /*\r
1987          * If we had a pending OID request for OID_GEN_LINK_SPEED,\r
1988          * complete it now.  Note that we hold the object lock since\r
1989          * NdisMQueryInformationComplete is called at DISPATCH_LEVEL.\r
1990          */\r
1991         if( pending_query )\r
1992         {\r
1993                 switch( query_oid.oid )\r
1994                 {\r
1995                 case OID_GEN_MEDIA_CONNECT_STATUS:\r
1996                         info = NdisMediaStateConnected;\r
1997                         ipoib_complete_query( p_adapter, &query_oid,\r
1998                                 status, &info, sizeof(info) );\r
1999                         break;\r
2000 \r
2001                 default:\r
2002                         CL_ASSERT( query_oid.oid == OID_GEN_MEDIA_CONNECT_STATUS );\r
2003                         break;\r
2004                 }\r
2005         }\r
2006 \r
2007         if( pending_set )\r
2008         {\r
2009                 switch( set_oid.oid )\r
2010                 {\r
2011                 case OID_GEN_CURRENT_PACKET_FILTER:\r
2012                         /* Validation already performed in the SetInformation path. */\r
2013 \r
2014                         KeAcquireInStackQueuedSpinLock( &g_ipoib.lock, &hdl );\r
2015                         cl_obj_lock( &p_adapter->obj );\r
2016                         if( !p_adapter->packet_filter && (*(PULONG)set_oid.p_buf) )\r
2017                         {\r
2018                                 cl_qlist_insert_tail(\r
2019                                         &g_ipoib.adapter_list, &p_adapter->entry );\r
2020                                 /*\r
2021                                  * Filter was zero, now non-zero.  Register IP addresses\r
2022                                  * with SA.\r
2023                                  */\r
2024                                 ipoib_reg_addrs( p_adapter );\r
2025                         }\r
2026                         else if( p_adapter->packet_filter && !(*(PULONG)set_oid.p_buf) )\r
2027                         {\r
2028                                 /* Filter was non-zero, now zero.  Deregister IP addresses. */\r
2029                                 ipoib_dereg_addrs( p_adapter );\r
2030 \r
2031                                 ASSERT( cl_qlist_count( &g_ipoib.adapter_list ) );\r
2032                                 cl_qlist_remove_item(\r
2033                                         &g_ipoib.adapter_list, &p_adapter->entry );\r
2034                         }\r
2035                         p_adapter->packet_filter = *(PULONG)set_oid.p_buf;\r
2036 \r
2037                         cl_obj_unlock( &p_adapter->obj );\r
2038                         KeReleaseInStackQueuedSpinLock( &hdl );\r
2039 \r
2040                         NdisMSetInformationComplete( p_adapter->h_adapter, status );\r
2041                         break;\r
2042 \r
2043                 case OID_GEN_NETWORK_LAYER_ADDRESSES:\r
2044                         status = __ipoib_set_net_addr( p_adapter,\r
2045                                                                                    p_adapter->set_oid.p_buf,\r
2046                                                                                    p_adapter->set_oid.buf_len,\r
2047                                                                                    p_adapter->set_oid.p_bytes_used,\r
2048                                                                                    p_adapter->set_oid.p_bytes_needed );\r
2049                         if( status != NDIS_STATUS_PENDING )\r
2050                         {\r
2051                                 NdisMSetInformationComplete( p_adapter->h_adapter, status );\r
2052                         }\r
2053                         break;\r
2054 \r
2055                 default:\r
2056                         CL_ASSERT( set_oid.oid && 0 );\r
2057                         break;\r
2058                 }\r
2059         }\r
2060 \r
2061         IPOIB_EXIT( IPOIB_DBG_INIT );\r
2062 }\r
2063 \r
2064 \r
2065 static NDIS_STATUS\r
2066 __ipoib_set_net_addr(\r
2067         IN              ipoib_adapter_t *       p_adapter,\r
2068         IN              PVOID                           info_buf,\r
2069         IN              ULONG                           info_buf_len,\r
2070                 OUT     PULONG                          p_bytes_read,\r
2071                 OUT     PULONG                          p_bytes_needed )\r
2072 {\r
2073         NDIS_STATUS                             status;\r
2074         PNETWORK_ADDRESS_LIST   p_net_addrs;\r
2075         PNETWORK_ADDRESS                p_net_addr_oid;\r
2076         PNETWORK_ADDRESS_IP             p_ip_addr;\r
2077 \r
2078         net_address_item_t              *p_addr_item;\r
2079 \r
2080         cl_status_t                             cl_status;\r
2081 \r
2082         size_t                                  idx;\r
2083         LONG                                    i;\r
2084         ULONG                                   addr_size;\r
2085         ULONG                                   total_size;\r
2086 \r
2087         uint8_t                                 port_num;\r
2088 \r
2089         IPOIB_ENTER( IPOIB_DBG_OID );\r
2090 \r
2091         status = NDIS_STATUS_SUCCESS;\r
2092         port_num = p_adapter->guids.port_num;\r
2093 \r
2094         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
2095                 ("Port %d received set for OID_GEN_NETWORK_LAYER_ADDRESSES\n",\r
2096                 port_num) );\r
2097 \r
2098         if( !info_buf )\r
2099         {\r
2100                 IPOIB_PRINT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
2101                         ("Port %d - OID_GEN_NETWORK_LAYER_ADDRESSES - "\r
2102                         "NULL buffer\n", port_num) );\r
2103                 IPOIB_EXIT( IPOIB_DBG_OID );\r
2104                 return NDIS_STATUS_INVALID_DATA;\r
2105         }\r
2106 \r
2107         /*\r
2108          * Must use field offset because the structures define array's of size one\r
2109          * of a the incorrect type for what is really stored.\r
2110          */\r
2111         if( info_buf_len < FIELD_OFFSET(NETWORK_ADDRESS_LIST, Address) )\r
2112         {\r
2113                 IPOIB_PRINT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR, \r
2114                         ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - "\r
2115                         "bad length of %d, not enough "\r
2116                         "for NETWORK_ADDRESS_LIST (%d)\n", port_num, info_buf_len,\r
2117                         FIELD_OFFSET(NETWORK_ADDRESS_LIST, Address)) );\r
2118                 *p_bytes_needed = FIELD_OFFSET(NETWORK_ADDRESS_LIST, Address);\r
2119                 IPOIB_EXIT( IPOIB_DBG_OID );\r
2120                 return NDIS_STATUS_INVALID_LENGTH;\r
2121         }\r
2122 \r
2123         p_net_addrs = (PNETWORK_ADDRESS_LIST)info_buf;\r
2124         if( p_net_addrs->AddressCount == 0)\r
2125         {\r
2126                 if( p_net_addrs->AddressType == NDIS_PROTOCOL_ID_TCP_IP )\r
2127                 {\r
2128                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION, IPOIB_DBG_OID,\r
2129                                 ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - "\r
2130                                 "clear TCP/IP addresses\n", port_num) );\r
2131                 }\r
2132                 else\r
2133                 {\r
2134                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION, IPOIB_DBG_OID,\r
2135                                 ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - "\r
2136                                 "Non TCP/IP address type of 0x%.4X on clear\n",\r
2137                                 port_num, p_net_addrs->AddressType) );\r
2138                         IPOIB_EXIT( IPOIB_DBG_OID );\r
2139                         return NDIS_STATUS_SUCCESS;\r
2140                 }\r
2141         }\r
2142 \r
2143         addr_size = FIELD_OFFSET(NETWORK_ADDRESS, Address) +\r
2144                 NETWORK_ADDRESS_LENGTH_IP;\r
2145         total_size = FIELD_OFFSET(NETWORK_ADDRESS_LIST, Address) +\r
2146                 addr_size * p_net_addrs->AddressCount;\r
2147 \r
2148         if( info_buf_len < total_size )\r
2149         {\r
2150                 IPOIB_PRINT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
2151                         ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - "\r
2152                         "bad length of %d, %d required for %d addresses\n",\r
2153                         port_num, info_buf_len, total_size, p_net_addrs->AddressCount) );\r
2154                 *p_bytes_needed = total_size;\r
2155                 IPOIB_EXIT( IPOIB_DBG_OID );\r
2156                 return NDIS_STATUS_INVALID_LENGTH;\r
2157         }\r
2158 \r
2159         /* Lock lists for duration since SA callbacks can occur on other CPUs */\r
2160         cl_obj_lock( &p_adapter->obj );\r
2161 \r
2162         /* Set the capacity of the vector to accomodate all assinged addresses. */\r
2163         cl_status = cl_vector_set_capacity(\r
2164                 &p_adapter->ip_vector, p_net_addrs->AddressCount );\r
2165         if( cl_status != CL_SUCCESS )\r
2166         {\r
2167                 cl_obj_unlock( &p_adapter->obj );\r
2168                 IPOIB_PRINT(TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
2169                         ("Port %d - OID_GEN_NETWORK_LAYER_ADDRESSES - "\r
2170                         "Failed to set IP vector capacity: %#x\n", port_num,\r
2171                         cl_status) );\r
2172                 IPOIB_EXIT( IPOIB_DBG_OID );\r
2173                 return NDIS_STATUS_RESOURCES;\r
2174         }\r
2175 \r
2176         *p_bytes_read = total_size;\r
2177 \r
2178         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
2179                 ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - List contains %d addresses\n",\r
2180                         port_num, p_net_addrs->AddressCount));\r
2181 \r
2182         /* First look for addresses we had that should be removed */\r
2183         for( idx = 0; idx != cl_vector_get_size( &p_adapter->ip_vector ); idx++ )\r
2184         {\r
2185                 p_addr_item = (net_address_item_t*)\r
2186                         cl_vector_get_ptr( &p_adapter->ip_vector, idx );\r
2187                 p_net_addr_oid = (PNETWORK_ADDRESS)p_net_addrs->Address;\r
2188 \r
2189                 for( i = 0; i < p_net_addrs->AddressCount; ++i, p_net_addr_oid =\r
2190                         (PNETWORK_ADDRESS)((uint8_t *)p_net_addr_oid +\r
2191                         FIELD_OFFSET(NETWORK_ADDRESS, Address) +\r
2192                         p_net_addr_oid->AddressLength) )\r
2193                 {\r
2194 \r
2195                         if( p_net_addr_oid->AddressType != NDIS_PROTOCOL_ID_TCP_IP )\r
2196                         {\r
2197                                 IPOIB_PRINT( TRACE_LEVEL_WARNING, IPOIB_DBG_OID,\r
2198                                         ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - Address %d is wrong type of 0x%.4X, "\r
2199                                                 "should be 0x%.4X\n", port_num, i, p_net_addr_oid->AddressType,\r
2200                                                 NDIS_PROTOCOL_ID_TCP_IP));\r
2201                                 continue;\r
2202                         }\r
2203 \r
2204                         if( p_net_addr_oid->AddressLength != NETWORK_ADDRESS_LENGTH_IP)\r
2205                         {\r
2206                                 IPOIB_PRINT( TRACE_LEVEL_WARNING, IPOIB_DBG_OID,\r
2207                                         ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - Address %d is wrong size of %d, "\r
2208                                                 "should be %d\n", port_num, i, p_net_addr_oid->AddressLength,\r
2209                                                 NETWORK_ADDRESS_LENGTH_IP));\r
2210                                 continue;\r
2211                         }\r
2212 \r
2213                         p_ip_addr = (PNETWORK_ADDRESS_IP)p_net_addr_oid->Address;\r
2214                         if( !cl_memcmp( &p_ip_addr->in_addr,\r
2215                                 &p_addr_item->address.as_ulong, sizeof(ULONG) ) )\r
2216                         {\r
2217                                 break;\r
2218                         }\r
2219                 }\r
2220 \r
2221                 if( i == p_net_addrs->AddressCount )\r
2222                 {\r
2223                         /* Didn't find a match, delete from SA */\r
2224                         IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
2225                                 ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - Deleting Address %d.%d.%d.%d\n",\r
2226                                         port_num,\r
2227                                         p_addr_item->address.as_bytes[0],\r
2228                                         p_addr_item->address.as_bytes[1],\r
2229                                         p_addr_item->address.as_bytes[2],\r
2230                                         p_addr_item->address.as_bytes[3]));\r
2231 \r
2232                         if( p_addr_item->p_reg )\r
2233                         {\r
2234                                 if( p_addr_item->p_reg->h_reg_svc )\r
2235                                 {\r
2236                                         p_adapter->p_ifc->dereg_svc(\r
2237                                                 p_addr_item->p_reg->h_reg_svc, __ipoib_ats_dereg_cb );\r
2238                                 }\r
2239                                 else\r
2240                                 {\r
2241                                         cl_free( p_addr_item->p_reg );\r
2242                                 }\r
2243                                 p_addr_item->p_reg = NULL;\r
2244                         }\r
2245                         p_addr_item->address.as_ulong = 0;\r
2246                 }\r
2247         }\r
2248 \r
2249         /* Now look for new addresses */\r
2250         p_net_addr_oid = (NETWORK_ADDRESS *)p_net_addrs->Address;\r
2251         idx = 0;\r
2252         for( i = 0; i < p_net_addrs->AddressCount; i++, p_net_addr_oid =\r
2253                 (PNETWORK_ADDRESS)((uint8_t *)p_net_addr_oid +\r
2254                 FIELD_OFFSET(NETWORK_ADDRESS, Address) + p_net_addr_oid->AddressLength) )\r
2255         {\r
2256 \r
2257                 if( p_net_addr_oid->AddressType != NDIS_PROTOCOL_ID_TCP_IP )\r
2258                 {\r
2259                         IPOIB_PRINT(TRACE_LEVEL_INFORMATION, IPOIB_DBG_OID,\r
2260                                 ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - Address %d is wrong type of 0x%.4X, "\r
2261                                         "should be 0x%.4X\n", port_num, i, p_net_addr_oid->AddressType,\r
2262                                         NDIS_PROTOCOL_ID_TCP_IP));\r
2263                         continue;\r
2264                 }\r
2265 \r
2266                 if( p_net_addr_oid->AddressLength != NETWORK_ADDRESS_LENGTH_IP)\r
2267                 {\r
2268                         IPOIB_PRINT(TRACE_LEVEL_INFORMATION, IPOIB_DBG_OID,\r
2269                                 ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - Address %d is wrong size of %d, "\r
2270                                         "should be %d\n", port_num, i, p_net_addr_oid->AddressLength,\r
2271                                         NETWORK_ADDRESS_LENGTH_IP));\r
2272                         continue;\r
2273                 }\r
2274 \r
2275                 p_ip_addr = (PNETWORK_ADDRESS_IP)p_net_addr_oid->Address;\r
2276 \r
2277                 /* Size the vector as needed. */\r
2278                 if( cl_vector_get_size( &p_adapter->ip_vector ) <= idx )\r
2279                         cl_vector_set_size( &p_adapter->ip_vector, idx + 1 );\r
2280 \r
2281                 p_addr_item = cl_vector_get_ptr( &p_adapter->ip_vector, idx );\r
2282                 if( !cl_memcmp( &p_ip_addr->in_addr, &p_addr_item->address.as_ulong,\r
2283                         sizeof(ULONG) ) )\r
2284                 {\r
2285                         idx++;\r
2286                         /* Already have this address - no change needed */\r
2287                         continue;\r
2288                 }\r
2289 \r
2290                 /*\r
2291                  * Copy the address information, but don't register yet - the port\r
2292                  * could be down.\r
2293                  */\r
2294                 if( p_addr_item->p_reg )\r
2295                 {\r
2296                         /* If in use by some other address, deregister. */\r
2297                         if( p_addr_item->p_reg->h_reg_svc )\r
2298                         {\r
2299                                 p_adapter->p_ifc->dereg_svc(\r
2300                                         p_addr_item->p_reg->h_reg_svc, __ipoib_ats_dereg_cb );\r
2301                         }\r
2302                         else\r
2303                         {\r
2304                                 cl_free( p_addr_item->p_reg );\r
2305                         }\r
2306                         p_addr_item->p_reg = NULL;\r
2307                 }\r
2308                 memcpy ((void *)&p_addr_item->address.as_ulong, (const void *)&p_ip_addr->in_addr, sizeof(ULONG) );\r
2309                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
2310                         ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - Adding Address %d.%d.%d.%d\n",\r
2311                         port_num,\r
2312                         p_addr_item->address.as_bytes[0],\r
2313                         p_addr_item->address.as_bytes[1],\r
2314                         p_addr_item->address.as_bytes[2],\r
2315                         p_addr_item->address.as_bytes[3]) );\r
2316                 idx++;\r
2317         }\r
2318 \r
2319         /* Now clear any extra entries that shouldn't be there. */\r
2320         while( idx < cl_vector_get_size( &p_adapter->ip_vector ) )\r
2321         {\r
2322                 p_addr_item = (net_address_item_t*)\r
2323                         cl_vector_get_ptr( &p_adapter->ip_vector,\r
2324                         cl_vector_get_size( &p_adapter->ip_vector ) - 1 );\r
2325 \r
2326                 if( p_addr_item->p_reg )\r
2327                 {\r
2328                         if( p_addr_item->p_reg->h_reg_svc )\r
2329                         {\r
2330                                 p_adapter->p_ifc->dereg_svc(\r
2331                                         p_addr_item->p_reg->h_reg_svc, __ipoib_ats_dereg_cb );\r
2332                         }\r
2333                         else\r
2334                         {\r
2335                                 cl_free( p_addr_item->p_reg );\r
2336                         }\r
2337                         p_addr_item->p_reg = NULL;\r
2338                         p_addr_item->address.as_ulong = 0;\r
2339                 }\r
2340 \r
2341                 /* No need to check return value - shrinking always succeeds. */\r
2342                 cl_vector_set_size( &p_adapter->ip_vector,\r
2343                         cl_vector_get_size( &p_adapter->ip_vector ) - 1 );\r
2344         }\r
2345 \r
2346         if( p_adapter->state == IB_PNP_PORT_ACTIVE && p_adapter->packet_filter )\r
2347                 ipoib_reg_addrs( p_adapter );\r
2348 \r
2349         cl_obj_unlock( &p_adapter->obj );\r
2350 \r
2351         IPOIB_EXIT( IPOIB_DBG_OID );\r
2352         return NDIS_STATUS_SUCCESS;\r
2353 }\r
2354 \r
2355 \r
2356 /* Object lock is held when this function is called. */\r
2357 void\r
2358 ipoib_reg_addrs(\r
2359         IN                              ipoib_adapter_t* const          p_adapter )\r
2360 {\r
2361         net_address_item_t              *p_addr_item;\r
2362 \r
2363         size_t                                  idx;\r
2364 \r
2365         uint8_t                                 port_num;\r
2366 \r
2367         ib_api_status_t                 ib_status;\r
2368         ib_reg_svc_req_t                ib_service;\r
2369         ib_gid_t                                port_gid;\r
2370 \r
2371         IPOIB_ENTER( IPOIB_DBG_OID );\r
2372 \r
2373         if(p_adapter->guids.port_guid.pkey != IB_DEFAULT_PKEY)\r
2374         {\r
2375                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR,IPOIB_DBG_ERROR,\r
2376                 ("ATS Service available for default pkey only\n"));      \r
2377                 return;\r
2378         }\r
2379         port_num = p_adapter->guids.port_num;\r
2380 \r
2381         /* Setup our service call with things common to all calls */\r
2382         cl_memset( &ib_service, 0, sizeof(ib_service) );\r
2383 \r
2384         /* BUGBUG Only register local subnet GID prefix for now */\r
2385         ib_gid_set_default( &port_gid, p_adapter->guids.port_guid.guid );\r
2386         ib_service.svc_rec.service_gid          = port_gid;\r
2387 \r
2388         ib_service.svc_rec.service_pkey         = IB_DEFAULT_PKEY;\r
2389         ib_service.svc_rec.service_lease        = IB_INFINITE_SERVICE_LEASE;\r
2390 \r
2391         /* Must cast here because the service name is an array of unsigned chars but\r
2392          * strcpy want a pointer to a signed char */\r
2393         if ( StringCchCopy( (char *)ib_service.svc_rec.service_name, \r
2394                 sizeof(ib_service.svc_rec.service_name) / sizeof(char), ATS_NAME ) != S_OK) {\r
2395                 ASSERT(FALSE);\r
2396                 IPOIB_PRINT_EXIT( TRACE_LEVEL_ERROR,IPOIB_DBG_ERROR,\r
2397                 ("Problem copying ATS name: exiting\n"));\r
2398                 return;\r
2399         }\r
2400     \r
2401         /* IP Address in question will be put in below */\r
2402         ib_service.port_guid            = p_adapter->guids.port_guid.guid;\r
2403         ib_service.timeout_ms           = p_adapter->params.sa_timeout;\r
2404         ib_service.retry_cnt            = p_adapter->params.sa_retry_cnt;\r
2405 \r
2406         /* Can't set IB_FLAGS_SYNC here because I can't wait at dispatch */\r
2407         ib_service.flags                        = 0;\r
2408 \r
2409         /* Service context will be put in below */\r
2410 \r
2411         ib_service.svc_data_mask        = IB_SR_COMPMASK_SID            |\r
2412                                                                   IB_SR_COMPMASK_SGID           |\r
2413                                                                   IB_SR_COMPMASK_SPKEY          |\r
2414                                                                   IB_SR_COMPMASK_SLEASE         |\r
2415                                                                   IB_SR_COMPMASK_SNAME          |\r
2416                                                                   IB_SR_COMPMASK_SDATA8_12      |\r
2417                                                                   IB_SR_COMPMASK_SDATA8_13      |\r
2418                                                                   IB_SR_COMPMASK_SDATA8_14      |\r
2419                                                                   IB_SR_COMPMASK_SDATA8_15;\r
2420         ib_service.pfn_reg_svc_cb = __ipoib_ats_reg_cb;\r
2421 \r
2422         for( idx = 0; idx < cl_vector_get_size( &p_adapter->ip_vector); idx++ )\r
2423         {\r
2424                 p_addr_item = (net_address_item_t*)\r
2425                         cl_vector_get_ptr(  &p_adapter->ip_vector, idx );\r
2426 \r
2427                 if( p_addr_item->p_reg )\r
2428                         continue;\r
2429 \r
2430                 p_addr_item->p_reg = cl_zalloc( sizeof(ats_reg_t) );\r
2431                 if( !p_addr_item->p_reg )\r
2432                         break;\r
2433 \r
2434                 p_addr_item->p_reg->p_adapter = p_adapter;\r
2435 \r
2436                 ib_service.svc_context          = p_addr_item->p_reg;\r
2437 \r
2438                 ib_service.svc_rec.service_id =\r
2439                         ATS_SERVICE_ID & CL_HTON64(0xFFFFFFFFFFFFFF00);\r
2440                 /* ATS service IDs start at 0x10000CE100415453 */\r
2441                 ib_service.svc_rec.service_id |= ((uint64_t)(idx + 0x53)) << 56;\r
2442 \r
2443                 cl_memcpy( &ib_service.svc_rec.service_data8[ATS_IPV4_OFFSET],\r
2444                         p_addr_item->address.as_bytes, IPV4_ADDR_SIZE );\r
2445 \r
2446                 /* Take a reference for each service request. */\r
2447                 cl_obj_ref(&p_adapter->obj);\r
2448                 ib_status = p_adapter->p_ifc->reg_svc(\r
2449                         p_adapter->h_al, &ib_service, &p_addr_item->p_reg->h_reg_svc );\r
2450                 if( ib_status != IB_SUCCESS )\r
2451                 {\r
2452                         if( ib_status == IB_INVALID_GUID )\r
2453                         {\r
2454                                 /* If this occurs, we log the error but do not fail the OID yet */\r
2455                                 IPOIB_PRINT( TRACE_LEVEL_WARNING, IPOIB_DBG_OID,\r
2456                                         ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - "\r
2457                                         "Failed to register IP Address "\r
2458                                         "of %d.%d.%d.%d with error IB_INVALID_GUID\n",\r
2459                                         port_num,\r
2460                                         p_addr_item->address.as_bytes[0],\r
2461                                         p_addr_item->address.as_bytes[1],\r
2462                                         p_addr_item->address.as_bytes[2],\r
2463                                         p_addr_item->address.as_bytes[3]) );\r
2464                         }\r
2465                         else\r
2466                         {\r
2467                                 /* Fatal error. */\r
2468                                 IPOIB_PRINT( TRACE_LEVEL_ERROR, IPOIB_DBG_ERROR,\r
2469                                         ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - Failed to register IP Address "\r
2470                                         "of %d.%d.%d.%d with error %s\n",\r
2471                                         port_num,\r
2472                                         p_addr_item->address.as_bytes[0],\r
2473                                         p_addr_item->address.as_bytes[1],\r
2474                                         p_addr_item->address.as_bytes[2],\r
2475                                         p_addr_item->address.as_bytes[3],\r
2476                                         p_adapter->p_ifc->get_err_str( ib_status )) );\r
2477                                 p_adapter->hung = TRUE;\r
2478                         }\r
2479                         cl_obj_deref(&p_adapter->obj);\r
2480                         cl_free( p_addr_item->p_reg );\r
2481                         p_addr_item->p_reg = NULL;\r
2482                 }\r
2483         }\r
2484 \r
2485         IPOIB_EXIT( IPOIB_DBG_OID );\r
2486 }\r
2487 \r
2488 \r
2489 /* Object lock is held when this function is called. */\r
2490 void\r
2491 ipoib_dereg_addrs(\r
2492         IN                              ipoib_adapter_t* const          p_adapter )\r
2493 {\r
2494         net_address_item_t              *p_addr_item;\r
2495 \r
2496         size_t                                  idx;\r
2497 \r
2498         IPOIB_ENTER( IPOIB_DBG_OID );\r
2499 \r
2500         for( idx = 0; idx < cl_vector_get_size( &p_adapter->ip_vector); idx++ )\r
2501         {\r
2502                 p_addr_item = (net_address_item_t*)\r
2503                         cl_vector_get_ptr( &p_adapter->ip_vector, idx );\r
2504 \r
2505                 if( !p_addr_item->p_reg )\r
2506                         continue;\r
2507 \r
2508                 if( p_addr_item->p_reg->h_reg_svc )\r
2509                 {\r
2510                         p_adapter->p_ifc->dereg_svc(\r
2511                                 p_addr_item->p_reg->h_reg_svc, __ipoib_ats_dereg_cb );\r
2512                 }\r
2513                 else\r
2514                 {\r
2515                         cl_free( p_addr_item->p_reg );\r
2516                 }\r
2517                 p_addr_item->p_reg = NULL;\r
2518         }\r
2519 \r
2520         IPOIB_EXIT( IPOIB_DBG_OID );\r
2521 }\r
2522 \r
2523 \r
2524 static void\r
2525 __ipoib_ats_reg_cb(\r
2526         IN                              ib_reg_svc_rec_t                        *p_reg_svc_rec )\r
2527 {\r
2528         ats_reg_t                               *p_reg;\r
2529         uint8_t                                 port_num;\r
2530 \r
2531         IPOIB_ENTER( IPOIB_DBG_OID );\r
2532 \r
2533         CL_ASSERT( p_reg_svc_rec );\r
2534         CL_ASSERT( p_reg_svc_rec->svc_context );\r
2535 \r
2536         p_reg = (ats_reg_t*)p_reg_svc_rec->svc_context;\r
2537         port_num = p_reg->p_adapter->guids.port_num;\r
2538 \r
2539         cl_obj_lock( &p_reg->p_adapter->obj );\r
2540 \r
2541         if( p_reg_svc_rec->req_status == IB_SUCCESS &&\r
2542                 !p_reg_svc_rec->resp_status )\r
2543         {\r
2544                 IPOIB_PRINT( TRACE_LEVEL_INFORMATION,IPOIB_DBG_OID,\r
2545                                          ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - Registered IP Address "\r
2546                                           "of %d.%d.%d.%d\n",\r
2547                                           port_num,\r
2548                                           p_reg_svc_rec->svc_rec.service_data8[ATS_IPV4_OFFSET],\r
2549                                           p_reg_svc_rec->svc_rec.service_data8[ATS_IPV4_OFFSET+1],\r
2550                                           p_reg_svc_rec->svc_rec.service_data8[ATS_IPV4_OFFSET+2],\r
2551                                           p_reg_svc_rec->svc_rec.service_data8[ATS_IPV4_OFFSET+3]) );\r
2552         }\r
2553         else if( p_reg_svc_rec->req_status != IB_CANCELED )\r
2554         {\r
2555                 IPOIB_PRINT( TRACE_LEVEL_ERROR, IPOIB_DBG_OID,\r
2556                                          ("Port %d OID_GEN_NETWORK_LAYER_ADDRESSES - Failed to register IP Address "\r
2557                                           "of %d.%d.%d.%d with error %s\n",\r
2558                                           port_num,\r
2559                                           p_reg_svc_rec->svc_rec.service_data8[ATS_IPV4_OFFSET],\r
2560                                           p_reg_svc_rec->svc_rec.service_data8[ATS_IPV4_OFFSET+1],\r
2561                                           p_reg_svc_rec->svc_rec.service_data8[ATS_IPV4_OFFSET+2],\r
2562                                           p_reg_svc_rec->svc_rec.service_data8[ATS_IPV4_OFFSET+3],\r
2563                                           p_reg->p_adapter->p_ifc->get_err_str( p_reg_svc_rec->resp_status )) );\r
2564                 p_reg->p_adapter->hung = TRUE;\r
2565                 p_reg->h_reg_svc = NULL;\r
2566         }\r
2567 \r
2568         cl_obj_unlock( &p_reg->p_adapter->obj );\r
2569         cl_obj_deref(&p_reg->p_adapter->obj);\r
2570 \r
2571         IPOIB_EXIT( IPOIB_DBG_OID );\r
2572 }\r
2573 \r
2574 \r
2575 static void\r
2576 __ipoib_ats_dereg_cb(\r
2577         IN                              void                                            *context )\r
2578 {\r
2579         cl_free( context );\r
2580 }\r