system76-edk2/MdeModulePkg/Universal/Network/SnpDxe/Initialize.c

/** @file
Copyright (c) 2004 - 2007, Intel Corporation
All rights reserved. This program and the accompanying materials
are licensed and made available under the terms and conditions of the BSD License
which accompanies this distribution.  The full text of the license may be found at
http://opensource.org/licenses/bsd-license.php

THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.

Module name:
  initialize.c

Abstract:

Revision history:
  2000-Feb-09 M(f)J   Genesis.

**/


#include "Snp.h"

VOID
EFIAPI
SnpWaitForPacketNotify (
  IN EFI_EVENT  Event,
  IN VOID       *SnpPtr
  );


/**
  this routine calls undi to initialize the interface.

  @param  snp                   pointer to snp driver structure
  @param  CableDetectFlag       Do/don't detect the cable (depending on what undi
                                supports)


**/
EFI_STATUS
pxe_init (
  SNP_DRIVER *snp,
  UINT16     CableDetectFlag
  )
{
  PXE_CPB_INITIALIZE  *cpb;
  VOID                *addr;
  EFI_STATUS          Status;

  cpb = snp->cpb;
  if (snp->tx_rx_bufsize != 0) {
    Status = snp->IoFncs->AllocateBuffer (
                            snp->IoFncs,
                            AllocateAnyPages,
                            EfiBootServicesData,
                            SNP_MEM_PAGES (snp->tx_rx_bufsize),
                            &addr,
                            0
                            );

    if (Status != EFI_SUCCESS) {
      DEBUG (
        (EFI_D_ERROR,
        "\nsnp->pxe_init()  AllocateBuffer  %xh (%r)\n",
        Status,
        Status)
        );

      return Status;
    }

    ASSERT (addr);

    snp->tx_rx_buffer = addr;
  }

  cpb->MemoryAddr   = (UINT64)(UINTN) snp->tx_rx_buffer;

  cpb->MemoryLength = snp->tx_rx_bufsize;

  //
  // let UNDI decide/detect these values
  //
  cpb->LinkSpeed      = 0;
  cpb->TxBufCnt       = 0;
  cpb->TxBufSize      = 0;
  cpb->RxBufCnt       = 0;
  cpb->RxBufSize      = 0;

  cpb->DuplexMode         = PXE_DUPLEX_DEFAULT;

  cpb->LoopBackMode       = LOOPBACK_NORMAL;

  snp->cdb.OpCode     = PXE_OPCODE_INITIALIZE;
  snp->cdb.OpFlags    = CableDetectFlag;

  snp->cdb.CPBsize    = sizeof (PXE_CPB_INITIALIZE);
  snp->cdb.DBsize     = sizeof (PXE_DB_INITIALIZE);

  snp->cdb.CPBaddr    = (UINT64)(UINTN) snp->cpb;
  snp->cdb.DBaddr     = (UINT64)(UINTN) snp->db;

  snp->cdb.StatCode   = PXE_STATCODE_INITIALIZE;
  snp->cdb.StatFlags  = PXE_STATFLAGS_INITIALIZE;
  snp->cdb.IFnum      = snp->if_num;
  snp->cdb.Control    = PXE_CONTROL_LAST_CDB_IN_LIST;

  DEBUG ((EFI_D_NET, "\nsnp->undi.initialize()  "));

  (*snp->issue_undi32_command) ((UINT64)(UINTN) &snp->cdb);

  if (snp->cdb.StatCode == PXE_STATCODE_SUCCESS) {
    snp->mode.State = EfiSimpleNetworkInitialized;

    Status          = EFI_SUCCESS;
  } else {
    DEBUG (
      (EFI_D_WARN,
      "\nsnp->undi.initialize()  %xh:%xh\n",
      snp->cdb.StatFlags,
      snp->cdb.StatCode)
      );

    if (snp->tx_rx_buffer != NULL) {
      snp->IoFncs->FreeBuffer (
                    snp->IoFncs,
                    SNP_MEM_PAGES (snp->tx_rx_bufsize),
                    (VOID *) snp->tx_rx_buffer
                    );
    }

    snp->tx_rx_buffer = NULL;

    Status            = EFI_DEVICE_ERROR;
  }

  return Status;
}


/**
  This is the SNP interface routine for initializing the interface
  This routine basically retrieves snp structure, checks the SNP state and
  calls the pxe_initialize routine to actually do the undi initialization

  @param  this                  context pointer
  @param  extra_rx_buffer_size  optional parameter, indicates extra space for
                                rx_buffers
  @param  extra_tx_buffer_size  optional parameter, indicates extra space for
                                tx_buffers


**/
EFI_STATUS
EFIAPI
snp_undi32_initialize (
  IN EFI_SIMPLE_NETWORK_PROTOCOL *this,
  IN UINTN                       extra_rx_buffer_size OPTIONAL,
  IN UINTN                       extra_tx_buffer_size OPTIONAL
  )
{
  EFI_STATUS  EfiStatus;
  SNP_DRIVER  *snp;
  EFI_TPL     OldTpl;

  //
  //
  //
  if (this == NULL) {
    return EFI_INVALID_PARAMETER;
  }

  snp = EFI_SIMPLE_NETWORK_DEV_FROM_THIS (this);

  OldTpl = gBS->RaiseTPL (TPL_CALLBACK);

  if (snp == NULL) {
    EfiStatus = EFI_INVALID_PARAMETER;
    goto ON_EXIT;
  }

  switch (snp->mode.State) {
  case EfiSimpleNetworkStarted:
    break;

  case EfiSimpleNetworkStopped:
    EfiStatus = EFI_NOT_STARTED;
    goto ON_EXIT;

  default:
    EfiStatus = EFI_DEVICE_ERROR;
    goto ON_EXIT;
  }

  EfiStatus = gBS->CreateEvent (
                    EVT_NOTIFY_WAIT,
                    TPL_NOTIFY,
                    &SnpWaitForPacketNotify,
                    snp,
                    &snp->snp.WaitForPacket
                    );

  if (EFI_ERROR (EfiStatus)) {
    snp->snp.WaitForPacket = NULL;
    EfiStatus = EFI_DEVICE_ERROR;
    goto ON_EXIT;
  }
  //
  //
  //
  snp->mode.MCastFilterCount      = 0;
  snp->mode.ReceiveFilterSetting  = 0;
  ZeroMem (snp->mode.MCastFilter, sizeof snp->mode.MCastFilter);
  CopyMem (
    &snp->mode.CurrentAddress,
    &snp->mode.PermanentAddress,
    sizeof (EFI_MAC_ADDRESS)
    );

  //
  // Compute tx/rx buffer sizes based on UNDI init info and parameters.
  //
  snp->tx_rx_bufsize = (UINT32) (snp->init_info.MemoryRequired + extra_rx_buffer_size + extra_tx_buffer_size);

  if (snp->mode.MediaPresentSupported) {
    if (pxe_init (snp, PXE_OPFLAGS_INITIALIZE_DETECT_CABLE) == EFI_SUCCESS) {
      snp->mode.MediaPresent = TRUE;
      goto ON_EXIT;
    }
  }

  snp->mode.MediaPresent  = FALSE;

  EfiStatus               = pxe_init (snp, PXE_OPFLAGS_INITIALIZE_DO_NOT_DETECT_CABLE);

  if (EFI_ERROR (EfiStatus)) {
    gBS->CloseEvent (snp->snp.WaitForPacket);
  }

ON_EXIT:
  gBS->RestoreTPL (OldTpl);

  return EfiStatus;
}