]> git.proxmox.com Git - mirror_edk2.git/blame - EmbeddedPkg/Drivers/AndroidFastbootTransportTcpDxe/FastbootTransportTcp.c
EmbeddedPkg: Apply uncrustify changes
[mirror_edk2.git] / EmbeddedPkg / Drivers / AndroidFastbootTransportTcpDxe / FastbootTransportTcp.c
CommitLineData
4d6e1e5a
BJ
1/** @file\r
2#\r
3# Copyright (c) 2014, ARM Ltd. All rights reserved.<BR>\r
4#\r
878b807a 5# SPDX-License-Identifier: BSD-2-Clause-Patent\r
4d6e1e5a
BJ
6#\r
7#\r
8#**/\r
9\r
10#include <Protocol/AndroidFastbootTransport.h>\r
11#include <Protocol/Dhcp4.h>\r
12#include <Protocol/Tcp4.h>\r
13#include <Protocol/ServiceBinding.h>\r
14#include <Protocol/SimpleTextOut.h>\r
15\r
16#include <Library/BaseLib.h>\r
17#include <Library/BaseMemoryLib.h>\r
18#include <Library/DebugLib.h>\r
19#include <Library/MemoryAllocationLib.h>\r
20#include <Library/PrintLib.h>\r
21#include <Library/UefiBootServicesTableLib.h>\r
22#include <Library/UefiDriverEntryPoint.h>\r
23#include <Library/UefiRuntimeServicesTableLib.h>\r
24\r
e7108d0e 25#define IP4_ADDR_TO_STRING(IpAddr, IpAddrString) UnicodeSPrint ( \\r
4d6e1e5a
BJ
26 IpAddrString, \\r
27 16 * 2, \\r
28 L"%d.%d.%d.%d", \\r
29 IpAddr.Addr[0], \\r
30 IpAddr.Addr[1], \\r
31 IpAddr.Addr[2], \\r
32 IpAddr.Addr[3] \\r
33 );\r
34\r
35// Fastboot says max packet size is 512, but FASTBOOT_TRANSPORT_PROTOCOL\r
36// doesn't place a limit on the size of buffers returned by Receive.\r
37// (This isn't actually a packet size - it's just the size of the buffers we\r
38// pass to the TCP driver to fill with received data.)\r
39// We can achieve much better performance by doing this in larger chunks.\r
e7108d0e 40#define RX_FRAGMENT_SIZE 2048\r
4d6e1e5a 41\r
e7108d0e 42STATIC EFI_SIMPLE_TEXT_OUTPUT_PROTOCOL *mTextOut;\r
4d6e1e5a 43\r
e7108d0e
MK
44STATIC EFI_TCP4_PROTOCOL *mTcpConnection;\r
45STATIC EFI_TCP4_PROTOCOL *mTcpListener;\r
4d6e1e5a 46\r
e7108d0e 47STATIC EFI_EVENT mReceiveEvent;\r
4d6e1e5a 48\r
e7108d0e 49STATIC EFI_SERVICE_BINDING_PROTOCOL *mTcpServiceBinding;\r
4d6e1e5a
BJ
50STATIC EFI_HANDLE mTcpHandle = NULL;\r
51\r
52// We only ever use one IO token for receive and one for transmit. To save\r
53// repeatedly allocating and freeing, just allocate statically and re-use.\r
e7108d0e
MK
54#define NUM_RX_TOKENS 16\r
55#define TOKEN_NEXT(Index) (((Index) + 1) % NUM_RX_TOKENS)\r
56\r
57STATIC UINTN mNextSubmitIndex;\r
58STATIC UINTN mNextReceiveIndex;\r
59STATIC EFI_TCP4_IO_TOKEN mReceiveToken[NUM_RX_TOKENS];\r
60STATIC EFI_TCP4_RECEIVE_DATA mRxData[NUM_RX_TOKENS];\r
61STATIC EFI_TCP4_IO_TOKEN mTransmitToken;\r
62STATIC EFI_TCP4_TRANSMIT_DATA mTxData;\r
4d6e1e5a 63// We also reuse the accept token\r
e7108d0e 64STATIC EFI_TCP4_LISTEN_TOKEN mAcceptToken;\r
4d6e1e5a 65// .. and the close token\r
e7108d0e 66STATIC EFI_TCP4_CLOSE_TOKEN mCloseToken;\r
4d6e1e5a
BJ
67\r
68// List type for queued received packets\r
69typedef struct _FASTBOOT_TCP_PACKET_LIST {\r
e7108d0e
MK
70 LIST_ENTRY Link;\r
71 VOID *Buffer;\r
72 UINTN BufferSize;\r
4d6e1e5a
BJ
73} FASTBOOT_TCP_PACKET_LIST;\r
74\r
e7108d0e 75STATIC LIST_ENTRY mPacketListHead;\r
4d6e1e5a
BJ
76\r
77STATIC\r
78VOID\r
79EFIAPI\r
80DataReceived (\r
e7108d0e
MK
81 IN EFI_EVENT Event,\r
82 IN VOID *Context\r
4d6e1e5a
BJ
83 );\r
84\r
85/*\r
86 Helper function to set up a receive IO token and call Tcp->Receive\r
87*/\r
88STATIC\r
89EFI_STATUS\r
90SubmitRecieveToken (\r
91 VOID\r
92 )\r
93{\r
e7108d0e
MK
94 EFI_STATUS Status;\r
95 VOID *FragmentBuffer;\r
4d6e1e5a
BJ
96\r
97 Status = EFI_SUCCESS;\r
98\r
99 FragmentBuffer = AllocatePool (RX_FRAGMENT_SIZE);\r
100 ASSERT (FragmentBuffer != NULL);\r
101 if (FragmentBuffer == NULL) {\r
a1878955 102 DEBUG ((DEBUG_ERROR, "TCP Fastboot out of resources"));\r
4d6e1e5a
BJ
103 return EFI_OUT_OF_RESOURCES;\r
104 }\r
105\r
e7108d0e 106 mRxData[mNextSubmitIndex].DataLength = RX_FRAGMENT_SIZE;\r
4d6e1e5a
BJ
107 mRxData[mNextSubmitIndex].FragmentTable[0].FragmentLength = RX_FRAGMENT_SIZE;\r
108 mRxData[mNextSubmitIndex].FragmentTable[0].FragmentBuffer = FragmentBuffer;\r
109\r
110 Status = mTcpConnection->Receive (mTcpConnection, &mReceiveToken[mNextSubmitIndex]);\r
e7108d0e 111 if (EFI_ERROR (Status)) {\r
a1878955 112 DEBUG ((DEBUG_ERROR, "TCP Receive: %r\n", Status));\r
4d6e1e5a
BJ
113 FreePool (FragmentBuffer);\r
114 }\r
115\r
116 mNextSubmitIndex = TOKEN_NEXT (mNextSubmitIndex);\r
117 return Status;\r
118}\r
119\r
120/*\r
121 Event notify function for when we have closed our TCP connection.\r
122 We can now start listening for another connection.\r
123*/\r
124STATIC\r
125VOID\r
126ConnectionClosed (\r
127 IN EFI_EVENT Event,\r
e7108d0e 128 IN VOID *Context\r
4d6e1e5a
BJ
129 )\r
130{\r
e7108d0e 131 EFI_STATUS Status;\r
4d6e1e5a
BJ
132\r
133 // Possible bug in EDK2 TCP4 driver: closing a connection doesn't remove its\r
134 // PCB from the list of live connections. Subsequent attempts to Configure()\r
135 // a TCP instance with the same local port will fail with INVALID_PARAMETER.\r
136 // Calling Configure with NULL is a workaround for this issue.\r
137 Status = mTcpConnection->Configure (mTcpConnection, NULL);\r
138\r
139 mTcpConnection = NULL;\r
140\r
141 Status = mTcpListener->Accept (mTcpListener, &mAcceptToken);\r
142 if (EFI_ERROR (Status)) {\r
a1878955 143 DEBUG ((DEBUG_ERROR, "TCP Accept: %r\n", Status));\r
4d6e1e5a
BJ
144 }\r
145}\r
146\r
147STATIC\r
148VOID\r
149CloseReceiveEvents (\r
150 VOID\r
151 )\r
152{\r
e7108d0e 153 UINTN Index;\r
4d6e1e5a
BJ
154\r
155 for (Index = 0; Index < NUM_RX_TOKENS; Index++) {\r
156 gBS->CloseEvent (mReceiveToken[Index].CompletionToken.Event);\r
157 }\r
158}\r
159\r
160/*\r
161 Event notify function to be called when we receive TCP data.\r
162*/\r
163STATIC\r
164VOID\r
165EFIAPI\r
166DataReceived (\r
e7108d0e
MK
167 IN EFI_EVENT Event,\r
168 IN VOID *Context\r
4d6e1e5a
BJ
169 )\r
170{\r
e7108d0e 171 EFI_STATUS Status;\r
4d6e1e5a
BJ
172 FASTBOOT_TCP_PACKET_LIST *NewEntry;\r
173 EFI_TCP4_IO_TOKEN *ReceiveToken;\r
174\r
175 ReceiveToken = &mReceiveToken[mNextReceiveIndex];\r
176\r
177 Status = ReceiveToken->CompletionToken.Status;\r
178\r
179 if (Status == EFI_CONNECTION_FIN) {\r
180 //\r
181 // Remote host closed connection. Close our end.\r
182 //\r
183\r
184 CloseReceiveEvents ();\r
185\r
186 Status = mTcpConnection->Close (mTcpConnection, &mCloseToken);\r
187 ASSERT_EFI_ERROR (Status);\r
188\r
189 return;\r
190 }\r
191\r
192 //\r
193 // Add an element to the receive queue\r
194 //\r
195\r
196 NewEntry = AllocatePool (sizeof (FASTBOOT_TCP_PACKET_LIST));\r
197 if (NewEntry == NULL) {\r
a1878955 198 DEBUG ((DEBUG_ERROR, "TCP Fastboot: Out of resources\n"));\r
4d6e1e5a
BJ
199 return;\r
200 }\r
201\r
202 mNextReceiveIndex = TOKEN_NEXT (mNextReceiveIndex);\r
203\r
204 if (!EFI_ERROR (Status)) {\r
205 NewEntry->Buffer\r
206 = ReceiveToken->Packet.RxData->FragmentTable[0].FragmentBuffer;\r
207 NewEntry->BufferSize\r
208 = ReceiveToken->Packet.RxData->FragmentTable[0].FragmentLength;\r
209\r
210 // Prepare to receive more data\r
e7108d0e 211 SubmitRecieveToken ();\r
4d6e1e5a
BJ
212 } else {\r
213 // Fatal receive error. Put an entry with NULL in the queue, signifying\r
214 // to return EFI_DEVICE_ERROR from TcpFastbootTransportReceive.\r
e7108d0e 215 NewEntry->Buffer = NULL;\r
4d6e1e5a
BJ
216 NewEntry->BufferSize = 0;\r
217\r
a1878955 218 DEBUG ((DEBUG_ERROR, "\nTCP Fastboot Receive error: %r\n", Status));\r
4d6e1e5a
BJ
219 }\r
220\r
221 InsertTailList (&mPacketListHead, &NewEntry->Link);\r
222\r
223 Status = gBS->SignalEvent (mReceiveEvent);\r
224 ASSERT_EFI_ERROR (Status);\r
225}\r
226\r
4d6e1e5a
BJ
227/*\r
228 Event notify function to be called when we accept an incoming TCP connection.\r
229*/\r
230STATIC\r
231VOID\r
232EFIAPI\r
233ConnectionAccepted (\r
e7108d0e
MK
234 IN EFI_EVENT Event,\r
235 IN VOID *Context\r
4d6e1e5a
BJ
236 )\r
237{\r
e7108d0e 238 EFI_TCP4_LISTEN_TOKEN *AcceptToken;\r
4d6e1e5a
BJ
239 EFI_STATUS Status;\r
240 UINTN Index;\r
241\r
e7108d0e
MK
242 AcceptToken = (EFI_TCP4_LISTEN_TOKEN *)Context;\r
243 Status = AcceptToken->CompletionToken.Status;\r
4d6e1e5a
BJ
244\r
245 if (EFI_ERROR (Status)) {\r
a1878955 246 DEBUG ((DEBUG_ERROR, "TCP Fastboot: Connection Error: %r\n", Status));\r
4d6e1e5a
BJ
247 return;\r
248 }\r
e7108d0e 249\r
a1878955 250 DEBUG ((DEBUG_ERROR, "TCP Fastboot: Connection Received.\n"));\r
4d6e1e5a
BJ
251\r
252 //\r
253 // Accepting a new TCP connection creates a new instance of the TCP protocol.\r
254 // Open it and prepare to receive on it.\r
255 //\r
256\r
257 Status = gBS->OpenProtocol (\r
258 AcceptToken->NewChildHandle,\r
259 &gEfiTcp4ProtocolGuid,\r
e7108d0e 260 (VOID **)&mTcpConnection,\r
4d6e1e5a
BJ
261 gImageHandle,\r
262 NULL,\r
263 EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
264 );\r
265 if (EFI_ERROR (Status)) {\r
a1878955 266 DEBUG ((DEBUG_ERROR, "Open TCP Connection: %r\n", Status));\r
4d6e1e5a
BJ
267 return;\r
268 }\r
269\r
e7108d0e 270 mNextSubmitIndex = 0;\r
4d6e1e5a
BJ
271 mNextReceiveIndex = 0;\r
272\r
273 for (Index = 0; Index < NUM_RX_TOKENS; Index++) {\r
274 Status = gBS->CreateEvent (\r
275 EVT_NOTIFY_SIGNAL,\r
276 TPL_CALLBACK,\r
277 DataReceived,\r
278 NULL,\r
279 &(mReceiveToken[Index].CompletionToken.Event)\r
280 );\r
281 ASSERT_EFI_ERROR (Status);\r
282 }\r
283\r
284 for (Index = 0; Index < NUM_RX_TOKENS; Index++) {\r
e7108d0e 285 SubmitRecieveToken ();\r
4d6e1e5a
BJ
286 }\r
287}\r
288\r
289/*\r
290 Set up TCP Fastboot transport: Configure the network device via DHCP then\r
291 start waiting for a TCP connection on the Fastboot port.\r
292*/\r
293EFI_STATUS\r
294TcpFastbootTransportStart (\r
e7108d0e 295 EFI_EVENT ReceiveEvent\r
4d6e1e5a
BJ
296 )\r
297{\r
e7108d0e
MK
298 EFI_STATUS Status;\r
299 EFI_HANDLE NetDeviceHandle;\r
300 EFI_HANDLE *HandleBuffer;\r
301 EFI_IP4_MODE_DATA Ip4ModeData;\r
302 UINTN NumHandles;\r
303 CHAR16 IpAddrString[16];\r
304 UINTN Index;\r
305\r
306 EFI_TCP4_CONFIG_DATA TcpConfigData = {\r
4d6e1e5a
BJ
307 0x00, // IPv4 Type of Service\r
308 255, // IPv4 Time to Live\r
309 { // AccessPoint:\r
310 TRUE, // Use default address\r
e7108d0e
MK
311 {\r
312 { 0, 0, 0, 0 }\r
313 }, // IP Address (ignored - use default)\r
314 {\r
315 { 0, 0, 0, 0 }\r
316 }, // Subnet mask (ignored - use default)\r
4d6e1e5a 317 FixedPcdGet32 (PcdAndroidFastbootTcpPort), // Station port\r
e7108d0e
MK
318 {\r
319 { 0, 0, 0, 0 }\r
320 }, // Remote address: accept any\r
4d6e1e5a
BJ
321 0, // Remote Port: accept any\r
322 FALSE // ActiveFlag: be a "server"\r
323 },\r
324 NULL // Default advanced TCP options\r
325 };\r
326\r
327 mReceiveEvent = ReceiveEvent;\r
328 InitializeListHead (&mPacketListHead);\r
329\r
330 mTextOut->OutputString (mTextOut, L"Initialising TCP Fastboot transport...\r\n");\r
331\r
332 //\r
333 // Open a passive TCP instance\r
334 //\r
335\r
336 Status = gBS->LocateHandleBuffer (\r
337 ByProtocol,\r
338 &gEfiTcp4ServiceBindingProtocolGuid,\r
339 NULL,\r
340 &NumHandles,\r
341 &HandleBuffer\r
342 );\r
343 if (EFI_ERROR (Status)) {\r
a1878955 344 DEBUG ((DEBUG_ERROR, "Find TCP Service Binding: %r\n", Status));\r
4d6e1e5a
BJ
345 return Status;\r
346 }\r
347\r
348 // We just use the first network device\r
349 NetDeviceHandle = HandleBuffer[0];\r
350\r
351 Status = gBS->OpenProtocol (\r
e7108d0e
MK
352 NetDeviceHandle,\r
353 &gEfiTcp4ServiceBindingProtocolGuid,\r
354 (VOID **)&mTcpServiceBinding,\r
355 gImageHandle,\r
356 NULL,\r
357 EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
358 );\r
4d6e1e5a 359 if (EFI_ERROR (Status)) {\r
a1878955 360 DEBUG ((DEBUG_ERROR, "Open TCP Service Binding: %r\n", Status));\r
4d6e1e5a
BJ
361 return Status;\r
362 }\r
363\r
364 Status = mTcpServiceBinding->CreateChild (mTcpServiceBinding, &mTcpHandle);\r
365 if (EFI_ERROR (Status)) {\r
a1878955 366 DEBUG ((DEBUG_ERROR, "TCP ServiceBinding Create: %r\n", Status));\r
4d6e1e5a
BJ
367 return Status;\r
368 }\r
369\r
370 Status = gBS->OpenProtocol (\r
e7108d0e
MK
371 mTcpHandle,\r
372 &gEfiTcp4ProtocolGuid,\r
373 (VOID **)&mTcpListener,\r
374 gImageHandle,\r
375 NULL,\r
376 EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
377 );\r
4d6e1e5a 378 if (EFI_ERROR (Status)) {\r
a1878955 379 DEBUG ((DEBUG_ERROR, "Open TCP Protocol: %r\n", Status));\r
4d6e1e5a
BJ
380 }\r
381\r
382 //\r
383 // Set up re-usable tokens\r
384 //\r
385\r
386 for (Index = 0; Index < NUM_RX_TOKENS; Index++) {\r
e7108d0e
MK
387 mRxData[Index].UrgentFlag = FALSE;\r
388 mRxData[Index].FragmentCount = 1;\r
4d6e1e5a
BJ
389 mReceiveToken[Index].Packet.RxData = &mRxData[Index];\r
390 }\r
391\r
e7108d0e
MK
392 mTxData.Push = TRUE;\r
393 mTxData.Urgent = FALSE;\r
394 mTxData.FragmentCount = 1;\r
4d6e1e5a
BJ
395 mTransmitToken.Packet.TxData = &mTxData;\r
396\r
397 Status = gBS->CreateEvent (\r
398 EVT_NOTIFY_SIGNAL,\r
399 TPL_CALLBACK,\r
400 ConnectionAccepted,\r
401 &mAcceptToken,\r
402 &mAcceptToken.CompletionToken.Event\r
403 );\r
404 ASSERT_EFI_ERROR (Status);\r
405\r
406 Status = gBS->CreateEvent (\r
407 EVT_NOTIFY_SIGNAL,\r
408 TPL_CALLBACK,\r
409 ConnectionClosed,\r
410 &mCloseToken,\r
411 &mCloseToken.CompletionToken.Event\r
412 );\r
413 ASSERT_EFI_ERROR (Status);\r
414\r
415 //\r
416 // Configure the TCP instance\r
417 //\r
418\r
419 Status = mTcpListener->Configure (mTcpListener, &TcpConfigData);\r
420 if (Status == EFI_NO_MAPPING) {\r
421 // Wait until the IP configuration process (probably DHCP) has finished\r
422 do {\r
e7108d0e
MK
423 Status = mTcpListener->GetModeData (\r
424 mTcpListener,\r
425 NULL,\r
426 NULL,\r
4d6e1e5a 427 &Ip4ModeData,\r
e7108d0e
MK
428 NULL,\r
429 NULL\r
4d6e1e5a
BJ
430 );\r
431 ASSERT_EFI_ERROR (Status);\r
432 } while (!Ip4ModeData.IsConfigured);\r
e7108d0e 433\r
4d6e1e5a
BJ
434 Status = mTcpListener->Configure (mTcpListener, &TcpConfigData);\r
435 } else if (EFI_ERROR (Status)) {\r
a1878955 436 DEBUG ((DEBUG_ERROR, "TCP Configure: %r\n", Status));\r
4d6e1e5a
BJ
437 return Status;\r
438 }\r
439\r
440 //\r
441 // Tell the user our address and hostname\r
442 //\r
443 IP4_ADDR_TO_STRING (Ip4ModeData.ConfigData.StationAddress, IpAddrString);\r
444\r
4d6e1e5a
BJ
445 mTextOut->OutputString (mTextOut, L"TCP Fastboot transport configured.");\r
446 mTextOut->OutputString (mTextOut, L"\r\nIP address: ");\r
e7108d0e 447 mTextOut->OutputString (mTextOut, IpAddrString);\r
4d6e1e5a 448 mTextOut->OutputString (mTextOut, L"\r\n");\r
4d6e1e5a
BJ
449\r
450 //\r
451 // Start listening for a connection\r
452 //\r
453\r
454 Status = mTcpListener->Accept (mTcpListener, &mAcceptToken);\r
455 if (EFI_ERROR (Status)) {\r
a1878955 456 DEBUG ((DEBUG_ERROR, "TCP Accept: %r\n", Status));\r
4d6e1e5a
BJ
457 return Status;\r
458 }\r
459\r
460 mTextOut->OutputString (mTextOut, L"TCP Fastboot transport initialised.\r\n");\r
461\r
462 FreePool (HandleBuffer);\r
463\r
464 return EFI_SUCCESS;\r
465}\r
466\r
467EFI_STATUS\r
468TcpFastbootTransportStop (\r
469 VOID\r
470 )\r
471{\r
472 EFI_TCP4_CLOSE_TOKEN CloseToken;\r
473 EFI_STATUS Status;\r
474 UINTN EventIndex;\r
e7108d0e
MK
475 FASTBOOT_TCP_PACKET_LIST *Entry;\r
476 FASTBOOT_TCP_PACKET_LIST *NextEntry;\r
4d6e1e5a
BJ
477\r
478 // Close any existing TCP connection, blocking until it's done.\r
479 if (mTcpConnection != NULL) {\r
480 CloseReceiveEvents ();\r
481\r
482 CloseToken.AbortOnClose = FALSE;\r
483\r
484 Status = gBS->CreateEvent (0, 0, NULL, NULL, &CloseToken.CompletionToken.Event);\r
485 ASSERT_EFI_ERROR (Status);\r
486\r
487 Status = mTcpConnection->Close (mTcpConnection, &CloseToken);\r
488 ASSERT_EFI_ERROR (Status);\r
489\r
490 Status = gBS->WaitForEvent (\r
491 1,\r
492 &CloseToken.CompletionToken.Event,\r
493 &EventIndex\r
494 );\r
495 ASSERT_EFI_ERROR (Status);\r
496\r
497 ASSERT_EFI_ERROR (CloseToken.CompletionToken.Status);\r
498\r
499 // Possible bug in EDK2 TCP4 driver: closing a connection doesn't remove its\r
500 // PCB from the list of live connections. Subsequent attempts to Configure()\r
501 // a TCP instance with the same local port will fail with INVALID_PARAMETER.\r
502 // Calling Configure with NULL is a workaround for this issue.\r
503 Status = mTcpConnection->Configure (mTcpConnection, NULL);\r
504 ASSERT_EFI_ERROR (Status);\r
505 }\r
506\r
4d6e1e5a
BJ
507 gBS->CloseEvent (mAcceptToken.CompletionToken.Event);\r
508\r
509 // Stop listening for connections.\r
510 // Ideally we would do this with Cancel, but it isn't implemented by EDK2.\r
511 // So we just "reset this TCPv4 instance brutally".\r
512 Status = mTcpListener->Configure (mTcpListener, NULL);\r
513 ASSERT_EFI_ERROR (Status);\r
514\r
7b6ceb4d 515 Status = mTcpServiceBinding->DestroyChild (mTcpServiceBinding, mTcpHandle);\r
4d6e1e5a
BJ
516\r
517 // Free any data the user didn't pick up\r
e7108d0e 518 Entry = (FASTBOOT_TCP_PACKET_LIST *)GetFirstNode (&mPacketListHead);\r
4d6e1e5a 519 while (!IsNull (&mPacketListHead, &Entry->Link)) {\r
e7108d0e 520 NextEntry = (FASTBOOT_TCP_PACKET_LIST *)GetNextNode (&mPacketListHead, &Entry->Link);\r
4d6e1e5a
BJ
521\r
522 RemoveEntryList (&Entry->Link);\r
523 if (Entry->Buffer) {\r
524 FreePool (Entry->Buffer);\r
525 }\r
e7108d0e 526\r
4d6e1e5a
BJ
527 FreePool (Entry);\r
528\r
529 Entry = NextEntry;\r
530 }\r
531\r
532 return EFI_SUCCESS;\r
533}\r
534\r
535/*\r
536 Event notify function for when data has been sent. Free resources and report\r
537 errors.\r
538 Context should point to the transmit IO token passed to\r
539 TcpConnection->Transmit.\r
540*/\r
541STATIC\r
542VOID\r
543DataSent (\r
e7108d0e
MK
544 EFI_EVENT Event,\r
545 VOID *Context\r
4d6e1e5a
BJ
546 )\r
547{\r
e7108d0e 548 EFI_STATUS Status;\r
4d6e1e5a
BJ
549\r
550 Status = mTransmitToken.CompletionToken.Status;\r
551 if (EFI_ERROR (Status)) {\r
a1878955 552 DEBUG ((DEBUG_ERROR, "TCP Fastboot transmit result: %r\n", Status));\r
e7108d0e 553 gBS->SignalEvent (*(EFI_EVENT *)Context);\r
4d6e1e5a
BJ
554 }\r
555\r
556 FreePool (mTransmitToken.Packet.TxData->FragmentTable[0].FragmentBuffer);\r
557}\r
558\r
559EFI_STATUS\r
560TcpFastbootTransportSend (\r
561 IN UINTN BufferSize,\r
e7108d0e
MK
562 IN CONST VOID *Buffer,\r
563 IN EFI_EVENT *FatalErrorEvent\r
4d6e1e5a
BJ
564 )\r
565{\r
e7108d0e 566 EFI_STATUS Status;\r
4d6e1e5a
BJ
567\r
568 if (BufferSize > 512) {\r
569 return EFI_INVALID_PARAMETER;\r
570 }\r
571\r
572 //\r
573 // Build transmit IO token\r
574 //\r
575\r
576 // Create an event so we are notified when a transmission is complete.\r
577 // We use this to free resources and report errors.\r
578 Status = gBS->CreateEvent (\r
579 EVT_NOTIFY_SIGNAL,\r
580 TPL_CALLBACK,\r
581 DataSent,\r
582 FatalErrorEvent,\r
583 &mTransmitToken.CompletionToken.Event\r
584 );\r
585 ASSERT_EFI_ERROR (Status);\r
586\r
587 mTxData.DataLength = BufferSize;\r
588\r
589 mTxData.FragmentTable[0].FragmentLength = BufferSize;\r
590 mTxData.FragmentTable[0].FragmentBuffer = AllocateCopyPool (\r
e7108d0e
MK
591 BufferSize,\r
592 Buffer\r
593 );\r
4d6e1e5a
BJ
594\r
595 Status = mTcpConnection->Transmit (mTcpConnection, &mTransmitToken);\r
596 if (EFI_ERROR (Status)) {\r
a1878955 597 DEBUG ((DEBUG_ERROR, "TCP Transmit: %r\n", Status));\r
4d6e1e5a
BJ
598 return Status;\r
599 }\r
600\r
601 return EFI_SUCCESS;\r
602}\r
603\r
4d6e1e5a
BJ
604EFI_STATUS\r
605TcpFastbootTransportReceive (\r
606 OUT UINTN *BufferSize,\r
e7108d0e 607 OUT VOID **Buffer\r
4d6e1e5a
BJ
608 )\r
609{\r
e7108d0e 610 FASTBOOT_TCP_PACKET_LIST *Entry;\r
4d6e1e5a
BJ
611\r
612 if (IsListEmpty (&mPacketListHead)) {\r
613 return EFI_NOT_READY;\r
614 }\r
615\r
e7108d0e 616 Entry = (FASTBOOT_TCP_PACKET_LIST *)GetFirstNode (&mPacketListHead);\r
4d6e1e5a
BJ
617\r
618 if (Entry->Buffer == NULL) {\r
619 // There was an error receiving this packet.\r
620 return EFI_DEVICE_ERROR;\r
621 }\r
622\r
e7108d0e 623 *Buffer = Entry->Buffer;\r
4d6e1e5a
BJ
624 *BufferSize = Entry->BufferSize;\r
625\r
626 RemoveEntryList (&Entry->Link);\r
627 FreePool (Entry);\r
628\r
629 return EFI_SUCCESS;\r
630}\r
631\r
e7108d0e 632FASTBOOT_TRANSPORT_PROTOCOL mTransportProtocol = {\r
4d6e1e5a
BJ
633 TcpFastbootTransportStart,\r
634 TcpFastbootTransportStop,\r
635 TcpFastbootTransportSend,\r
636 TcpFastbootTransportReceive\r
637};\r
638\r
639EFI_STATUS\r
640TcpFastbootTransportEntryPoint (\r
641 IN EFI_HANDLE ImageHandle,\r
e7108d0e 642 IN EFI_SYSTEM_TABLE *SystemTable\r
4d6e1e5a
BJ
643 )\r
644{\r
e7108d0e 645 EFI_STATUS Status;\r
4d6e1e5a 646\r
e7108d0e
MK
647 Status = gBS->LocateProtocol (\r
648 &gEfiSimpleTextOutProtocolGuid,\r
649 NULL,\r
650 (VOID **)&mTextOut\r
651 );\r
4d6e1e5a 652 if (EFI_ERROR (Status)) {\r
a1878955 653 DEBUG ((DEBUG_ERROR, "Fastboot: Open Text Output Protocol: %r\n", Status));\r
4d6e1e5a
BJ
654 return Status;\r
655 }\r
656\r
657 Status = gBS->InstallProtocolInterface (\r
658 &ImageHandle,\r
659 &gAndroidFastbootTransportProtocolGuid,\r
660 EFI_NATIVE_INTERFACE,\r
661 &mTransportProtocol\r
662 );\r
663 if (EFI_ERROR (Status)) {\r
a1878955 664 DEBUG ((DEBUG_ERROR, "Fastboot: Install transport Protocol: %r\n", Status));\r
4d6e1e5a
BJ
665 }\r
666\r
667 return Status;\r
668}\r