[MLX4] add 2 new functions to Eth interface: mlx4_register_vlan/mlx4_unregister_vlan...
[mirror/winof/.git] / hw / mlx4 / kernel / bus / drv / pdo.c
1 #include "precomp.h"\r
2 #include <initguid.h>\r
3 #include <wdmguid.h>\r
4 \r
5 #if defined (EVENT_TRACING)\r
6 #ifdef offsetof\r
7 #undef offsetof\r
8 #endif\r
9 #include "pdo.tmh"\r
10 #endif \r
11 \r
12 #define MAX_ID_LEN 80\r
13 \r
14 NTSTATUS\r
15 EvtDeviceProcessQueryInterfaceRequest(\r
16         IN WDFDEVICE  Device,\r
17         IN LPGUID  InterfaceType,\r
18         IN OUT PINTERFACE  ExposedInterface,\r
19         IN OUT PVOID  ExposedInterfaceSpecificData\r
20         )\r
21 {\r
22         PPDO_DEVICE_DATA p_pdo = PdoGetData(Device);\r
23         PFDO_DEVICE_DATA p_fdo  = p_pdo->p_fdo;\r
24         PMLX4_BUS_IB_INTERFACE p_ib_ifc = (PMLX4_BUS_IB_INTERFACE)ExposedInterface;\r
25 \r
26         UNUSED_PARAM(InterfaceType);\r
27         UNUSED_PARAM(ExposedInterfaceSpecificData);\r
28 \r
29         if (p_fdo->pci_dev.dev) {\r
30                 p_ib_ifc->p_ibdev = p_fdo->bus_ib_ifc.p_ibdev;\r
31                 p_ib_ifc->pmlx4_dev = p_fdo->bus_ib_ifc.pmlx4_dev;\r
32                 p_ib_ifc->is_livefish = p_fdo->bus_ib_ifc.is_livefish;\r
33                 return STATUS_SUCCESS;\r
34         }\r
35         else {\r
36                 p_ib_ifc->p_ibdev = NULL;\r
37                 p_ib_ifc->pmlx4_dev = NULL;\r
38                 p_ib_ifc->is_livefish = FALSE;\r
39                 return STATUS_UNSUCCESSFUL;\r
40         }\r
41 \r
42 }\r
43 \r
44 NTSTATUS\r
45 create_pdo(\r
46         __in WDFDEVICE  Device,\r
47         __in PWCHAR     HardwareIds,\r
48         __in PWCHAR     DeviceDescription,\r
49         __in ULONG      SerialNo,\r
50         __in PWCHAR     Location\r
51 )\r
52 /*++\r
53 \r
54 Routine Description:\r
55 \r
56     This routine creates and initialize a PDO.\r
57 \r
58 Arguments:\r
59 \r
60 Return Value:\r
61 \r
62     NT Status code.\r
63 \r
64 --*/\r
65 {\r
66         NTSTATUS                    status;\r
67         PWDFDEVICE_INIT             pDeviceInit = NULL;\r
68         PPDO_DEVICE_DATA            p_pdo = NULL;\r
69         PFDO_DEVICE_DATA            p_fdo;\r
70         WDFDEVICE                   hChild = NULL;\r
71         WDF_OBJECT_ATTRIBUTES       pdoAttributes;\r
72         WDF_DEVICE_PNP_CAPABILITIES pnpCaps;\r
73         WDF_DEVICE_POWER_CAPABILITIES powerCaps;\r
74         UNICODE_STRING compatId;\r
75         UNICODE_STRING deviceId;\r
76         DECLARE_UNICODE_STRING_SIZE(buffer, MAX_ID_LEN);\r
77         DECLARE_UNICODE_STRING_SIZE(deviceLocation, MAX_ID_LEN);\r
78 \r
79         MLX4_PRINT(TRACE_LEVEL_INFORMATION, MLX4_DBG_DRV, ("Entered CreatePdo\n"));\r
80 \r
81         RtlInitUnicodeString(&compatId, HardwareIds);\r
82         PAGED_CODE();\r
83 \r
84         //\r
85         // Allocate a WDFDEVICE_INIT structure and set the properties\r
86         // so that we can create a device object for the child.\r
87         //\r
88         pDeviceInit = WdfPdoInitAllocate(Device);\r
89 \r
90         if (pDeviceInit == NULL) {\r
91                 status = STATUS_INSUFFICIENT_RESOURCES;\r
92                 goto Cleanup;\r
93         }\r
94 \r
95         //\r
96         // Set DeviceType\r
97         //\r
98         WdfDeviceInitSetDeviceType(pDeviceInit, FILE_DEVICE_BUS_EXTENDER);\r
99 \r
100         //\r
101         // Provide DeviceID, HardwareIDs, CompatibleIDs and InstanceId\r
102         //\r
103         RtlInitUnicodeString(&deviceId,HardwareIds);\r
104 \r
105         status = WdfPdoInitAssignDeviceID(pDeviceInit, &deviceId);\r
106         if (!NT_SUCCESS(status)) {\r
107                 goto Cleanup;\r
108         }\r
109 \r
110         //\r
111         // Note same string  is used to initialize hardware id too\r
112         //\r
113         status = WdfPdoInitAddHardwareID(pDeviceInit, &deviceId);\r
114         if (!NT_SUCCESS(status)) {\r
115                 goto Cleanup;\r
116         }\r
117 \r
118         status = WdfPdoInitAddCompatibleID(pDeviceInit, &compatId);\r
119         if (!NT_SUCCESS(status)) {\r
120                 goto Cleanup;\r
121         }\r
122 \r
123         status =  RtlUnicodeStringPrintf(&buffer, L"%02d", SerialNo);\r
124         if (!NT_SUCCESS(status)) {\r
125                 goto Cleanup;\r
126         }\r
127 \r
128         status = WdfPdoInitAssignInstanceID(pDeviceInit, &buffer);\r
129         if (!NT_SUCCESS(status)) {\r
130                 goto Cleanup;\r
131         }\r
132 \r
133         //\r
134         // Provide a description about the device. This text is usually read from\r
135         // the device. In the case of USB device, this text comes from the string\r
136         // descriptor. This text is displayed momentarily by the PnP manager while\r
137         // it's looking for a matching INF. If it finds one, it uses the Device\r
138         // Description from the INF file or the friendly name created by\r
139         // coinstallers to display in the device manager. FriendlyName takes\r
140         // precedence over the DeviceDesc from the INF file.\r
141         //\r
142         status = RtlUnicodeStringPrintf(&buffer,DeviceDescription  , SerialNo );\r
143         \r
144         if (!NT_SUCCESS(status)) {\r
145                 goto Cleanup;\r
146         }\r
147 \r
148         //\r
149         // You can call WdfPdoInitAddDeviceText multiple times, adding device\r
150         // text for multiple locales. When the system displays the text, it\r
151         // chooses the text that matches the current locale, if available.\r
152         // Otherwise it will use the string for the default locale.\r
153         // The driver can specify the driver's default locale by calling\r
154         // WdfPdoInitSetDefaultLocale.\r
155         //\r
156         status =  RtlUnicodeStringPrintf(&deviceLocation, L"MLX4 %s", Location+4);\r
157         if (!NT_SUCCESS(status)) {\r
158                 goto Cleanup;\r
159         }\r
160 \r
161         status = WdfPdoInitAddDeviceText(pDeviceInit,\r
162                 &buffer, &deviceLocation, 0x409);\r
163         if (!NT_SUCCESS(status)) {\r
164                 goto Cleanup;\r
165         }\r
166 \r
167         WdfPdoInitSetDefaultLocale(pDeviceInit, 0x409);\r
168 \r
169         //\r
170         // Initialize the attributes to specify the size of PDO device extension.\r
171         // All the state information private to the PDO will be tracked here.\r
172         //\r
173         WDF_OBJECT_ATTRIBUTES_INIT_CONTEXT_TYPE(&pdoAttributes, PDO_DEVICE_DATA);\r
174 \r
175         status = WdfDeviceCreate(&pDeviceInit, &pdoAttributes, &hChild);\r
176         if (!NT_SUCCESS(status)) {\r
177                 goto Cleanup;\r
178         }\r
179 \r
180         //\r
181         // Once the device is created successfully, framework frees the\r
182         // DeviceInit memory and sets the pDeviceInit to NULL. So don't\r
183         // call any WdfDeviceInit functions after that.\r
184         //\r
185         // Get the device context.\r
186         //\r
187         p_pdo = PdoGetData(hChild);\r
188         p_fdo = FdoGetData(Device);\r
189 \r
190         p_pdo->p_fdo = p_fdo;\r
191         p_pdo->SerialNo = SerialNo;\r
192         p_pdo->PdoDevice = hChild;\r
193 \r
194         //\r
195         // Set PnP properties for the child device.\r
196         //\r
197         WDF_DEVICE_PNP_CAPABILITIES_INIT(&pnpCaps);\r
198         pnpCaps.Address  = SerialNo;\r
199         pnpCaps.UINumber = SerialNo;\r
200 \r
201         WdfDeviceSetPnpCapabilities(hChild, &pnpCaps);\r
202 \r
203         //\r
204         // Set Power properties for the child device\r
205         //\r
206         WDF_DEVICE_POWER_CAPABILITIES_INIT(&powerCaps);\r
207 \r
208         powerCaps.DeviceD1 = WdfTrue;\r
209         powerCaps.WakeFromD1 = WdfTrue;\r
210         powerCaps.DeviceWake = PowerDeviceD1;\r
211 \r
212         powerCaps.DeviceState[PowerSystemWorking]   = PowerDeviceD0;\r
213         powerCaps.DeviceState[PowerSystemSleeping1] = PowerDeviceD1;\r
214         powerCaps.DeviceState[PowerSystemSleeping2] = PowerDeviceD3;\r
215         powerCaps.DeviceState[PowerSystemSleeping3] = PowerDeviceD3;\r
216         powerCaps.DeviceState[PowerSystemHibernate] = PowerDeviceD3;\r
217         powerCaps.DeviceState[PowerSystemShutdown] = PowerDeviceD3;\r
218 \r
219         WdfDeviceSetPowerCapabilities(hChild, &powerCaps);\r
220 \r
221         //\r
222         // Set bus IB interface\r
223         //\r
224         p_fdo->bus_ib_ifc.port_id = (u8) SerialNo;\r
225         p_fdo->bus_ib_ifc.pVipBusIfc = &p_fdo->mtnic_Ifc;\r
226         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_pd_alloc = mlx4_pd_alloc;\r
227         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_pd_free = mlx4_pd_free;\r
228         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_uar_alloc = mlx4_uar_alloc;\r
229         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_uar_free = mlx4_uar_free;\r
230         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_mr_alloc = mlx4_mr_alloc;\r
231         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_mr_free = mlx4_mr_free;\r
232         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_mr_enable = mlx4_mr_enable;\r
233         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_qp_get_region = mlx4_qp_get_region;\r
234         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_alloc_hwq_res = mlx4_alloc_hwq_res;\r
235         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_free_hwq_res = mlx4_free_hwq_res;\r
236 \r
237         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_cq_alloc = mlx4_cq_alloc;\r
238         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_cq_free = mlx4_cq_free;\r
239         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_cq_modify = mlx4_cq_modify;\r
240         \r
241         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_register_mac = mlx4_register_mac;\r
242         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_unregister_mac = mlx4_unregister_mac;\r
243         \r
244         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_srq_alloc = mlx4_srq_alloc;\r
245         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_srq_free = mlx4_srq_free;\r
246         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_srq_invalidate = mlx4_srq_invalidate;\r
247         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_srq_remove = mlx4_srq_remove;\r
248 \r
249         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_qp_alloc = mlx4_qp_alloc;\r
250         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_qp_free = mlx4_qp_free;\r
251         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_qp_remove = mlx4_qp_remove;\r
252         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_qp_modify = mlx4_qp_modify;\r
253         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_qp_to_ready = mlx4_qp_to_ready;\r
254         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_qp_reserve_range = mlx4_qp_reserve_range;\r
255         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_qp_release_range = mlx4_qp_release_range;\r
256 \r
257         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_alloc_cmd_mailbox = mlx4_alloc_cmd_mailbox;\r
258         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_free_cmd_mailbox = mlx4_free_cmd_mailbox;\r
259         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_cmd = imlx4_cmd;\r
260 \r
261         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_INIT_PORT = mlx4_INIT_PORT;\r
262         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_CLOSE_PORT = mlx4_CLOSE_PORT;\r
263         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_add_eq = mlx4_add_eq;\r
264         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_remove_eq = mlx4_remove_eq;\r
265         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_register_ev_cb = mlx4_reset_cb_register;\r
266         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_unregister_ev_cb = mlx4_reset_cb_unregister;\r
267         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_reset_request = mlx4_reset_request;\r
268         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_reset_execute = mlx4_reset_execute;\r
269         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_reset_ready = mlx4_reset_ready;\r
270         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_register_vlan = mlx4_register_vlan;\r
271         p_fdo->bus_ib_ifc.mlx4_interface.mlx4_unregister_vlan = mlx4_unregister_vlan;\r
272         \r
273         //\r
274         // Create a custom interface so that other drivers can\r
275         // query (IRP_MN_QUERY_INTERFACE) and use our callbacks directly.\r
276         //\r
277         p_fdo->bus_ib_ifc.i.Context = p_pdo;\r
278 \r
279         WDF_QUERY_INTERFACE_CONFIG_INIT( &p_pdo->qiMlx4Bus,\r
280                 (PINTERFACE) &p_fdo->bus_ib_ifc,\r
281                 &MLX4_BUS_IB_INTERFACE_GUID, EvtDeviceProcessQueryInterfaceRequest);\r
282 \r
283         status = WdfDeviceAddQueryInterface( hChild, &p_pdo->qiMlx4Bus );\r
284         if (!NT_SUCCESS(status))\r
285                 goto Cleanup;\r
286 \r
287         //\r
288         // Expose also PCI.SYS interface for MLX4_HCA\r
289         //\r
290         WDF_QUERY_INTERFACE_CONFIG_INIT( &p_pdo->qiPciBus,\r
291                 (PINTERFACE) &p_fdo->pci_dev.bus_pci_ifc,\r
292                 &GUID_BUS_INTERFACE_STANDARD, NULL);\r
293 \r
294         // TODO: Soft Reset - how tobar getting interface during RESET_IN_PROGRESS\r
295         // maybe - using EvtDeviceProcessQueryInterfaceRequest\r
296         status = WdfDeviceAddQueryInterface( hChild, &p_pdo->qiPciBus );\r
297         if (!NT_SUCCESS(status))\r
298                 goto Cleanup;\r
299 \r
300         //\r
301         // Add this device to the FDO's collection of children.\r
302         // After the child device is added to the static collection successfully,\r
303         // driver must call WdfPdoMarkMissing to get the device deleted. It\r
304         // shouldn't delete the child device directly by calling WdfObjectDelete.\r
305         //\r
306         status = WdfFdoAddStaticChild(Device, hChild);\r
307         if (!NT_SUCCESS(status)) {\r
308                 goto Cleanup;\r
309         }\r
310 \r
311         return status;\r
312 \r
313 Cleanup:\r
314         KdPrint(("BusEnum: Bus_CreatePdo failed %x\n", status));\r
315 \r
316         //\r
317         // Call WdfDeviceInitFree if you encounter an error before the\r
318         // device is created. Once the device is created, framework\r
319         // NULLs the pDeviceInit value.\r
320         //\r
321         if (pDeviceInit != NULL) {\r
322                 WdfDeviceInitFree(pDeviceInit);\r
323         }\r
324 \r
325         if(hChild) {\r
326                 WdfObjectDelete(hChild);\r
327         }\r
328 \r
329         return status;\r
330 }\r
331 \r
332 \r